altos: Debugging TBT issues -- check pin configuration after boot

[fw/altos] / src / ao_btm.c

diff --git a/src/ao_btm.c b/src/ao_btm.c
index 4b3c52092937ddc5f34cae6e00e3012a51ea9a40..490b2667e3c8a78eb412b020f204f59e6c1ad272 100644 (file)
--- a/src/ao_btm.c
+++ b/src/ao_btm.c
@@ -17,6 +17,21 @@
 
 #include "ao.h"
 
+#if BT_LINK_ON_P2
+#define BT_PICTL_ICON  PICTL_P2ICON
+#define BT_PIFG                P2IFG
+#define BT_PDIR                P2DIR
+#define BT_PINP                P2INP
+#define BT_IEN2_PIE    IEN2_P2IE
+#endif
+#if BT_LINK_ON_P1
+#define BT_PICTL_ICON  PICTL_P1ICON
+#define BT_PIFG                P1IFG
+#define BT_PDIR                P1DIR
+#define BT_PINP                P1INP
+#define BT_IEN2_PIE    IEN2_P1IE
+#endif
+
 int8_t                 ao_btm_stdio;
 __xdata uint8_t                ao_btm_connected;
 
@@ -166,6 +181,15 @@ ao_btm(void)
         */
        ao_delay(AO_SEC_TO_TICKS(3));
 
+#if BT_LINK_ON_P1
+       if ((P1DIR & (1 << 6)) == 0)
+               ao_panic(AO_PANIC_BT);
+       if ((P1DIR & (1 << 7)) != 0)
+               ao_panic(AO_PANIC_BT);
+       if ((P0SEL & ((1 << 5) | (1 << 4) | (1 << 3) | (1 << 2))) !=
+           ((1 << 5) | (1 << 4) | (1 << 3) | (1 << 2)))
+               ao_panic(AO_PANIC_BT);
+#endif
 #if HAS_BEEP
        ao_beep_for(AO_BEEP_MID, AO_MS_TO_TICKS(200));
 #endif
@@ -212,21 +236,6 @@ ao_btm(void)
 
 __xdata struct ao_task ao_btm_task;
 
-#if BT_LINK_ON_P2
-#define BT_PICTL_ICON  PICTL_P2ICON
-#define BT_PIFG                P2IFG
-#define BT_PDIR                P2DIR
-#define BT_PINP                P2INP
-#define BT_IEN2_PIE    IEN2_P2IE
-#endif
-#if BT_LINK_ON_P1
-#define BT_PICTL_ICON  PICTL_P1ICON
-#define BT_PIFG                P1IFG
-#define BT_PDIR                P1DIR
-#define BT_PINP                P1INP
-#define BT_IEN2_PIE    IEN2_P1IE
-#endif
-
 void
 ao_btm_check_link() __critical
 {