X-Git-Url: https://git.jankratochvil.net/?p=gnokii.git;a=blobdiff_plain;f=common%2Fprotocol%2Ffbus.c;h=af7eaac4007a3b8d08304cce0d842ac2c7005779;hp=2cc8aae0801b9da92f0cf44e690e8bd8723a299a;hb=95c6140ba18b9b87148911f0e304f6c9af7aadb4;hpb=c7dcdfd34d2bed9cc64c5c9603e51ef8c8271951

diff --git a/common/protocol/fbus.c b/common/protocol/fbus.c
index 2cc8aae..af7eaac 100644
--- a/common/protocol/fbus.c
+++ b/common/protocol/fbus.c
@@ -161,6 +161,10 @@ int FBUS_SendFrame(u16 message_length, u8 message_type, u8 *buffer) {
   NULL_TX_DisplayMessage(current, out_buffer);
 #endif /* DEBUG */
 
+#if 0
+usleep(200000);
+#endif
+
   /* Send it out... */
   if (!NULL_WritePhone(current,out_buffer))
     return (false);
@@ -256,6 +260,14 @@ void FBUS_RX_StateMachine(unsigned char rx_byte) {
 //    AT_RX_StateMachine(rx_byte);
 //  } else {
 
+#ifdef XDEBUG_LaceDisabled
+  if (isprint(rx_byte))
+    fprintf(stdout, "[%02x%c]", rx_byte, rx_byte);
+  else
+    fprintf(stdout, "[%02x ]", rx_byte);
+  fflush(stdout);
+#endif
+
 #ifdef DEBUG
   /* For model sniff only display received bytes */
   if (strcmp(GSM_Info->FBUSModels, "sniff"))
@@ -434,7 +446,7 @@ void FBUS_RX_StateMachine(unsigned char rx_byte) {
               if (MessageType != FBUS_FRTYPE_ACK && MessageType != 0xf1)
                 N61_RX_DisplayMessage();
 
-              GSM->DispatchMessage(MessageLength, MessageBuffer, MessageType);
+              GSM->DispatchMessage(MessageLength-2, MessageBuffer, MessageType);
             }
 
 	  } else {
@@ -476,7 +488,7 @@ void FBUS_RX_StateMachine(unsigned char rx_byte) {
             if (MessageType != FBUS_FRTYPE_ACK && MessageType != 0xf1)
               N61_RX_DisplayMessage();
 
-            GSM->DispatchMessage(MessageLength, MessageBuffer, MessageType);
+            GSM->DispatchMessage(MessageLength-2, MessageBuffer, MessageType);
           }
 
 #ifdef DEBUG