Update I2C_Wrapper.cpp

This commit is contained in:
Ben V. Brown
2025-01-11 12:50:17 +11:00
parent 05158321ba
commit be1536b82f

View File

@@ -40,10 +40,10 @@ bool FRToSI2C::Mem_Read(uint16_t DevAddress, uint16_t read_address, uint8_t *p_b
i2cCfg.data = p_buffer;
i2cCfg.subAddrSize = 1; // one byte address
taskENTER_CRITICAL();
vTaskSuspendAll();
/* --------------- */
err = I2C_MasterReceiveBlocking(I2C0_ID, &i2cCfg);
taskEXIT_CRITICAL();
xTaskResumeAll();
bool res = err == SUCCESS;
if (!res) {
I2C_Unstick();
@@ -65,10 +65,10 @@ bool FRToSI2C::Mem_Write(uint16_t DevAddress, uint16_t MemAddress, uint8_t *p_bu
i2cCfg.data = p_buffer;
i2cCfg.subAddrSize = 1; // one byte address
taskENTER_CRITICAL();
vTaskSuspendAll();
/* --------------- */
err = I2C_MasterSendBlocking(I2C0_ID, &i2cCfg);
taskEXIT_CRITICAL();
xTaskResumeAll();
bool res = err == SUCCESS;
if (!res) {
I2C_Unstick();