Reduce EXI speed for WIZnet in Serial Port 1

Author: Extrems

lwip/netif/w5500if.c

@@ -331,6 +331,7 @@ struct w5500if {
 
 static struct netif *w5500_netif;
 static u8 Dev[EXI_CHANNEL_MAX];
+static u8 Freq[EXI_CHANNEL_MAX];
 
 static bool W5500_ReadCmd(s32 chan, u32 cmd, void *buf, u32 len)
 {
@@ -339,7 +340,7 @@ static bool W5500_ReadCmd(s32 chan, u32 cmd, void *buf, u32 len)
 	cmd &= ~W5500_RWB;
 	cmd  = (cmd << 16) | (cmd >> 16);
 
-	if (!EXI_Select(chan, Dev[chan], EXI_SPEED32MHZ))
+	if (!EXI_Select(chan, Dev[chan], Freq[chan]))
 		return false;
 
 	err |= !EXI_ImmEx(chan, &cmd, 3, EXI_WRITE);
@@ -355,7 +356,7 @@ static bool W5500_WriteCmd(s32 chan, u32 cmd, const void *buf, u32 len)
 	cmd |=  W5500_RWB;
 	cmd  = (cmd << 16) | (cmd >> 16);
 
-	if (!EXI_Select(chan, Dev[chan], EXI_SPEED32MHZ))
+	if (!EXI_Select(chan, Dev[chan], Freq[chan]))
 		return false;
 
 	err |= !EXI_ImmEx(chan, &cmd, 3, EXI_WRITE);
@@ -558,6 +559,7 @@ static bool W5500_Init(s32 chan, s32 dev, struct w5500if *w5500if)
 
 	EXI_LockEx(chan, dev);
 	Dev[chan] = dev;
+	Freq[chan] = dev == EXI_DEVICE_0 ? EXI_SPEED32MHZ : EXI_SPEED16MHZ;
 
 	if (!W5500_ReadReg(chan, W5500_VERSIONR, &versionr) || versionr != 0x04) {
 		EXI_Unlock(chan);

lwip/netif/w6x00if.c

@@ -698,6 +698,7 @@ struct w6x00if {
 
 static struct netif *w6x00_netif;
 static u8 Dev[EXI_CHANNEL_MAX];
+static u8 Freq[EXI_CHANNEL_MAX];
 
 static bool (*W6X00_ReadCmd)(s32 chan, u32 cmd, void *buf, u32 len);
 static bool (*W6X00_WriteCmd)(s32 chan, u32 cmd, const void *buf, u32 len);
@@ -709,7 +710,7 @@ static bool W6100_ReadCmd(s32 chan, u32 cmd, void *buf, u32 len)
 	cmd &= ~W6100_RWB;
 	cmd  = (cmd << 16) | (cmd >> 16);
 
-	if (!EXI_Select(chan, Dev[chan], EXI_SPEED32MHZ))
+	if (!EXI_Select(chan, Dev[chan], Freq[chan]))
 		return false;
 
 	err |= !EXI_ImmEx(chan, &cmd, 3, EXI_WRITE);
@@ -725,7 +726,7 @@ static bool W6100_WriteCmd(s32 chan, u32 cmd, const void *buf, u32 len)
 	cmd |=  W6100_RWB;
 	cmd  = (cmd << 16) | (cmd >> 16);
 
-	if (!EXI_Select(chan, Dev[chan], EXI_SPEED32MHZ))
+	if (!EXI_Select(chan, Dev[chan], Freq[chan]))
 		return false;
 
 	err |= !EXI_ImmEx(chan, &cmd, 3, EXI_WRITE);
@@ -742,7 +743,7 @@ static bool W6300_ReadCmd(s32 chan, u32 cmd, void *buf, u32 len)
 	cmd &= ~W6300_RWB;
 	cmd <<= 8;
 
-	if (!EXI_Select(chan, Dev[chan], EXI_SPEED32MHZ))
+	if (!EXI_Select(chan, Dev[chan], Freq[chan]))
 		return false;
 
 	err |= !EXI_ImmEx(chan, &cmd, 4, EXI_WRITE);
@@ -759,7 +760,7 @@ static bool W6300_WriteCmd(s32 chan, u32 cmd, const void *buf, u32 len)
 	cmd |=  W6300_RWB;
 	cmd <<= 8;
 
-	if (!EXI_Select(chan, Dev[chan], EXI_SPEED32MHZ))
+	if (!EXI_Select(chan, Dev[chan], Freq[chan]))
 		return false;
 
 	err |= !EXI_ImmEx(chan, &cmd, 4, EXI_WRITE);
@@ -960,6 +961,7 @@ static bool W6X00_Init(s32 chan, s32 dev, struct w6x00if *w6x00if)
 
 	EXI_LockEx(chan, dev);
 	Dev[chan] = dev;
+	Freq[chan] = dev == EXI_DEVICE_0 ? EXI_SPEED32MHZ : EXI_SPEED16MHZ;
 
 	switch (id) {
 		case W6100_CID: