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

diff --git a/bmc/bmc.c b/bmc/bmc.c
index c786032..4db28a6 100644
--- a/bmc/bmc.c
+++ b/bmc/bmc.c
@@ -1,32 +1,65 @@
 #include <avr/io.h>
+#include <avr/sleep.h>
 #include <avr/interrupt.h>
 #include <stdio.h>
 #include "usart.h"
 #include "i2c.h"
+#include "bmc.h"
 
-int main(void)
+uint8_t ipmb_csum(unsigned char *buf, int len)
 {
-	uint8_t pb = 0x00;
-	int8_t dir = 1;
-	volatile uint16_t i;
+	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();
 
-	sei();
+	printf("Waiting for I2C...\n");
 
-	printf("Hallo!\n");
+	sei();
 
 	while(1) {
-		pb += dir;
-		PORTB = pb;
-
-		for (i = 0; i < (pb<<5); i++) {}
-
-		if ((pb == 0) || (pb == 0xff))
-			dir = -dir;
+#if 1
+		sleep_mode();
+#endif
 	}
 
 	return 0;