esp32_i2c: allow to read many bytes

Co-authored-by: Ivan Grokhotkov <igrokhotkov@gmail.com>
espressif · May 18, 2023 · 5396d5c · 5396d5c
1 parent d13e182
commit 5396d5c
Showing 1 changed file with 9 additions and 2 deletions.
diff --git a/hw/i2c/esp32_i2c.c b/hw/i2c/esp32_i2c.c
@@ -210,8 +210,15 @@ static void esp32_i2c_do_transaction(Esp32I2CState * s)
                 break;
             }
             case I2C_OPCODE_READ: {
-                uint8_t data = i2c_recv(s->bus);
-                fifo8_push(&s->rx_fifo, data);
+                size_t length = FIELD_EX32(cmd, I2C_CMD, BYTE_NUM);
+                for (size_t nbytes = 0; nbytes < length; ++nbytes) {
+                    if (fifo8_num_free(&s->rx_fifo) == 0) {
+                        error_report("esp32_i2c: RX FIFO overflow");
+                    } else {
+                        uint8_t data = i2c_recv(s->bus);
+                        fifo8_push(&s->rx_fifo, data);
+                    }
+                }
                 break;
             }
             case I2C_OPCODE_STOP: