remove DEBUG printouts from non-debug build

[rsbs2] / bmc / bmc.c

diff --git a/bmc/bmc.c b/bmc/bmc.c
index d7c5cdc95ec4d1c4028112f188b6547e7320b081..abe86e53751053c279eac5c38bc97006d8750375 100644 (file)
--- a/bmc/bmc.c
+++ b/bmc/bmc.c
@@ -1,30 +1,42 @@
 #include <avr/io.h>
-#include <avr/sleep.h>
 #include <avr/interrupt.h>
+#include <avr/sleep.h>
+#include <string.h>
 #include <stdio.h>
 #include "usart.h"
 #include "i2c.h"
+#include "ipmb.h"
+#include "chassis.h"
+#include "bmc.h"
 
 int main(void)
 {
-       DDRB = 0xff;
-       PORTB = 0xff;
+       uint8_t old_SREG;
+       unsigned char buf[12];
+       unsigned int len;
 
+       chassis_init();
        usart_init();
-       printf("\n");
-
        i2c_init();
 
-       printf("Waiting for I2C...\n");
-
        sei();
 
-       PORTB = 0xff;
-
        while(1) {
-#if 1
+#if 0
                sleep_mode();
 #endif
+               old_SREG = SREG;
+               cli();
+               if (i2c_done) {
+                       len = i2c_len;
+                       memcpy(buf, (unsigned char*)i2c_databuf, len);
+                       i2c_done = 0x00;
+                       SREG = old_SREG;
+
+                       decode_ipmb_pkt(buf, len);
+               } else {
+                       SREG = old_SREG;
+               }
        }
 
        return 0;