reset i2c cmd buffer before read/write

related to [issue
53](https://github.com/espressif/arduino-esp32/issues/53)
This commit is contained in:
me-no-dev 2016-11-17 00:46:56 +02:00
parent 6d097cd4b5
commit 7abb15ca62

View File

@ -112,6 +112,13 @@ void i2cSetCmd(i2c_t * i2c, uint8_t index, uint8_t op_code, uint8_t byte_num, bo
i2c->dev->command[index].op_code = op_code; i2c->dev->command[index].op_code = op_code;
} }
void i2cResetCmd(i2c_t * i2c){
int i;
for(i=0;i<16;i++){
i2c->dev->command[i].val = 0;
}
}
void i2cResetFiFo(i2c_t * i2c) void i2cResetFiFo(i2c_t * i2c)
{ {
i2c->dev->fifo_conf.tx_fifo_rst = 1; i2c->dev->fifo_conf.tx_fifo_rst = 1;
@ -138,6 +145,7 @@ i2c_err_t i2cWrite(i2c_t * i2c, uint16_t address, bool addr_10bit, uint8_t * dat
uint8_t dataSend = willSend; uint8_t dataSend = willSend;
i2cResetFiFo(i2c); i2cResetFiFo(i2c);
i2cResetCmd(i2c);
//CMD START //CMD START
i2cSetCmd(i2c, 0, I2C_CMD_RSTART, 0, false, false, false); i2cSetCmd(i2c, 0, I2C_CMD_RSTART, 0, false, false, false);
@ -222,6 +230,7 @@ i2c_err_t i2cRead(i2c_t * i2c, uint16_t address, bool addr_10bit, uint8_t * data
I2C_MUTEX_LOCK(); I2C_MUTEX_LOCK();
i2cResetFiFo(i2c); i2cResetFiFo(i2c);
i2cResetCmd(i2c);
//CMD START //CMD START
i2cSetCmd(i2c, 0, I2C_CMD_RSTART, 0, false, false, false); i2cSetCmd(i2c, 0, I2C_CMD_RSTART, 0, false, false, false);