board: wait for unique id message from usb link on startup

shanteacontrols · Sep 17, 2021 · 87b1710 · 87b1710
1 parent 62e31f1
commit 87b1710
Showing 1 changed file with 15 additions and 0 deletions.
diff --git a/src/board/arch/avr/common/Init.cpp b/src/board/arch/avr/common/Init.cpp
@@ -174,6 +174,21 @@ namespace Board
                 //add some delay and remove initial readout of digital inputs
                 core::timing::waitMs(10);
                 detail::io::flushInputReadings();
+
+#ifndef USB_SUPPORTED
+                //wait for unique id from usb host
+                //this is to make sure host and the device share the same unique id
+                USBLink::internalCMD_t cmd;
+
+                while (1)
+                {
+                    while (!Board::detail::USB::readInternal(cmd))
+                        ;
+
+                    if (cmd == USBLink::internalCMD_t::uniqueID)
+                        break;
+                }
+#endif
 #endif
             }