decode packets

[rsbs2] / bmc / bmc.c

diff --git a/bmc/bmc.c b/bmc/bmc.c
index 06a38290da134ec7f51e1ff00f3ec14a090f1a2d..4db28a6fab3cb2c9408a38f7b39dcdd6da8cdc55 100644 (file)
--- a/bmc/bmc.c
+++ b/bmc/bmc.c
@@ -1,24 +1,66 @@
-#define F_CPU 1000000UL\r
-\r
-#include <avr/io.h>\r
-\r
-int main(void)\r
-{\r
-       uint8_t pb = 0x00;\r
-       int8_t dir = 1;\r
-       volatile uint16_t i;\r
-\r
-       DDRB = 0xff;\r
-\r
-       while(1) {\r
-               pb += dir;\r
-               PORTB = pb;\r
-\r
-               for (i = 0; i < (pb<<5); i++) {}\r
-\r
-               if ((pb == 0) || (pb == 0xff))\r
-                       dir = -dir;\r
-       }\r
-\r
-       return 0;\r
-}\r
+#include <avr/io.h>
+#include <avr/sleep.h>
+#include <avr/interrupt.h>
+#include <stdio.h>
+#include "usart.h"
+#include "i2c.h"
+#include "bmc.h"
+
+uint8_t ipmb_csum(unsigned char *buf, int len)
+{
+       uint8_t csum = 0x00;
+       int i;
+
+       for(i = 0; i < len; i++) {
+               csum += buf[i];
+       }
+
+       return -csum;
+}
+
+void decode_bmc_cmd(unsigned char *buf, int len)
+{
+       int i;
+
+       printf(">>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>\n");
+       printf("Connection Header:\n");
+       printf("\trs Slave Addr.: 0x%02x\n", buf[0]);
+       printf("\tnetFn: 0x%02x, LUN: 0x%02x\n", (buf[1]>>2)&0x3f, (buf[1] & 0x03));
+       printf("\tChecksum: 0x%02x (%s)\n", buf[2],
+               (buf[2] == ipmb_csum(buf, 2)) ? "OK" : "Wrong");
+       printf("Data:\n");
+       printf("\trq Slave Addr.: 0x%02x\n", buf[3]);
+       printf("\trqSeq: 0x%02x, rqLUN: 0x%02x\n", (buf[4]>>2)&0x3f, (buf[4] & 0x03));
+       printf("\tcmd: 0x%02x\n", buf[5]);
+       printf("\tData: ");
+       for(i = 6; i < (len - 1); i++) {
+               printf("0x%02x ", buf[i]);
+       }
+       printf("\n");
+       printf("\tChecksum: 0x%02x (%s)\n", buf[len-1],
+               (buf[len-1] == ipmb_csum(buf+3, len-4)) ? "OK" : "Wrong");
+       printf("<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<\n");
+}
+
+int main(void)
+{
+       DDRB = 0xff;
+       PORTB = 0xff;
+
+       usart_init();
+       printf("\n");
+
+       i2c_init();
+
+       printf("Waiting for I2C...\n");
+
+       sei();
+
+       while(1) {
+#if 1
+               sleep_mode();
+#endif
+       }
+
+       return 0;
+}