Add TDoA3 to LPP. Closes #40

bitcraze · Aug 29, 2018 · cba6165 · cba6165
1 parent 2865a4f
commit cba6165
Show file tree

Hide file tree

Showing 3 changed files with 8 additions and 4 deletions.
diff --git a/inc/lpp.h b/inc/lpp.h
@@ -49,7 +49,8 @@ struct lppShortReboot_s {
 } __attribute__((packed));
 
 #define LPP_SHORT_MODE_TWR 0x01
-#define LPP_SHORT_MODE_TDOA 0x02
+#define LPP_SHORT_MODE_TDOA2 0x02
+#define LPP_SHORT_MODE_TDOA3 0x03
 
 struct lppShortMode_s {
   uint8_t mode;

diff --git a/inc/uwb.h b/inc/uwb.h
@@ -50,7 +50,8 @@ typedef struct uwbConfig_s {
 #define MODE_ANCHOR 0
 #define MODE_TAG 1
 #define MODE_SNIFFER 2
-#define MODE_TDOA_ANCHOR 3
+#define MODE_TDOA_ANCHOR2 3
+#define MODE_TDOA_ANCHOR3 4
 
 typedef enum uwbEvent_e {
   eventTimeout,

diff --git a/src/lpp.c b/src/lpp.c
@@ -93,8 +93,10 @@ void lppHandleShortPacket(char *data, size_t length)
       // Set new mode
       if (modeInfo->mode == LPP_SHORT_MODE_TWR) {
         cfgWriteU8(cfgMode, MODE_ANCHOR);
-      } else if (modeInfo->mode == LPP_SHORT_MODE_TDOA) {
-        cfgWriteU8(cfgMode, MODE_TDOA_ANCHOR);
+      } else if (modeInfo->mode == LPP_SHORT_MODE_TDOA2) {
+        cfgWriteU8(cfgMode, MODE_TDOA_ANCHOR2);
+      } else if (modeInfo->mode == LPP_SHORT_MODE_TDOA3) {
+        cfgWriteU8(cfgMode, MODE_TDOA_ANCHOR3);
       }
 
       // Then resets!