X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=target%2Fee%2Fee.c;h=9ea22cdcc41fe74081e0a94c9ea0c10c22afe1df;hp=ed13d0ad455e4655b525c6d4686ed7805e9436dd;hb=17d2432a8b9c15963cd3b821f025ad33972ef477;hpb=de1ac6f99a1526fa840a52cfc10fa3edc0589bed

diff --git a/target/ee/ee.c b/target/ee/ee.c
index ed13d0ad..9ea22cdc 100644
--- 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)
@@ -170,7 +174,7 @@ uint8_t
 bitbang_in_bit(void)
 {
 	uint8_t	b;
-	
+
 	delay(1);
 	SCK = 1;
 	delay(1);
@@ -274,6 +278,7 @@ usart_in_out(uint8_t byte)
 	while ((U0CSR & UxCSR_TX_BYTE) == 0)
 		;
 	U0CSR &= ~UxCSR_TX_BYTE;
+	return U0DBUF;
 }
 
 void
@@ -314,7 +319,7 @@ wrsr(uint8_t status)
 	spi_out_byte(status);
 	spi_cs(1);
 }
-	
+
 void
 wren(void)
 {
@@ -378,7 +383,9 @@ main ()
 
 	P1DIR |= 2;
 	CLKCON = 0;
-	
+	while (!(SLEEP & SLEEP_XOSC_STB))
+		;
+
 	spi_init();
 
 	status = rdsr();