control-components/components/ocs_io/i2c/target_esp32/master_store.cpp at a4f2d27d1775a320fd066bb3c9ba9d9d7c7e8a83 · tendry-lab/control-components · GitHub

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
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
/*
 * SPDX-FileCopyrightText: 2025 Tendry Lab
 * SPDX-License-Identifier: Apache-2.0
 */

#include <cstring>

#include "freertos/FreeRTOSConfig.h"

#include "driver/i2c_master.h"
#include "driver/i2c_types.h"

#include "ocs_core/log.h"
#include "ocs_io/i2c/target_esp32/master_store.h"
#include "ocs_io/i2c/target_esp32/master_transceiver.h"

namespace ocs {
namespace io {
namespace i2c {

namespace {

const char* log_tag = "i2c_master_store";

} // namespace

MasterStore::MasterStore(IStore::Params params) {
    i2c_master_bus_config_t config;
    memset(&config, 0, sizeof(config));

    config.clk_source = I2C_CLK_SRC_DEFAULT;
    config.i2c_port = I2C_NUM_0;
    config.sda_io_num = params.sda;
    config.scl_io_num = params.scl;
    config.glitch_ignore_cnt = 7;
    config.flags.enable_internal_pullup = true;

    ESP_ERROR_CHECK(i2c_new_master_bus(&config, &handle_));
}

IStore::ITransceiverPtr
MasterStore::add(const char* id, AddressLength len, Address addr, TransferSpeed speed) {
    i2c_device_config_t config;
    memset(&config, 0, sizeof(config));

#if SOC_I2C_SUPPORT_10BIT_ADDR
    if (len == AddressLength::Bit_10) {
        config.dev_addr_length = I2C_ADDR_BIT_LEN_10;
    } else {
        config.dev_addr_length = I2C_ADDR_BIT_LEN_7;
    }
#else  // !SOC_I2C_SUPPORT_10BIT_ADDR
    configASSERT(len == AddressLength::Bit_7);
    config.dev_addr_length = I2C_ADDR_BIT_LEN_7;
#endif // SOC_I2C_SUPPORT_10BIT_ADDR

    config.device_address = addr;

    if (speed == TransferSpeed::Fast) {
        config.scl_speed_hz = 400000;
    } else {
        config.scl_speed_hz = 100000;
    }

    i2c_master_dev_handle_t device = nullptr;

    auto err = i2c_master_bus_add_device(handle_, &config, &device);
    if (err != ESP_OK) {
        ocs_loge(log_tag, "i2c_master_bus_add_device() failed: id=%s err=%s", id,
                 esp_err_to_name(err));

        return nullptr;
    }

    auto device_ptr = MasterTransceiver::make_device_shared(device);
    configASSERT(device_ptr);

    return IStore::ITransceiverPtr(new (std::nothrow) MasterTransceiver(device_ptr, id));
}

MasterStore::~MasterStore() {
    ESP_ERROR_CHECK(i2c_del_master_bus(handle_));
}

} // namespace i2c
} // namespace io
} // namespace ocs