/* * Copyright (c) 2018, Nordic Semiconductor ASA * * SPDX-License-Identifier: Apache-2.0 */ #include #include #include #define LOG_DOMAIN "i2c_nrfx_twim" #define LOG_LEVEL CONFIG_I2C_LOG_LEVEL #include 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_I2C_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_I2C_I2C_##idx##_IRQ_0, \ DT_NORDIC_NRF_I2C_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_I2C_I2C_##idx##_SCL_PIN, \ .sda = DT_NORDIC_NRF_I2C_I2C_##idx##_SDA_PIN, \ .frequency = I2C_NRFX_TWIM_FREQUENCY( \ DT_NORDIC_NRF_I2C_I2C_##idx##_CLOCK_FREQUENCY) \ } \ }; \ DEVICE_DEFINE(twim_##idx, \ DT_NORDIC_NRF_I2C_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