#34 Reset syslink state when STM is restarted

bitcraze · Feb 12, 2020 · 9c69891 · 9c69891
1 parent 3c4780c
commit 9c69891
Show file tree

Hide file tree

Showing 3 changed files with 8 additions and 1 deletion.
diff --git a/interface/syslink.h b/interface/syslink.h
@@ -41,6 +41,7 @@ struct syslinkPacket {
 bool syslinkReceive(struct syslinkPacket *packet);
 
 bool syslinkSend(struct syslinkPacket *packet);
+void syslinkReset();
 
 
 // Defined packet types

diff --git a/src/main.c b/src/main.c
@@ -498,6 +498,7 @@ static void handleBootloaderCmd(struct esbPacket_s *packet)
     case BOOTLOADER_CMD_SYSON:
       pmSysBootloader(false);
       pmSetState(pmSysRunning);
+      syslinkReset();
       break;
     case BOOTLOADER_CMD_GETVBAT:
       if (esbCanTxPacket()) {

diff --git a/src/syslink.c b/src/syslink.c
@@ -47,9 +47,14 @@
 #define START_BYTE1 0xBC
 #define START_BYTE2 0xCF
 
+static enum {state_first_start, state_second_start, state_length, state_type, state_data, state_cksum1, state_cksum2, state_done} state = state_first_start;
+
+void syslinkReset() {
+  state = state_first_start;
+}
+
 bool syslinkReceive(struct syslinkPacket *packet)
 {
-  static enum {state_first_start, state_second_start, state_length, state_type, state_data, state_cksum1, state_cksum2, state_done} state = state_first_start;
   static int step=0;
   static int length=0;
   static uint8_t cksum_a=0, cksum_b=0;