From d8c4d55dadbc2fafeab164f903484e104d9ff22a Mon Sep 17 00:00:00 2001 From: PaulStoffregen Date: Fri, 20 Oct 2017 09:02:55 -0700 Subject: [PATCH] Fix AntPlus transmit buffer wrap issue --- antplus.cpp | 4 +++- 1 file changed, 3 insertions(+), 1 deletion(-) diff --git a/antplus.cpp b/antplus.cpp index cb65039..69a9b3a 100644 --- a/antplus.cpp +++ b/antplus.cpp @@ -149,7 +149,9 @@ void AntPlus::tx_data(const Transfer_t *transfer) //print(", tail=", (p-1) - txbuffer); //println(", tail=", txtail); uint32_t tail = txtail; - tail += *(p-1) + 1; + uint8_t size = *(p-1); + tail += size + 1; + if (tail >= sizeof(txbuffer)) tail -= sizeof(txbuffer); txtail = tail; //println("new tail=", tail); txready = true;