make sure i2c rxbuf does not overrun

[rsbs2] / bmc / i2c.c

diff --git a/bmc/i2c.c b/bmc/i2c.c
index f081991ad34c5c1b5a449b147fc527afe77af976..c5f587babaf1535549200513d9953a4fda53ac21 100644 (file)
--- a/bmc/i2c.c
+++ b/bmc/i2c.c
@@ -87,6 +87,11 @@ ISR (TWI_vect, ISR_BLOCK)
 #ifdef DEBUG
                        printf("I2C: Data received: 0x%02x\n", TWDR);
 #endif
+                       if (i2c_pos >= sizeof(i2c_databuf)) {
+                               TWCR_RESET;
+                               i2c_pos = 0x00;
+                               break;
+                       }
                        i2c_databuf[i2c_pos] = TWDR;
                        i2c_pos++;
                        TWCR_ACK;