Wait for xtal to stabilize after changing to 24MHz

diff --git a/target/ee/ee.c b/target/ee/ee.c
index 08d551370e8daa12223837e843f4c61ccb8f0e58..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)
@@ -379,6 +383,8 @@ main ()
 
        P1DIR |= 2;
        CLKCON = 0;
+       while (!(SLEEP & SLEEP_XOSC_STB))
+               ;
        
        spi_init();