| /* |
| * Copyright (c) 2018, Nordic Semiconductor ASA |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| |
| #include <drivers/i2c.h> |
| #include <dt-bindings/i2c/i2c.h> |
| #include <nrfx_twim.h> |
| |
| #define LOG_DOMAIN "i2c_nrfx_twim" |
| #define LOG_LEVEL CONFIG_I2C_LOG_LEVEL |
| #include <logging/log.h> |
| LOG_MODULE_REGISTER(i2c_nrfx_twim); |
| |
| struct i2c_nrfx_twim_data { |
| struct k_sem transfer_sync; |
| struct k_sem completion_sync; |
| volatile nrfx_err_t res; |
| uint32_t dev_config; |
| #ifdef CONFIG_DEVICE_POWER_MANAGEMENT |
| u32_t pm_state; |
| #endif |
| }; |
| |
| struct i2c_nrfx_twim_config { |
| nrfx_twim_t twim; |
| nrfx_twim_config_t config; |
| }; |
| |
| static inline struct i2c_nrfx_twim_data *get_dev_data(struct device *dev) |
| { |
| return dev->driver_data; |
| } |
| |
| static inline |
| const struct i2c_nrfx_twim_config *get_dev_config(struct device *dev) |
| { |
| return dev->config->config_info; |
| } |
| |
| static int i2c_nrfx_twim_transfer(struct device *dev, struct i2c_msg *msgs, |
| u8_t num_msgs, u16_t addr) |
| { |
| int ret = 0; |
| |
| k_sem_take(&(get_dev_data(dev)->transfer_sync), K_FOREVER); |
| nrfx_twim_enable(&get_dev_config(dev)->twim); |
| |
| for (size_t i = 0; i < num_msgs; i++) { |
| if (I2C_MSG_ADDR_10_BITS & msgs[i].flags) { |
| ret = -ENOTSUP; |
| break; |
| } |
| |
| nrfx_twim_xfer_desc_t cur_xfer = { |
| .p_primary_buf = msgs[i].buf, |
| .primary_length = msgs[i].len, |
| .address = addr, |
| .type = (msgs[i].flags & I2C_MSG_READ) ? |
| NRFX_TWIM_XFER_RX : NRFX_TWIM_XFER_TX |
| }; |
| |
| nrfx_err_t res = nrfx_twim_xfer(&get_dev_config(dev)->twim, |
| &cur_xfer, |
| (msgs[i].flags & I2C_MSG_STOP) ? |
| 0 : NRFX_TWIM_FLAG_TX_NO_STOP); |
| if (res != NRFX_SUCCESS) { |
| if (res == NRFX_ERROR_BUSY) { |
| ret = -EBUSY; |
| break; |
| } else { |
| ret = -EIO; |
| break; |
| } |
| } |
| |
| k_sem_take(&(get_dev_data(dev)->completion_sync), K_FOREVER); |
| res = get_dev_data(dev)->res; |
| if (res != NRFX_SUCCESS) { |
| LOG_ERR("Error %d occurred for message %d", res, i); |
| ret = -EIO; |
| break; |
| } |
| } |
| |
| nrfx_twim_disable(&get_dev_config(dev)->twim); |
| k_sem_give(&(get_dev_data(dev)->transfer_sync)); |
| |
| return ret; |
| } |
| |
| static void event_handler(nrfx_twim_evt_t const *p_event, void *p_context) |
| { |
| struct device *dev = p_context; |
| struct i2c_nrfx_twim_data *dev_data = get_dev_data(dev); |
| |
| switch (p_event->type) { |
| case NRFX_TWIM_EVT_DONE: |
| dev_data->res = NRFX_SUCCESS; |
| break; |
| case NRFX_TWIM_EVT_ADDRESS_NACK: |
| dev_data->res = NRFX_ERROR_DRV_TWI_ERR_ANACK; |
| break; |
| case NRFX_TWIM_EVT_DATA_NACK: |
| dev_data->res = NRFX_ERROR_DRV_TWI_ERR_DNACK; |
| break; |
| default: |
| dev_data->res = NRFX_ERROR_INTERNAL; |
| break; |
| } |
| |
| k_sem_give(&dev_data->completion_sync); |
| } |
| |
| static int i2c_nrfx_twim_configure(struct device *dev, u32_t dev_config) |
| { |
| nrfx_twim_t const *inst = &(get_dev_config(dev)->twim); |
| |
| if (I2C_ADDR_10_BITS & dev_config) { |
| return -EINVAL; |
| } |
| |
| switch (I2C_SPEED_GET(dev_config)) { |
| case I2C_SPEED_STANDARD: |
| nrf_twim_frequency_set(inst->p_twim, NRF_TWIM_FREQ_100K); |
| break; |
| case I2C_SPEED_FAST: |
| nrf_twim_frequency_set(inst->p_twim, NRF_TWIM_FREQ_400K); |
| break; |
| default: |
| LOG_ERR("unsupported speed"); |
| return -EINVAL; |
| } |
| get_dev_data(dev)->dev_config = dev_config; |
| |
| return 0; |
| } |
| |
| static const struct i2c_driver_api i2c_nrfx_twim_driver_api = { |
| .configure = i2c_nrfx_twim_configure, |
| .transfer = i2c_nrfx_twim_transfer, |
| }; |
| |
| static int init_twim(struct device *dev) |
| { |
| nrfx_err_t result = nrfx_twim_init(&get_dev_config(dev)->twim, |
| &get_dev_config(dev)->config, |
| event_handler, |
| dev); |
| if (result != NRFX_SUCCESS) { |
| LOG_ERR("Failed to initialize device: %s", |
| dev->config->name); |
| return -EBUSY; |
| } |
| |
| #ifdef CONFIG_DEVICE_POWER_MANAGEMENT |
| get_dev_data(dev)->pm_state = DEVICE_PM_ACTIVE_STATE; |
| #endif |
| |
| return 0; |
| } |
| |
| #ifdef CONFIG_DEVICE_POWER_MANAGEMENT |
| static int twim_nrfx_pm_control(struct device *dev, u32_t ctrl_command, |
| void *context, device_pm_cb cb, void *arg) |
| { |
| int ret = 0; |
| |
| if (ctrl_command == DEVICE_PM_SET_POWER_STATE) { |
| u32_t new_state = *((const u32_t *)context); |
| |
| if (new_state != get_dev_data(dev)->pm_state) { |
| switch (new_state) { |
| case DEVICE_PM_ACTIVE_STATE: |
| init_twim(dev); |
| if (get_dev_data(dev)->dev_config) { |
| i2c_nrfx_twim_configure( |
| dev, |
| get_dev_data(dev)->dev_config); |
| } |
| break; |
| |
| case DEVICE_PM_LOW_POWER_STATE: |
| case DEVICE_PM_SUSPEND_STATE: |
| case DEVICE_PM_OFF_STATE: |
| nrfx_twim_uninit(&get_dev_config(dev)->twim); |
| break; |
| |
| default: |
| ret = -ENOTSUP; |
| } |
| if (!ret) { |
| get_dev_data(dev)->pm_state = new_state; |
| } |
| } |
| } else { |
| assert(ctrl_command == DEVICE_PM_GET_POWER_STATE); |
| *((u32_t *)context) = get_dev_data(dev)->pm_state; |
| } |
| |
| if (cb) { |
| cb(dev, ret, context, arg); |
| } |
| |
| return ret; |
| } |
| #endif /* CONFIG_DEVICE_POWER_MANAGEMENT */ |
| |
| #define I2C_NRFX_TWIM_INVALID_FREQUENCY ((nrf_twim_frequency_t)-1) |
| #define I2C_NRFX_TWIM_FREQUENCY(bitrate) \ |
| (bitrate == I2C_BITRATE_STANDARD ? NRF_TWIM_FREQ_100K \ |
| : bitrate == 250000 ? NRF_TWIM_FREQ_250K \ |
| : bitrate == I2C_BITRATE_FAST ? NRF_TWIM_FREQ_400K \ |
| : I2C_NRFX_TWIM_INVALID_FREQUENCY) |
| |
| #define I2C_NRFX_TWIM_DEVICE(idx) \ |
| BUILD_ASSERT_MSG( \ |
| I2C_NRFX_TWIM_FREQUENCY( \ |
| DT_NORDIC_NRF_TWIM_I2C_##idx##_CLOCK_FREQUENCY) \ |
| != I2C_NRFX_TWIM_INVALID_FREQUENCY, \ |
| "Wrong I2C " #idx " frequency setting in dts"); \ |
| static int twim_##idx##_init(struct device *dev) \ |
| { \ |
| IRQ_CONNECT(DT_NORDIC_NRF_TWIM_I2C_##idx##_IRQ_0, \ |
| DT_NORDIC_NRF_TWIM_I2C_##idx##_IRQ_0_PRIORITY, \ |
| nrfx_isr, nrfx_twim_##idx##_irq_handler, 0); \ |
| return init_twim(dev); \ |
| } \ |
| static struct i2c_nrfx_twim_data twim_##idx##_data = { \ |
| .transfer_sync = Z_SEM_INITIALIZER( \ |
| twim_##idx##_data.transfer_sync, 1, 1), \ |
| .completion_sync = Z_SEM_INITIALIZER( \ |
| twim_##idx##_data.completion_sync, 0, 1) \ |
| }; \ |
| static const struct i2c_nrfx_twim_config twim_##idx##z_config = { \ |
| .twim = NRFX_TWIM_INSTANCE(idx), \ |
| .config = { \ |
| .scl = DT_NORDIC_NRF_TWIM_I2C_##idx##_SCL_PIN, \ |
| .sda = DT_NORDIC_NRF_TWIM_I2C_##idx##_SDA_PIN, \ |
| .frequency = I2C_NRFX_TWIM_FREQUENCY( \ |
| DT_NORDIC_NRF_TWIM_I2C_##idx##_CLOCK_FREQUENCY)\ |
| } \ |
| }; \ |
| DEVICE_DEFINE(twim_##idx, \ |
| DT_NORDIC_NRF_TWIM_I2C_##idx##_LABEL, \ |
| twim_##idx##_init, \ |
| twim_nrfx_pm_control, \ |
| &twim_##idx##_data, \ |
| &twim_##idx##z_config, \ |
| POST_KERNEL, \ |
| CONFIG_I2C_INIT_PRIORITY, \ |
| &i2c_nrfx_twim_driver_api) |
| |
| #ifdef CONFIG_I2C_0_NRF_TWIM |
| I2C_NRFX_TWIM_DEVICE(0); |
| #endif |
| |
| #ifdef CONFIG_I2C_1_NRF_TWIM |
| I2C_NRFX_TWIM_DEVICE(1); |
| #endif |
| |
| #ifdef CONFIG_I2C_2_NRF_TWIM |
| I2C_NRFX_TWIM_DEVICE(2); |
| #endif |
| |
| #ifdef CONFIG_I2C_3_NRF_TWIM |
| I2C_NRFX_TWIM_DEVICE(3); |
| #endif |