Wait for xtal to stabilize after changing to 24MHz

[fw/altos] / target / ee / ee.c

diff --git a/target/ee/ee.c b/target/ee/ee.c
index ed13d0ad455e4655b525c6d4686ed7805e9436dd..7cc47120394a68ec54112826231fa5f58f588559 100644 (file)
--- a/target/ee/ee.c
+++ b/target/ee/ee.c
@@ -26,6 +26,10 @@ sfr at 0x80 P0;
 sfr at 0x90 P1;
 sfr at 0xA0 P2;
 sfr at 0xC6 CLKCON;
+sfr at 0xbe SLEEP;
+
+# define SLEEP_USB_EN          (1 << 7)
+# define SLEEP_XOSC_STB                (1 << 6)
 
 sfr at 0xF1 PERCFG;
 #define PERCFG_T1CFG_ALT_1     (0 << 6)
@@ -274,6 +278,7 @@ usart_in_out(uint8_t byte)
        while ((U0CSR & UxCSR_TX_BYTE) == 0)
                ;
        U0CSR &= ~UxCSR_TX_BYTE;
+       return U0DBUF;
 }
 
 void
@@ -378,6 +383,8 @@ main ()
 
        P1DIR |= 2;
        CLKCON = 0;
+       while (!(SLEEP & SLEEP_XOSC_STB))
+               ;
        
        spi_init();