1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
| #include "i2c_device.h"
|
| #include <esp_log.h>
|
| #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_ERROR_CHECK(i2c_master_transmit(i2c_device_, buffer, 2, 100));
| }
|
| uint8_t I2cDevice::ReadReg(uint8_t reg) {
| uint8_t buffer[1];
| ESP_ERROR_CHECK(i2c_master_transmit_receive(i2c_device_, ®, 1, buffer, 1, 100));
| return buffer[0];
| }
|
| void I2cDevice::ReadRegs(uint8_t reg, uint8_t* buffer, size_t length) {
| ESP_ERROR_CHECK(i2c_master_transmit_receive(i2c_device_, ®, 1, buffer, length, 100));
| }
|
|
