From 6b306e18a563b0118012a0e601f7be1446bf4e83 Mon Sep 17 00:00:00 2001 From: RSDuck Date: Sat, 9 Jan 2021 22:06:15 +0100 Subject: handle edge cases properly --- src/Wifi.cpp | 9 ++++----- 1 file changed, 4 insertions(+), 5 deletions(-) (limited to 'src') diff --git a/src/Wifi.cpp b/src/Wifi.cpp index e00f72b..6792bc8 100644 --- a/src/Wifi.cpp +++ b/src/Wifi.cpp @@ -793,13 +793,12 @@ bool ProcessTX(TXSlot* slot, int num) inline void IncrementRXAddr(u16& addr, u16 inc = 2) { - addr += inc; - addr &= 0x1FFE; - if (addr >= (IOPORT(W_RXBufEnd) & 0x1FFE)) + for (u32 i = 0; i < inc; i += 2) { - addr -= (IOPORT(W_RXBufEnd) & 0x1FFE); - addr += (IOPORT(W_RXBufBegin) & 0x1FFE); + addr += 2; addr &= 0x1FFE; + if (addr == (IOPORT(W_RXBufEnd) & 0x1FFE)) + addr = (IOPORT(W_RXBufBegin) & 0x1FFE); } } -- cgit v1.2.3