From cba61657a8b4d86f8d5069d97b6d006144806fa2 Mon Sep 17 00:00:00 2001
From: Kristoffer Richardsson <kristoffer@bitcraze.io>
Date: Wed, 29 Aug 2018 08:56:47 +0200
Subject: [PATCH] Add TDoA3 to LPP. Closes #40

---
 inc/lpp.h | 3 ++-
 inc/uwb.h | 3 ++-
 src/lpp.c | 6 ++++--
 3 files changed, 8 insertions(+), 4 deletions(-)

diff --git a/inc/lpp.h b/inc/lpp.h
index b01d2b2..af704dc 100644
--- 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
index 5f40b3f..cd7e7a2 100644
--- 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
index aac29f9..c0fc123 100644
--- 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!