57 lines
1.9 KiB
C++
57 lines
1.9 KiB
C++
#include "i2c_device.h"
|
|
|
|
#include <esp_log.h>
|
|
#include <cstring>
|
|
|
|
#define TAG "I2cDevice"
|
|
|
|
|
|
I2cDevice::I2cDevice(i2c_master_bus_handle_t i2c_bus, uint8_t addr) {
|
|
i2c_device_config_t i2c_device_cfg = {
|
|
.dev_addr_length = I2C_ADDR_BIT_LEN_7,
|
|
.device_address = addr,
|
|
.scl_speed_hz = 400 * 1000,
|
|
.scl_wait_us = 0,
|
|
.flags = {
|
|
.disable_ack_check = 0,
|
|
},
|
|
};
|
|
ESP_ERROR_CHECK(i2c_master_bus_add_device(i2c_bus, &i2c_device_cfg, &i2c_device_));
|
|
assert(i2c_device_ != NULL);
|
|
}
|
|
|
|
void I2cDevice::WriteReg(uint8_t reg, uint8_t value) {
|
|
uint8_t buffer[2] = {reg, value};
|
|
esp_err_t ret = i2c_master_transmit(i2c_device_, buffer, 2, 100);
|
|
if (ret != ESP_OK) {
|
|
ESP_LOGE(TAG, "Failed to write register 0x%02X with value 0x%02X: %s", reg, value, esp_err_to_name(ret));
|
|
}
|
|
}
|
|
|
|
esp_err_t I2cDevice::WriteRegWithError(uint8_t reg, uint8_t value) {
|
|
uint8_t buffer[2] = {reg, value};
|
|
esp_err_t ret = i2c_master_transmit(i2c_device_, buffer, 2, 100);
|
|
if (ret != ESP_OK) {
|
|
ESP_LOGE(TAG, "Failed to write register 0x%02X with value 0x%02X: %s", reg, value, esp_err_to_name(ret));
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
uint8_t I2cDevice::ReadReg(uint8_t reg) {
|
|
uint8_t buffer[1];
|
|
esp_err_t ret = i2c_master_transmit_receive(i2c_device_, ®, 1, buffer, 1, 100);
|
|
if (ret != ESP_OK) {
|
|
ESP_LOGE(TAG, "Failed to read register 0x%02X: %s", reg, esp_err_to_name(ret));
|
|
return 0xFF; // 返回错误值
|
|
}
|
|
return buffer[0];
|
|
}
|
|
|
|
void I2cDevice::ReadRegs(uint8_t reg, uint8_t* buffer, size_t length) {
|
|
esp_err_t ret = i2c_master_transmit_receive(i2c_device_, ®, 1, buffer, length, 100);
|
|
if (ret != ESP_OK) {
|
|
ESP_LOGE(TAG, "Failed to read %zu bytes from register 0x%02X: %s", length, reg, esp_err_to_name(ret));
|
|
// 清零缓冲区以避免使用未初始化的数据
|
|
memset(buffer, 0, length);
|
|
}
|
|
} |