Retreated uC patch for: GSM->DispatchMessage(MessageLength +/- 2 ,...

diff --git a/common/protocol/fbus.c b/common/protocol/fbus.c
index 04984ca..d1b51e0 100644 (file)
--- a/common/protocol/fbus.c
+++ b/common/protocol/fbus.c
@@ -161,7 +161,9 @@ int FBUS_SendFrame(u16 message_length, u8 message_type, u8 *buffer) {
   NULL_TX_DisplayMessage(current, out_buffer);
 #endif /* DEBUG */
 
+#if 1
 usleep(200000);
+#endif
 
   /* Send it out... */
   if (!NULL_WritePhone(current,out_buffer))
@@ -444,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 {
@@ -486,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