Diff: vz_protocol.cpp

Revision:

20:2d6ab23956e5

Parent:

18:01a93677e40c

Child:

21:0bd688722e81

--- a/vz_protocol.cpp	Sat Sep 20 11:27:47 2014 +0000
+++ b/vz_protocol.cpp	Sat Sep 20 13:34:52 2014 +0000
@@ -2,6 +2,9 @@
     
 extern DigitalOut led2;
 extern DigitalOut led3;
+
+uint16_t pkg_ckserr = 0;
+uint16_t pkg_cksok = 0;
     
 uint8_t * __parse_cb_buffer__( int * ext, int * port, volatile uint8_t * type, uint8_t * cb_buffer ){
     /**
@@ -38,9 +41,19 @@
     debug.sendTo( debug_server, debug_msg, strlen( debug_msg ) );
     debug.sendTo( debug_server, debug_msg, strlen( debug_msg ) );
     */
+    
+    pc.printf("\n\r PKG_CSK OK: %d", pkg_cksok);
+    pc.printf("\n\r PKG_CSK ERR: %d\n\r", pkg_ckserr); 
+    
     if( cc != __checksum__( cb_buffer, __CB_BUFFER_SIZE__ ) ){
+            /*pc.printf("\n\r CKS ERROR:  ");
+            for (int i=0; i< 300; i++ ){ pc.printf("%x ", cb_buffer[i]); }
+            pc.printf("\n\r");*/
+            pkg_ckserr++;
             return( NULL );
+
     }else{
+        pkg_cksok++;
         e_msb = cb_buffer[ 0 ];
         e_lsb = cb_buffer[ 1 ];
         *ext = e_msb << 8  | e_lsb;
@@ -53,6 +66,7 @@
 
         return( cb_buffer + __VZ_HEADER_OFFSET__ );    
     }
+
 }
 uint8_t * __build_cb_package__( int ext, int port, uint8_t type, char * cb_buffer, uint8_t seq_num, int length,  uint8_t * pkg ){
     debug_msg("");