Index: firmware/App/Services/CommBuffers.c
===================================================================
diff -u -r30f049651877229042e3f8700c8596e5b9a1e0f4 -rcd5be724d5a3ba7457e761191d82f278654d7f5c
--- firmware/App/Services/CommBuffers.c	(.../CommBuffers.c)	(revision 30f049651877229042e3f8700c8596e5b9a1e0f4)
+++ firmware/App/Services/CommBuffers.c	(.../CommBuffers.c)	(revision cd5be724d5a3ba7457e761191d82f278654d7f5c)
@@ -1,17 +1,17 @@
 /**************************************************************************
 *
-* Copyright (c) 2019-2020 Diality Inc. - All Rights Reserved.
+* Copyright (c) 2019-2024 Diality Inc. - All Rights Reserved.
 *
 * THIS CODE MAY NOT BE COPIED OR REPRODUCED IN ANY FORM, IN PART OR IN
 * WHOLE, WITHOUT THE EXPLICIT PERMISSION OF THE COPYRIGHT OWNER.
 *
-* @file CommBuffers.c
+* @file    CommBuffers.c
 *
-* @author (last) Sean Nash
-* @date (last) 14-Oct-2020
+* @author  (last)      Sean Nash
+* @date    (last)      29-Jul-2022
 *
-* @author (original) Dara Navaei
-* @date (original) 05-Nov-2019
+* @author  (original)  Dara Navaei
+* @date    (original)  05-Nov-2019
 *
 ***************************************************************************/
 
@@ -30,7 +30,7 @@
 
 // ********** private definitions **********
 
-#define COMM_BUFFER_LENGTH              512             ///< Max bytes in each comm buffer (each side of double buffer is this size)
+#define COMM_BUFFER_LENGTH              768             ///< Max bytes in each comm buffer (each side of double buffer is this size)
 #define DOUBLE_BUFFERS                  2               ///< Need 2 buffers for double buffering
 #define BUFFER_OVERFLOW_PERSISTENCE_MS  5000            ///< How many ms buffer overflows must persist before fault
 
@@ -153,12 +153,6 @@
         // If buffer was full, check persistence - trigger s/w fault if persists
         if ( TRUE == bufferFull )
         {
-#ifdef DEBUG_ENABLED
-            char debugStr[ 100 ];
-            sprintf( debugStr, "Buf OF:#%3d,%3d, %02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X\n", buffer, len, data[0], data[1], data[2], data[3], data[4], data[5], data[6], data[7] );
-            sendDebugData( (U08*)debugStr, strlen(debugStr) );
-            sendDebugDataToUI( (U08*)debugStr );
-#endif
             clearBuffer( buffer );
             // Not first overflow?
             if ( firstBufferOverflowTimeStamp != 0 )
@@ -220,7 +214,7 @@
         if ( ( len <= ( COMM_BUFFER_LENGTH * DOUBLE_BUFFERS ) ) && ( len <= numberOfBytesInCommBuffer( buffer ) ) )
         {
             U32 activeBuffer = activeDoubleBuffer[ buffer ];
-            U32 inactiveBuffer = ( activeBuffer == 0 ? 1 : 0 );
+            U32 inactiveBuffer = GET_TOGGLE( activeBuffer, 0, 1 );
             U32 bytesInInactiveBuffer = commBufferByteCount[ buffer ][ inactiveBuffer ];
             U32 sizeOfFirstConsumption = MIN( len, bytesInInactiveBuffer );
 
@@ -229,7 +223,7 @@
             // Will return # of bytes consumed
             result = sizeOfFirstConsumption;
             // Do we need more from active buffer?
-            if ( len > bytesInInactiveBuffer )
+            if ( len > sizeOfFirstConsumption )
             {
                 U32 remNumOfBytes = len - sizeOfFirstConsumption;
                 U08 *remPtr = data + sizeOfFirstConsumption;
@@ -278,7 +272,7 @@
         if ( ( len <= ( COMM_BUFFER_LENGTH * DOUBLE_BUFFERS ) ) && ( len <= numberOfBytesInCommBuffer( buffer ) ) )
         {
             U32 activeBuffer = activeDoubleBuffer[ buffer ];
-            U32 inactiveBuffer = ( activeBuffer == 0 ? 1 : 0 );
+            U32 inactiveBuffer = GET_TOGGLE( activeBuffer, 0, 1 );
             U32 bytesInInactiveBuffer = commBufferByteCount[ buffer ][ inactiveBuffer ];
 
             if ( len <= bytesInInactiveBuffer )
@@ -351,7 +345,7 @@
 static U32 switchDoubleBuffer( COMM_BUFFER_T buffer )
 {
     U32 activeBuffer = activeDoubleBuffer[ buffer ];
-    U32 inactiveBuffer = ( activeBuffer == 0 ? 1 : 0 );
+    U32 inactiveBuffer = GET_TOGGLE( activeBuffer, 0, 1 );
 
     // Ensure inactive buffer is reset before making active
     commBufferByteCount[ buffer ][ inactiveBuffer ] = 0;
@@ -377,7 +371,7 @@
 static void getDataFromInactiveBuffer( COMM_BUFFER_T buffer, U08 *data, U32 len )
 {
     U32 activeBuffer = activeDoubleBuffer[ buffer ];
-    U32 inactiveBuffer = ( activeBuffer == 0 ? 1 : 0 );
+    U32 inactiveBuffer = GET_TOGGLE( activeBuffer, 0, 1 );
     U32 bytesInInactiveBuffer = commBufferByteCount[ buffer ][ inactiveBuffer ];
 
     // Get the requested data from inactive buffer