Added debugging counters

src/main/io/serial_4way.c

@@ -359,6 +359,7 @@ void esc4wayProcess(serialPort_t *serial)
         TX_LED_ON;
         if (replyAck == esc4wayAck_OK)
             replyAck = esc4wayProcessCmd(command, addr, paramBuf, inLen, &outLen);
+        RX_LED_OFF;
 
         // send single '\0' byte is output when length is zero (len ==0 -> 256 bytes)
         if(!outLen) {
@@ -366,7 +367,6 @@ void esc4wayProcess(serialPort_t *serial)
             outLen = 1;
         }
 
-        RX_LED_OFF;
         crcOut = 0;
         serialBeginWrite(port);
         writeByteCrc(cmd_Remote_Escape);
@@ -374,7 +374,7 @@ void esc4wayProcess(serialPort_t *serial)
         writeByteCrc(addr >> 8);
         writeByteCrc(addr & 0xff);
         writeByteCrc(outLen & 0xff);          // only low byte is send, 0x00 -> 256B
-        for(int i = 0; i < outLen; i++)
+        for(int i = 0; i < outLen % 0x100; i++)
             writeByteCrc(paramBuf[i]);
         writeByteCrc(replyAck);
         writeByte(crcOut >> 8);

src/main/io/serial_4way_avrootloader.c

@@ -238,7 +238,7 @@ void BL_SendCMDRunRestartBootloader(void)
 static uint8_t BL_SendCMDSetAddress(ioMem_t *pMem) //supports only 16 bit Adr
 {
     // skip if adr == 0xFFFF
-    if((pMem->addr == 0xffff))
+    if(pMem->addr == 0xffff)
         return 1;
     uint8_t sCMD[] = {CMD_SET_ADDRESS, 0, pMem->addr >> 8, pMem->addr & 0xff };
     BL_SendBuf(sCMD, sizeof(sCMD), true);

src/main/vcpf4/usbd_cdc_vcp.c

@@ -218,18 +218,20 @@ uint32_t CDC_Receive_DATA(uint8_t* recvBuf, uint32_t len)
  * @param  Len: Number of data received (in bytes)
  * @retval Result of the opeartion: USBD_OK if all operations are OK else VCP_FAIL
  */
+static uint32_t rxTotalBytes = 0;
+static uint32_t rxPackets = 0;
+
 static uint16_t VCP_DataRx(uint8_t* Buf, uint32_t Len)
 {
-    __disable_irq();
+    rxPackets++;
 
     for (uint32_t i = 0; i < Len; i++) {
         usbData.buffer[usbData.bufferInPosition] = Buf[i];
         usbData.bufferInPosition = (usbData.bufferInPosition + 1) % USB_RX_BUFSIZE;
         receiveLength++;
+        rxTotalBytes++;
     }
 
-    __enable_irq();
-
     if(receiveLength > (USB_RX_BUFSIZE-1))
         return USBD_FAIL;
     

src/main/vcpf4/usbd_cdc_vcp.h

@@ -34,7 +34,7 @@
 #include "usbd_usr.h"
 #include "usbd_desc.h"
 
-#define USB_RX_BUFSIZE      1024
+#define USB_RX_BUFSIZE      2048
 
 __ALIGN_BEGIN USB_OTG_CORE_HANDLE  USB_OTG_dev __ALIGN_END;