|
|
|
@ -204,3 +204,57 @@ uint8_t SCCB_Write16(uint8_t slv_addr, uint16_t reg, uint8_t data)
@@ -204,3 +204,57 @@ uint8_t SCCB_Write16(uint8_t slv_addr, uint16_t reg, uint8_t data)
|
|
|
|
|
} |
|
|
|
|
return ret == ESP_OK ? 0 : -1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
uint16_t SCCB_Read_Addr16_Val16(uint8_t slv_addr, uint16_t reg) |
|
|
|
|
{ |
|
|
|
|
uint16_t data = 0; |
|
|
|
|
uint8_t *data_u8 = (uint8_t *)&data; |
|
|
|
|
esp_err_t ret = ESP_FAIL; |
|
|
|
|
uint16_t reg_htons = LITTLETOBIG(reg); |
|
|
|
|
uint8_t *reg_u8 = (uint8_t *)®_htons; |
|
|
|
|
i2c_cmd_handle_t cmd = i2c_cmd_link_create(); |
|
|
|
|
i2c_master_start(cmd); |
|
|
|
|
i2c_master_write_byte(cmd, ( slv_addr << 1 ) | WRITE_BIT, ACK_CHECK_EN); |
|
|
|
|
i2c_master_write_byte(cmd, reg_u8[0], ACK_CHECK_EN); |
|
|
|
|
i2c_master_write_byte(cmd, reg_u8[1], ACK_CHECK_EN); |
|
|
|
|
i2c_master_stop(cmd); |
|
|
|
|
ret = i2c_master_cmd_begin(sccb_i2c_port, cmd, 1000 / portTICK_RATE_MS); |
|
|
|
|
i2c_cmd_link_delete(cmd); |
|
|
|
|
if(ret != ESP_OK) return -1; |
|
|
|
|
|
|
|
|
|
cmd = i2c_cmd_link_create(); |
|
|
|
|
i2c_master_start(cmd); |
|
|
|
|
i2c_master_write_byte(cmd, ( slv_addr << 1 ) | READ_BIT, ACK_CHECK_EN); |
|
|
|
|
i2c_master_read_byte(cmd, &data_u8[1], ACK_VAL); |
|
|
|
|
i2c_master_read_byte(cmd, &data_u8[0], NACK_VAL); |
|
|
|
|
i2c_master_stop(cmd); |
|
|
|
|
ret = i2c_master_cmd_begin(sccb_i2c_port, cmd, 1000 / portTICK_RATE_MS); |
|
|
|
|
i2c_cmd_link_delete(cmd); |
|
|
|
|
if(ret != ESP_OK) { |
|
|
|
|
ESP_LOGE(TAG, "W [%04x]=%04x fail\n", reg, data); |
|
|
|
|
} |
|
|
|
|
return data; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
uint8_t SCCB_Write_Addr16_Val16(uint8_t slv_addr, uint16_t reg, uint16_t data) |
|
|
|
|
{ |
|
|
|
|
esp_err_t ret = ESP_FAIL; |
|
|
|
|
uint16_t reg_htons = LITTLETOBIG(reg); |
|
|
|
|
uint8_t *reg_u8 = (uint8_t *)®_htons; |
|
|
|
|
uint16_t data_htons = LITTLETOBIG(data); |
|
|
|
|
uint8_t *data_u8 = (uint8_t *)&data_htons; |
|
|
|
|
i2c_cmd_handle_t cmd = i2c_cmd_link_create(); |
|
|
|
|
i2c_master_start(cmd); |
|
|
|
|
i2c_master_write_byte(cmd, ( slv_addr << 1 ) | WRITE_BIT, ACK_CHECK_EN); |
|
|
|
|
i2c_master_write_byte(cmd, reg_u8[0], ACK_CHECK_EN); |
|
|
|
|
i2c_master_write_byte(cmd, reg_u8[1], ACK_CHECK_EN); |
|
|
|
|
i2c_master_write_byte(cmd, data_u8[0], ACK_CHECK_EN); |
|
|
|
|
i2c_master_write_byte(cmd, data_u8[1], ACK_CHECK_EN); |
|
|
|
|
i2c_master_stop(cmd); |
|
|
|
|
ret = i2c_master_cmd_begin(sccb_i2c_port, cmd, 1000 / portTICK_RATE_MS); |
|
|
|
|
i2c_cmd_link_delete(cmd); |
|
|
|
|
if(ret != ESP_OK) { |
|
|
|
|
ESP_LOGE(TAG, "W [%04x]=%04x fail\n", reg, data); |
|
|
|
|
} |
|
|
|
|
return ret == ESP_OK ? 0 : -1; |
|
|
|
|
} |
|
|
|
|