Primary Git Repository for the Zephyr Project. Zephyr is a new generation, scalable, optimized, secure RTOS for multiple hardware architectures.
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 
 
 
 

539 lines
18 KiB

/*
* Copyright (c) 2024 Renesas Electronics Corporation
*
* SPDX-License-Identifier: Apache-2.0
*/
#define DT_DRV_COMPAT renesas_rz_riic
#include <math.h>
#include <zephyr/drivers/i2c.h>
#include <zephyr/drivers/pinctrl.h>
#include <instances/rzg/r_riic_master.h>
#include <zephyr/logging/log.h>
LOG_MODULE_REGISTER(renesas_rz_riic);
typedef void (*init_func_t)(const struct device *dev);
struct i2c_rz_riic_config {
const struct pinctrl_dev_config *pin_config;
i2c_master_cfg_t *fsp_cfg;
riic_master_extended_cfg_t *riic_master_ext_cfg;
const i2c_master_api_t *fsp_api;
double rise_time_s;
double fall_time_s;
double duty_cycle_percent;
};
struct i2c_rz_riic_data {
i2c_master_ctrl_t *fsp_ctrl;
struct k_mutex bus_mutex;
struct k_sem complete_sem;
i2c_master_event_t event;
uint32_t dev_config;
};
/* IIC master clock setting calculation function. */
static void calc_riic_master_clock_setting(const struct device *dev, const uint32_t fsp_i2c_rate,
iic_master_clock_settings_t *clk_cfg);
/* FSP interruption handlers. */
void riic_master_rxi_isr(void);
void riic_master_txi_isr(void);
void riic_master_tei_isr(void);
void riic_master_naki_isr(void);
void riic_master_sti_isr(void);
void riic_master_spi_isr(void);
void riic_master_ali_isr(void);
void riic_master_tmoi_isr(void);
struct rz_riic_master_bitrate {
uint32_t bitrate;
uint32_t duty;
uint32_t divider;
uint32_t brl;
uint32_t brh;
double duty_error_percent;
};
static int i2c_rz_riic_configure(const struct device *dev, uint32_t dev_config)
{
const struct i2c_rz_riic_config *config = dev->config;
struct i2c_rz_riic_data *data = dev->data;
if (!(dev_config & I2C_MODE_CONTROLLER)) {
LOG_ERR("Only I2C Master mode supported.");
return -EIO;
}
switch (I2C_SPEED_GET(dev_config)) {
case I2C_SPEED_STANDARD:
config->fsp_cfg->rate = I2C_MASTER_RATE_STANDARD;
break;
case I2C_SPEED_FAST:
config->fsp_cfg->rate = I2C_MASTER_RATE_FAST;
break;
case I2C_SPEED_FAST_PLUS:
config->fsp_cfg->rate = I2C_MASTER_RATE_FASTPLUS;
break;
default:
LOG_ERR("%s: Invalid I2C speed rate flag: %d", __func__, I2C_SPEED_GET(dev_config));
return -EIO;
}
/* Recalc clock setting after updating config. */
calc_riic_master_clock_setting(dev, config->fsp_cfg->rate,
&config->riic_master_ext_cfg->clock_settings);
config->fsp_api->close(data->fsp_ctrl);
config->fsp_api->open(data->fsp_ctrl, config->fsp_cfg);
/* save current devconfig. */
data->dev_config = dev_config;
return 0;
}
static int i2c_rz_riic_get_config(const struct device *dev, uint32_t *dev_config)
{
struct i2c_rz_riic_data *data = (struct i2c_rz_riic_data *const)dev->data;
*dev_config = data->dev_config;
return 0;
}
#define OPERATION(msg) (((struct i2c_msg *)msg)->flags & I2C_MSG_RW_MASK)
static int i2c_rz_riic_transfer(const struct device *dev, struct i2c_msg *msgs, uint8_t num_msgs,
uint16_t addr)
{
const struct i2c_rz_riic_config *config = dev->config;
struct i2c_rz_riic_data *data = (struct i2c_rz_riic_data *const)dev->data;
struct i2c_msg *current, *next;
fsp_err_t err = FSP_SUCCESS;
int ret = 0;
if (!num_msgs) {
return 0;
}
/* Check for validity of all messages before transfer */
current = msgs;
/*
* Set I2C_MSG_RESTART flag on first message in order to send start
* condition
*/
current->flags |= I2C_MSG_RESTART;
for (int i = 1; i <= num_msgs; i++) {
if (i < num_msgs) {
next = current + 1;
/*
* Restart condition between messages
* of different directions is required
*/
if (OPERATION(current) != OPERATION(next)) {
if (!(next->flags & I2C_MSG_RESTART)) {
LOG_ERR("%s: Restart condition between messages of "
"different directions is required."
"Current/Total: [%d/%d]",
__func__, i, num_msgs);
ret = -EIO;
break;
}
}
/* Stop condition is only allowed on last message */
if (current->flags & I2C_MSG_STOP) {
LOG_ERR("%s: Invalid stop flag. Stop condition is only allowed on "
"last message. "
"Current/Total: [%d/%d]",
__func__, i, num_msgs);
ret = -EIO;
break;
}
} else {
current->flags |= I2C_MSG_STOP;
}
current++;
}
if (ret) {
return ret;
}
k_mutex_lock(&data->bus_mutex, K_FOREVER);
/* Set destination address with configured address mode before sending msg. */
i2c_master_addr_mode_t addr_mode = 0;
if (I2C_MSG_ADDR_10_BITS & data->dev_config) {
addr_mode = I2C_MASTER_ADDR_MODE_10BIT;
} else {
addr_mode = I2C_MASTER_ADDR_MODE_7BIT;
}
config->fsp_api->slaveAddressSet(data->fsp_ctrl, addr, addr_mode);
/* Process input `msgs`. */
current = msgs;
while (num_msgs > 0) {
if (num_msgs > 1) {
next = current + 1;
} else {
next = NULL;
}
if (current->flags & I2C_MSG_READ) {
err = config->fsp_api->read(data->fsp_ctrl, current->buf, current->len,
next != NULL &&
(next->flags & I2C_MSG_RESTART));
} else {
err = config->fsp_api->write(data->fsp_ctrl, current->buf, current->len,
next != NULL &&
(next->flags & I2C_MSG_RESTART));
}
if (err != FSP_SUCCESS) {
switch (err) {
case FSP_ERR_IN_USE:
LOG_ERR("%s: Bus busy condition. Another transfer was in progress.",
__func__);
break;
default:
/* Should not reach here. */
LOG_ERR("%s: Unknown error. FSP_ERR=%d\n", __func__, err);
break;
}
ret = -EIO;
goto RELEASE_BUS;
}
/* Wait for callback to return. */
k_sem_take(&data->complete_sem, K_FOREVER);
/* Handle event msg from callback. */
switch (data->event) {
case I2C_MASTER_EVENT_ABORTED:
LOG_ERR("%s: %s failed.", __func__,
(current->flags & I2C_MSG_READ) ? "Read" : "Write");
ret = -EIO;
goto RELEASE_BUS;
case I2C_MASTER_EVENT_RX_COMPLETE:
break;
case I2C_MASTER_EVENT_TX_COMPLETE:
break;
default:
break;
}
current++;
num_msgs--;
}
RELEASE_BUS:
k_mutex_unlock(&data->bus_mutex);
return ret;
}
static void i2c_rz_riic_callback(i2c_master_callback_args_t *p_args)
{
const struct device *dev = p_args->p_context;
struct i2c_rz_riic_data *data = dev->data;
data->event = p_args->event;
k_sem_give(&data->complete_sem);
}
static int i2c_rz_riic_init(const struct device *dev)
{
const struct i2c_rz_riic_config *config = dev->config;
struct i2c_rz_riic_data *data = dev->data;
fsp_err_t err = FSP_SUCCESS;
int ret = 0;
/* Configure dt provided device signals when available */
if (config->pin_config->state_cnt > 0) {
ret = pinctrl_apply_state(config->pin_config, PINCTRL_STATE_DEFAULT);
if (ret < 0) {
LOG_ERR("%s: pinctrl config failed.", __func__);
return ret;
}
}
k_mutex_init(&data->bus_mutex);
k_sem_init(&data->complete_sem, 0, 1);
switch (config->fsp_cfg->rate) {
case I2C_MASTER_RATE_STANDARD:
case I2C_MASTER_RATE_FAST:
case I2C_MASTER_RATE_FASTPLUS:
calc_riic_master_clock_setting(dev, config->fsp_cfg->rate,
&config->riic_master_ext_cfg->clock_settings);
config->riic_master_ext_cfg->timeout_mode = IIC_MASTER_TIMEOUT_MODE_SHORT;
config->riic_master_ext_cfg->timeout_scl_low = IIC_MASTER_TIMEOUT_SCL_LOW_ENABLED;
break;
default:
LOG_ERR("%s: Invalid I2C speed rate: %d", __func__, config->fsp_cfg->rate);
return -ENOTSUP;
}
err = config->fsp_api->open(data->fsp_ctrl, config->fsp_cfg);
if (err != FSP_SUCCESS) {
LOG_ERR("I2C initialization failed");
return -EIO;
}
return 0;
}
static void calc_riic_master_bitrate(const struct i2c_rz_riic_config *config,
uint32_t total_brl_brh, uint32_t brh, uint32_t divider,
struct rz_riic_master_bitrate *result)
{
const uint32_t noise_filter_stages = config->riic_master_ext_cfg->noise_filter_stage;
const double rise_time_s = config->rise_time_s;
const double fall_time_s = config->fall_time_s;
const double requested_duty = config->duty_cycle_percent;
const uint32_t peripheral_clock = R_FSP_SystemClockHzGet(FSP_PRIV_CLOCK_P0CLK);
uint32_t constant_add = 0;
/* A constant is added to BRL and BRH in all formulas. This constand is 3 + nf when CKS ==
* 0, or 2 + nf when CKS != 0.
*/
if (divider == 0) {
constant_add = 3 + noise_filter_stages;
} else {
/* All dividers other than 0 use an addition of 2 + noise_filter_stages. */
constant_add = 2 + noise_filter_stages;
}
/* Converts all divided numbers to double to avoid data loss. */
double divided_p0 = (peripheral_clock >> divider);
result->bitrate =
1 / ((total_brl_brh + 2 * constant_add) / divided_p0 + rise_time_s + fall_time_s);
result->duty =
100 *
((rise_time_s + ((brh + constant_add) / divided_p0)) /
(rise_time_s + fall_time_s + ((total_brl_brh + 2 * constant_add)) / divided_p0));
result->divider = divider;
result->brh = brh;
result->brl = total_brl_brh - brh;
result->duty_error_percent =
(result->duty > requested_duty ? (result->duty - requested_duty)
: (requested_duty - result->duty)) /
requested_duty;
}
static void calc_riic_master_clock_setting(const struct device *dev, const uint32_t fsp_i2c_rate,
iic_master_clock_settings_t *clk_cfg)
{
const struct i2c_rz_riic_config *config = dev->config;
const uint32_t noise_filter_stages = config->riic_master_ext_cfg->noise_filter_stage;
const double rise_time_s = config->rise_time_s;
const double fall_time_s = config->fall_time_s;
const uint32_t requested_duty = config->duty_cycle_percent;
const uint32_t peripheral_clock = R_FSP_SystemClockHzGet(FSP_PRIV_CLOCK_P0CLK);
uint32_t requested_bitrate = 0;
switch (fsp_i2c_rate) {
case I2C_MASTER_RATE_STANDARD:
case I2C_MASTER_RATE_FAST:
case I2C_MASTER_RATE_FASTPLUS:
requested_bitrate = fsp_i2c_rate;
break;
default:
LOG_ERR("%s: Invalid I2C speed rate: %d", __func__, fsp_i2c_rate);
return;
}
/* Start with maximum possible bitrate. */
uint32_t min_brh = noise_filter_stages + 1;
uint32_t min_brl_brh = 2 * min_brh;
struct rz_riic_master_bitrate bitrate = {};
calc_riic_master_bitrate(config, min_brl_brh, min_brh, 0, &bitrate);
/* Start with the smallest divider because it gives the most resolution. */
uint32_t constant_add = 3 + noise_filter_stages;
for (int temp_divider = 0; temp_divider <= 7; ++temp_divider) {
if (1 == temp_divider) {
/* All dividers other than 0 use an addition of 2 + noise_filter_stages. */
constant_add = 2 + noise_filter_stages;
}
/* If the requested bitrate cannot be achieved with this divider, continue. */
double divided_p0 = (peripheral_clock >> temp_divider);
uint32_t total_brl_brh =
ceil(((1 / (double)requested_bitrate) - (rise_time_s + fall_time_s)) *
divided_p0 -
(2 * constant_add));
if ((total_brl_brh > 62) || (total_brl_brh < min_brl_brh)) {
continue;
}
uint32_t temp_brh = total_brl_brh * requested_duty / 100;
if (temp_brh < min_brh) {
temp_brh = min_brh;
}
/* Calculate the actual bitrate and duty cycle. */
struct rz_riic_master_bitrate temp_bitrate = {};
calc_riic_master_bitrate(config, total_brl_brh, temp_brh, temp_divider,
&temp_bitrate);
/* Adjust duty cycle down if it helps. */
struct rz_riic_master_bitrate test_bitrate = temp_bitrate;
while (test_bitrate.duty > requested_duty) {
temp_brh -= 1;
if ((temp_brh < min_brh) || ((total_brl_brh - temp_brh) > 31)) {
break;
}
struct rz_riic_master_bitrate new_bitrate = {};
calc_riic_master_bitrate(config, total_brl_brh, temp_brh, temp_divider,
&new_bitrate);
if (new_bitrate.duty_error_percent < temp_bitrate.duty_error_percent) {
temp_bitrate = new_bitrate;
} else {
break;
}
}
/* Adjust duty cycle up if it helps. */
while (test_bitrate.duty < requested_duty) {
++temp_brh;
if ((temp_brh > total_brl_brh) || (temp_brh > 31) ||
((total_brl_brh - temp_brh) < min_brh)) {
break;
}
struct rz_riic_master_bitrate new_bitrate = {};
calc_riic_master_bitrate(config, total_brl_brh, temp_brh, temp_divider,
&new_bitrate);
if (new_bitrate.duty_error_percent < temp_bitrate.duty_error_percent) {
temp_bitrate = new_bitrate;
} else {
break;
}
}
if ((temp_bitrate.brh < 32) && (temp_bitrate.brl < 32)) {
/* Valid setting found. */
bitrate = temp_bitrate;
break;
}
}
clk_cfg->brl_value = bitrate.brl;
clk_cfg->brh_value = bitrate.brh;
clk_cfg->cks_value = bitrate.divider;
}
static DEVICE_API(i2c, i2c_rz_riic_driver_api) = {
.configure = i2c_rz_riic_configure,
.get_config = i2c_rz_riic_get_config,
.transfer = i2c_rz_riic_transfer,
};
#define I2C_RZG_IRQ_CONNECT(index, irq_name, isr) \
do { \
IRQ_CONNECT(DT_INST_IRQ_BY_NAME(index, irq_name, irq), \
DT_INST_IRQ_BY_NAME(index, irq_name, priority), isr, \
DEVICE_DT_INST_GET(index), 0); \
irq_enable(DT_INST_IRQ_BY_NAME(index, irq_name, irq)); \
} while (0)
#define I2C_RZG_CONFIG_FUNC(index) \
I2C_RZG_IRQ_CONNECT(index, rxi, riic_master_rxi_isr); \
I2C_RZG_IRQ_CONNECT(index, txi, riic_master_txi_isr); \
I2C_RZG_IRQ_CONNECT(index, tei, riic_master_tei_isr); \
I2C_RZG_IRQ_CONNECT(index, naki, riic_master_naki_isr); \
I2C_RZG_IRQ_CONNECT(index, sti, riic_master_sti_isr); \
I2C_RZG_IRQ_CONNECT(index, spi, riic_master_spi_isr); \
I2C_RZG_IRQ_CONNECT(index, ali, riic_master_ali_isr); \
I2C_RZG_IRQ_CONNECT(index, tmoi, riic_master_tmoi_isr);
#define I2C_RZG_RIIC_INIT(index) \
static const double RZG_RIIC_MASTER_DIV_TIME_NS = 1000000000; \
\
static riic_master_extended_cfg_t g_i2c_master##index##_extend = { \
.noise_filter_stage = DT_INST_PROP(index, noise_filter_stages), \
.naki_irq = DT_INST_IRQ_BY_NAME(index, naki, irq), \
.sti_irq = DT_INST_IRQ_BY_NAME(index, sti, irq), \
.spi_irq = DT_INST_IRQ_BY_NAME(index, spi, irq), \
.ali_irq = DT_INST_IRQ_BY_NAME(index, ali, irq), \
.tmoi_irq = DT_INST_IRQ_BY_NAME(index, tmoi, irq), \
}; \
\
static i2c_master_cfg_t g_i2c_master##index##_cfg = { \
.channel = DT_INST_PROP(index, channel), \
.rate = DT_INST_PROP(index, clock_frequency), \
.slave = 0x00, \
.addr_mode = I2C_MASTER_ADDR_MODE_7BIT, \
.p_transfer_tx = NULL, \
.p_transfer_rx = NULL, \
.p_callback = i2c_rz_riic_callback, \
.p_context = DEVICE_DT_GET(DT_DRV_INST(index)), \
.rxi_irq = DT_INST_IRQ_BY_NAME(index, rxi, irq), \
.txi_irq = DT_INST_IRQ_BY_NAME(index, txi, irq), \
.tei_irq = DT_INST_IRQ_BY_NAME(index, tei, irq), \
.ipl = DT_INST_IRQ_BY_NAME(index, rxi, priority), \
.p_extend = &g_i2c_master##index##_extend, \
}; \
\
PINCTRL_DT_INST_DEFINE(index); \
\
static struct i2c_rz_riic_config i2c_rz_riic_config_##index = { \
.pin_config = PINCTRL_DT_INST_DEV_CONFIG_GET(index), \
.fsp_cfg = &g_i2c_master##index##_cfg, \
.riic_master_ext_cfg = &g_i2c_master##index##_extend, \
.fsp_api = &g_i2c_master_on_iic, \
.rise_time_s = DT_INST_PROP(index, rise_time_ns) / RZG_RIIC_MASTER_DIV_TIME_NS, \
.fall_time_s = DT_INST_PROP(index, fall_time_ns) / RZG_RIIC_MASTER_DIV_TIME_NS, \
.duty_cycle_percent = DT_INST_PROP(index, duty_cycle_percent), \
}; \
\
static iic_master_instance_ctrl_t g_i2c_master##index##_ctrl; \
\
static struct i2c_rz_riic_data i2c_rz_riic_data_##index = { \
.fsp_ctrl = (i2c_master_ctrl_t *)&g_i2c_master##index##_ctrl, \
}; \
\
static int i2c_rz_riic_init_##index(const struct device *dev) \
{ \
I2C_RZG_CONFIG_FUNC(index) \
return i2c_rz_riic_init(dev); \
}; \
\
I2C_DEVICE_DT_INST_DEFINE(index, i2c_rz_riic_init_##index, NULL, \
&i2c_rz_riic_data_##index, &i2c_rz_riic_config_##index, \
PRE_KERNEL_2, CONFIG_I2C_INIT_PRIORITY, \
&i2c_rz_riic_driver_api);
DT_INST_FOREACH_STATUS_OKAY(I2C_RZG_RIIC_INIT)