fix TWSTO thinko in i2c.c

[rsbs2] / bmc / bmc.c

#include <avr/io.h>
#include <avr/interrupt.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)
{
	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 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;
}