altos: Hook up the P1 ISR for TeleBT v0.1 bt_link line

[fw/altos] / src / ao_btm.c

diff --git a/src/ao_btm.c b/src/ao_btm.c
index 241b3f6a5b053e489ef7362e93887313dac7a57a..172004e9c6aae746f0b30b64201c249e8ba1a57b 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,19 @@ 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
+
        /*
         * The first time we connect, the BTM-180 comes up at 19200 baud.
         * After that, it will remember and come up at 57600 baud. So, see
@@ -208,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
 {
@@ -240,6 +253,9 @@ ao_btm_check_link() __critical
 
 void
 ao_btm_isr(void)
+#if BT_LINK_ON_P1
+       __interrupt 15
+#endif
 {
        if (BT_PIFG & (1 << BT_LINK_PIN_INDEX)) {
                ao_btm_check_link();