i2c: sh_mobile: refactor rx isr
Remove the do_while loop which was just there to have an easy exit with "break;" and replace it with if-else-blocks which should make the state machine clearer. Signed-off-by: Wolfram Sang <wsa+renesas@sang-engineering.com> Reviewed-by: Geert Uytterhoeven <geert+renesas@glider.be> Signed-off-by: Wolfram Sang <wsa@the-dreams.de>
This commit is contained in:
parent
0130e3bfa9
commit
63c5246003
|
@ -373,39 +373,31 @@ static int sh_mobile_i2c_isr_rx(struct sh_mobile_i2c_data *pd)
|
||||||
unsigned char data;
|
unsigned char data;
|
||||||
int real_pos;
|
int real_pos;
|
||||||
|
|
||||||
do {
|
real_pos = pd->pos - 2;
|
||||||
if (pd->pos == -1) {
|
|
||||||
i2c_op(pd, OP_TX_FIRST);
|
if (pd->pos == -1) {
|
||||||
break;
|
i2c_op(pd, OP_TX_FIRST);
|
||||||
|
} else if (pd->pos == 0) {
|
||||||
|
i2c_op(pd, OP_TX_TO_RX);
|
||||||
|
} else if (pd->pos == pd->msg->len) {
|
||||||
|
if (pd->stop_after_dma) {
|
||||||
|
/* Simulate PIO end condition after DMA transfer */
|
||||||
|
i2c_op(pd, OP_RX_STOP);
|
||||||
|
pd->pos++;
|
||||||
|
goto done;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (pd->pos == 0) {
|
if (real_pos < 0)
|
||||||
i2c_op(pd, OP_TX_TO_RX);
|
i2c_op(pd, OP_RX_STOP);
|
||||||
break;
|
else
|
||||||
}
|
data = i2c_op(pd, OP_RX_STOP_DATA);
|
||||||
|
} else if (real_pos >= 0) {
|
||||||
real_pos = pd->pos - 2;
|
data = i2c_op(pd, OP_RX);
|
||||||
|
}
|
||||||
if (pd->pos == pd->msg->len) {
|
|
||||||
if (pd->stop_after_dma) {
|
|
||||||
/* Simulate PIO end condition after DMA transfer */
|
|
||||||
i2c_op(pd, OP_RX_STOP);
|
|
||||||
pd->pos++;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (real_pos < 0)
|
|
||||||
i2c_op(pd, OP_RX_STOP);
|
|
||||||
else
|
|
||||||
data = i2c_op(pd, OP_RX_STOP_DATA);
|
|
||||||
} else if (real_pos >= 0) {
|
|
||||||
data = i2c_op(pd, OP_RX);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (real_pos >= 0)
|
|
||||||
pd->msg->buf[real_pos] = data;
|
|
||||||
} while (0);
|
|
||||||
|
|
||||||
|
if (real_pos >= 0)
|
||||||
|
pd->msg->buf[real_pos] = data;
|
||||||
|
done:
|
||||||
pd->pos++;
|
pd->pos++;
|
||||||
return pd->pos == (pd->msg->len + 2);
|
return pd->pos == (pd->msg->len + 2);
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue