WebSVN - NaviCtrl - Diff - Rev 110 and 112

 #include "91x_lib.h"
 #include "mkprotocol.h"
 #include "ramfunc.h"
 #include "usb.h"
+void Buffer_Clear(Buffer_t* pBuffer)
+{
+        pBuffer->DataBytes = 0;
+        pBuffer->Position = 0;
+        pBuffer->Locked = FALSE;
+}
+void Buffer_Init(Buffer_t* pBuffer, u8* pDataBuffer, u16 DataBufferSize)
+{
+        pBuffer->pData = pDataBuffer;
+        pBuffer->Size = DataBufferSize;
+        Buffer_Clear(pBuffer);
+}
 /**************************************************************/
 /* Create serial output frame                                 */
         int len = 0;
         if(pTxBuff->Locked == FALSE)
         {       // tx-buffer is not in use
                 pTxBuff->Position = 0;
-                pTxBuff->pData[pTxBuff->Position++] = '#';                      // Start character
+                pTxBuff->pData[pTxBuff->Position++] = '#';                          // Start character
                 pTxBuff->pData[pTxBuff->Position++] = 'a' + Address;    // Address (a=0; b=1,...)
                 pTxBuff->pData[pTxBuff->Position++] = CmdID;                    // Command
+                }
                 tmpCRC %= 4096;
                 pTxBuff->pData[pTxBuff->Position++] = '=' + tmpCRC / 64;
                 pTxBuff->pData[pTxBuff->Position++] = '=' + tmpCRC % 64;
                 pTxBuff->pData[pTxBuff->Position++] = '\r';
+                pTxBuff->DataBytes = pTxBuff->Position;
                 pTxBuff->Position = 0;  // reset buffer position for transmision
                 pTxBuff->Locked = TRUE; // mark as used
         } // EOF buffer not in use
+}
         if(pRxBuff->Locked == FALSE)
         { // rx buffer not locked
                 if((pRxBuff->Position == 0) && (c == '#')) // if rxd buffer is empty and syncronisation character is received
+                        {
                                 pRxBuff->pData[pRxBuff->Position++] = c; // copy 1st byte to buffer
-                                //crc = c; // init crc
+                                pRxBuff->DataBytes = 1;
+                        }
                         else if (pRxBuff->Position < pRxBuff->Size) // rx buffer not full
+                        {
                                 if (c != '\r') // no termination character received
+                                {
                                         pRxBuff->pData[pRxBuff->Position++] = c; // copy byte to rxd buffer
-                                        //crc += c; // update crc
+                                        pRxBuff->DataBytes++;
+                                }
                                 else // termination character received
+                                {
                                         // calculate checksum from transmitted data
                                         u16 crc = 0, i;
                                         crc2 = '=' + crc % 64;
                                         // compare checksum to transmitted checksum bytes
                                         if((crc1 == pRxBuff->pData[pRxBuff->Position-2]) && (crc2 == pRxBuff->pData[pRxBuff->Position-1]))
                                         {   // checksum is valid
                                                 pRxBuff->Locked = TRUE;                                     // lock the rxd buffer
-                                                pRxBuff->pData[pRxBuff->Position] = '\r';       // set termination character
+                                                pRxBuff->pData[pRxBuff->Position++] = '\r';     // set termination character
+                                                pRxBuff->DataBytes = pRxBuff->Position;
+                                                pRxBuff->Position = 0;
                                                 // if 2nd byte is an 'R' start bootloader
                                                 if(pRxBuff->pData[2] == 'R')
+                                                {
                                                         PowerOff();
                                                         VIC_DeInit();
                                                         Execute_Bootloader(); // Reset-Commando - Bootloader starten
+                                                }
                                         } // eof checksum valid
                                         else
                                         {       // checksum is invalid
-                                                pRxBuff->Position = 0;   // reset rxd buffer position
-                                                pRxBuff->Locked = FALSE; // unlock rxd buffer
+                                                Buffer_Clear(pRxBuff);
                                         }  // eof checksum invalid
                                 } // eof termination character received
                         } // rxd buffer not full
                         else // rxd buffer overrun
+                        {
-                                pRxBuff->Position = 0; // reset rxd buffer      pointer
-                                pRxBuff->Locked = FALSE; // unlock rxd buffer
+                                Buffer_Clear(pRxBuff);
                         } // eof rxd buffer overrrun
+        }
+}
+{
         u8 a,b,c,d;
         u8 x,y,z;
         u8 ptrIn = 3; // start with first data byte in rx buffer
         u8 ptrOut = 3;
-        u8 len = pRxBuff->Position - 6;  // must be a multiple of 4 (3 bytes at begin and 3 bytes at end are no payload )
+        u8 len = pRxBuff->DataBytes - 6;         // must be a multiple of 4 (3 bytes at begin and 3 bytes at end are no payload )
         while(len)
+        {
                 a = pRxBuff->pData[ptrIn++] - '=';
                 b = pRxBuff->pData[ptrIn++] - '=';
                 c = pRxBuff->pData[ptrIn++] - '=';
+        }
         pSerialMsg->Address = pRxBuff->pData[1] - 'a';
         pSerialMsg->CmdID = pRxBuff->pData[2];
         pSerialMsg->pData = &(pRxBuff->pData[3]);
         pSerialMsg->DataLen = ptrOut - 3;       // return number of data in bytes
+        pRxBuff->Position = 0;
+        pRxBuff->DataBytes = ptrOut;
+}

Subversion Repositories NaviCtrl

(root)/tags/V2.12a/mkprotocol.c @ 684 - Rev 110 → 112