X-Git-Url: http://git.zerfleddert.de/cgi-bin/gitweb.cgi/rsbs2/blobdiff_plain/20ef0f397c40ec362d25b6349b3e3383e80fc2af..f9d5c6e0b95e763fb9900e1e7cd5114bc452dfb9:/bmc/bmc.c

diff --git a/bmc/bmc.c b/bmc/bmc.c
index 4db28a6..abe86e5 100644
--- a/bmc/bmc.c
+++ b/bmc/bmc.c
@@ -1,65 +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"
 
-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;
+	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();
 
 	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;