fix lost wakeup and activate sleep mode

diff --git a/bmc/bmc.c b/bmc/bmc.c
index c96cf6a0bf4a867682535408ac99733cf970b8d7..a7217efb263fad6b886eb9df13351024f4e30417 100644 (file)
--- a/bmc/bmc.c
+++ b/bmc/bmc.c
@@ -9,9 +9,10 @@
 #include "chassis.h"
 #include "bmc.h"
 
 #include "chassis.h"
 #include "bmc.h"
 

+#define SLEEP_MODE
+

 int main(void)
 {
 int main(void)
 {

-       uint8_t old_SREG;

        unsigned char buf[24];
        unsigned int len;
 
        unsigned char buf[24];
        unsigned int len;
 


@@ -19,24 +20,31 @@ int main(void)
        usart_init();
        i2c_init();
 
        usart_init();
        i2c_init();
 

+       set_sleep_mode(SLEEP_MODE_IDLE);
+

        sei();
 
        while(1) {
        sei();
 
        while(1) {

-#if 0
-               sleep_mode();
-#endif
-               old_SREG = SREG;

                cli();
                cli();

-               if (i2c_done) {
+               while (i2c_done) {

                        len = i2c_len;
                        memcpy(buf, (unsigned char*)i2c_databuf, len);
                        i2c_done = 0x00;
                        len = i2c_len;
                        memcpy(buf, (unsigned char*)i2c_databuf, len);
                        i2c_done = 0x00;

-                       SREG = old_SREG;
+                       sei();

 
                        decode_ipmb_pkt(buf, len);
 
                        decode_ipmb_pkt(buf, len);

-               } else {
-                       SREG = old_SREG;
+
+                       cli();

                }
                }

+
+#ifdef SLEEP_MODE
+               sleep_enable();
+#endif
+               sei();
+#ifdef SLEEP_MODE
+               sleep_cpu();
+               sleep_disable();
+#endif

        }
 
        return 0;
        }
 
        return 0;