i2c-bcm2708: fix stupid mistake

bootc · bootc · commit fe5ea84d2375 · 2012-05-19T21:43:42.000+01:00
This makes it actually work.

Signed-off-by: Chris Boot &lt;bootc@bootc.net&gt;
diff --git a/drivers/i2c/busses/i2c-bcm2708.c b/drivers/i2c/busses/i2c-bcm2708.c
@@ -166,6 +166,12 @@ static irqreturn_t bcm2708_i2c_interrupt(int irq, void *dev_id)
 	} else if (s & BSC_S_DONE) {
 		bi->nmsgs--;
 
+		/* drain the RX FIFO */
+		while (s & BSC_S_RXD) {
+			msg->buf[bi->pos++] = bcm2708_rd(bi, BSC_FIFO);
+			s = bcm2708_rd(bi, BSC_S);
+		};
+
 		bcm2708_bsc_reset(bi);
 
 		if (bi->nmsgs) {
