Since the __IO macro use has been removed, make the whole reg pointer volatile. This is similar to what is done in the gpio-davinci driver. Signed-off-by: Ayush Singh <ayush@beagleboard.org>
727 lines
24 KiB
C
727 lines
24 KiB
C
/* Copyright (C) 2024 BeagleBoard.org Foundation
|
|
* Copyright (C) 2024 Dhruv Menon <dhruvmenon1104@gmail.com>
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT ti_omap_i2c
|
|
#include <errno.h>
|
|
#include <zephyr/kernel.h>
|
|
#include <zephyr/device.h>
|
|
#include <zephyr/devicetree.h>
|
|
#include <zephyr/logging/log.h>
|
|
#include <zephyr/irq.h>
|
|
#include <zephyr/drivers/i2c.h>
|
|
#include <zephyr/drivers/pinctrl.h>
|
|
|
|
#ifdef CONFIG_I2C_OMAP_BUS_RECOVERY
|
|
#include "i2c_bitbang.h"
|
|
#endif /* CONFIG_I2C_OMAP_BUS_RECOVERY */
|
|
|
|
LOG_MODULE_REGISTER(omap_i2c, CONFIG_I2C_LOG_LEVEL);
|
|
|
|
#define I2C_OMAP_TIMEOUT 100U
|
|
/* OCP_SYSSTATUS bit definitions */
|
|
#define SYSS_RESETDONE_MASK BIT(0)
|
|
#define RETRY -1
|
|
#define I2C_BITRATE_FAST 400000
|
|
#define I2C_BITRATE_STANDARD 100000
|
|
|
|
/* I2C Registers */
|
|
typedef struct {
|
|
uint8_t RESERVED_0[0x10]; /**< Reserved, offset: 0x0 */
|
|
|
|
uint32_t SYSC; /**< System Configuration, offset: 0x10 */
|
|
uint8_t RESERVED_1[0x18]; /**< Reserved, offset: 0x14 - 0x2C */
|
|
uint32_t IRQENABLE_SET; /**< Interrupt Enable Set, offset: 0x2C */
|
|
uint8_t RESERVED_2[0x4]; /**< Reserved, offset: 0x30 - 0x34 */
|
|
uint32_t WE; /**< Wakeup Enable, offset: 0x34 */
|
|
uint8_t RESERVED_3[0x4C]; /**< Reserved, offset: 0x38 - 0x84 */
|
|
uint32_t IE; /**< Interrupt Enable (Legacy), offset: 0x84 */
|
|
uint32_t STAT; /**< Status, offset: 0x88 */
|
|
uint8_t RESERVED_4[0x4]; /**< Reserved, offset: 0x8C - 0x90 */
|
|
uint32_t SYSS; /**< System Status, offset: 0x90 */
|
|
uint32_t BUF; /**< Buffer, offset: 0x94 */
|
|
uint32_t CNT; /**< Data Count, offset: 0x98 */
|
|
uint32_t DATA; /**< Data Access, offset: 0x9C */
|
|
uint8_t RESERVED_5[0x4]; /**< Reserved, offset: 0xA0 - 0xA4 */
|
|
uint32_t CON; /**< Configuration, offset: 0xA4 */
|
|
uint32_t OA; /**< Own Address, offset: 0xA8 */
|
|
uint32_t SA; /**< Target Address, offset: 0xAC */
|
|
uint32_t PSC; /**< Clock Prescaler, offset: 0xB0 */
|
|
uint32_t SCLL; /**< SCL Low Time, offset: 0xB4 */
|
|
uint32_t SCLH; /**< SCL High Time, offset: 0xB8 */
|
|
uint32_t SYSTEST; /**< System Test, offset: 0xBC */
|
|
uint32_t BUFSTAT; /**< Buffer Status, offset: 0xC0 */
|
|
} i2c_omap_regs_t;
|
|
|
|
/* I2C Configuration Register (I2C_OMAP_CON) */
|
|
#define I2C_OMAP_CON_EN BIT(15) /* I2C module enable */
|
|
#define I2C_OMAP_CON_OPMODE_HS BIT(12) /* High Speed support */
|
|
#define I2C_OMAP_CON_MST BIT(10) /* Controller/target mode */
|
|
#define I2C_OMAP_CON_TRX BIT(9) /* TX/RX mode (controller only) */
|
|
#define I2C_OMAP_CON_STP BIT(1) /* Stop condition (controller only) */
|
|
#define I2C_OMAP_CON_STT BIT(0) /* Start condition (controller) */
|
|
|
|
/* I2C Buffer Configuration Register (I2C_OMAP_BUF): */
|
|
#define I2C_OMAP_BUF_RXFIF_CLR BIT(14) /* RX FIFO Clear */
|
|
#define I2C_OMAP_BUF_TXFIF_CLR BIT(6) /* TX FIFO Clear */
|
|
|
|
/* I2C Status Register (I2C_OMAP_STAT): */
|
|
#define I2C_OMAP_STAT_XDR BIT(14) /* TX Buffer draining */
|
|
#define I2C_OMAP_STAT_RDR BIT(13) /* RX Buffer draining */
|
|
#define I2C_OMAP_STAT_BB BIT(12) /* Bus busy */
|
|
#define I2C_OMAP_STAT_ROVR BIT(11) /* Receive overrun */
|
|
#define I2C_OMAP_STAT_XUDF BIT(10) /* Transmit underflow */
|
|
#define I2C_OMAP_STAT_AAS BIT(9) /* Address as target */
|
|
#define I2C_OMAP_STAT_XRDY BIT(4) /* Transmit data ready */
|
|
#define I2C_OMAP_STAT_RRDY BIT(3) /* Receive data ready */
|
|
#define I2C_OMAP_STAT_ARDY BIT(2) /* Register access ready */
|
|
#define I2C_OMAP_STAT_NACK BIT(1) /* No ack interrupt enable */
|
|
#define I2C_OMAP_STAT_AL BIT(0) /* Arbitration lost */
|
|
|
|
/* I2C System Test Register (I2C_OMAP_SYSTEST): */
|
|
#define I2C_OMAP_SYSTEST_ST_EN BIT(15) /* System test enable */
|
|
#define I2C_OMAP_SYSTEST_FREE BIT(14) /* Free running mode */
|
|
#define I2C_OMAP_SYSTEST_TMODE_MASK (3 << 12) /* Test mode select mask */
|
|
#define I2C_OMAP_SYSTEST_TMODE_SHIFT (12) /* Test mode select shift */
|
|
|
|
/* Functional mode */
|
|
#define I2C_OMAP_SYSTEST_SCL_I_FUNC BIT(8) /* SCL line input value */
|
|
#define I2C_OMAP_SYSTEST_SDA_I_FUNC BIT(6) /* SDA line input value */
|
|
|
|
/* SDA/SCL IO mode */
|
|
#define I2C_OMAP_SYSTEST_SCL_I BIT(3) /* SCL line sense in */
|
|
#define I2C_OMAP_SYSTEST_SCL_O BIT(2) /* SCL line drive out */
|
|
#define I2C_OMAP_SYSTEST_SDA_I BIT(1) /* SDA line sense in */
|
|
#define I2C_OMAP_SYSTEST_SDA_O BIT(0) /* SDA line drive out */
|
|
|
|
typedef void (*init_func_t)(const struct device *dev);
|
|
#define DEV_CFG(dev) ((const struct i2c_omap_cfg *)(dev)->config)
|
|
#define DEV_DATA(dev) ((struct i2c_omap_data *)(dev)->data)
|
|
#define DEV_I2C_BASE(dev) ((volatile i2c_omap_regs_t *)DEVICE_MMIO_GET(dev))
|
|
|
|
struct i2c_omap_cfg {
|
|
DEVICE_MMIO_ROM;
|
|
uint32_t irq;
|
|
uint32_t speed;
|
|
const struct pinctrl_dev_config *pcfg;
|
|
};
|
|
|
|
enum i2c_omap_speed {
|
|
I2C_OMAP_SPEED_STANDARD,
|
|
I2C_OMAP_SPEED_FAST,
|
|
I2C_OMAP_SPEED_FAST_PLUS,
|
|
};
|
|
|
|
struct i2c_omap_speed_config {
|
|
uint32_t pscstate;
|
|
uint32_t scllstate;
|
|
uint32_t sclhstate;
|
|
};
|
|
|
|
struct i2c_omap_data {
|
|
DEVICE_MMIO_RAM;
|
|
enum i2c_omap_speed speed;
|
|
struct i2c_omap_speed_config speed_config;
|
|
struct i2c_msg current_msg;
|
|
struct k_sem lock;
|
|
bool receiver;
|
|
bool bb_valid;
|
|
};
|
|
|
|
/**
|
|
* @brief Initializes the OMAP I2C driver.
|
|
*
|
|
* This function is responsible for initializing the OMAP I2C driver.
|
|
*
|
|
* @param dev Pointer to the device structure for the I2C driver instance.
|
|
*/
|
|
static void i2c_omap_init_ll(const struct device *dev)
|
|
{
|
|
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
|
|
i2c_base_addr->CON = 0;
|
|
i2c_base_addr->PSC = data->speed_config.pscstate;
|
|
i2c_base_addr->SCLL = data->speed_config.scllstate;
|
|
i2c_base_addr->SCLH = data->speed_config.sclhstate;
|
|
i2c_base_addr->CON = I2C_OMAP_CON_EN;
|
|
}
|
|
|
|
/**
|
|
* @brief Reset the OMAP I2C controller.
|
|
*
|
|
* This function resets the OMAP I2C controller specified by the device pointer.
|
|
*
|
|
* @param dev Pointer to the device structure for the I2C controller.
|
|
* @return 0 on success, negative errno code on failure.
|
|
*/
|
|
static int i2c_omap_reset(const struct device *dev)
|
|
{
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
uint64_t timeout;
|
|
uint16_t sysc;
|
|
|
|
sysc = i2c_base_addr->SYSC;
|
|
i2c_base_addr->CON &= ~I2C_OMAP_CON_EN;
|
|
timeout = k_uptime_get() + I2C_OMAP_TIMEOUT;
|
|
i2c_base_addr->CON = I2C_OMAP_CON_EN;
|
|
while (!(i2c_base_addr->SYSS & SYSS_RESETDONE_MASK)) {
|
|
if (k_uptime_get() > timeout) {
|
|
LOG_WRN("timeout waiting for controller reset");
|
|
return -ETIMEDOUT;
|
|
}
|
|
k_busy_wait(100);
|
|
}
|
|
i2c_base_addr->SYSC = sysc;
|
|
data->bb_valid = 0;
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @brief Set the speed of the OMAP I2C controller.
|
|
*
|
|
* This function sets the speed of the OMAP I2C controller based on the
|
|
* specified speed parameter. The speed can be set to either Fast mode or
|
|
* Standard mode.
|
|
*
|
|
* @param dev The pointer to the device structure.
|
|
* @param speed The desired speed for the I2C controller.
|
|
*
|
|
* @return 0 on success, negative error code on failure.
|
|
*/
|
|
static int i2c_omap_set_speed(const struct device *dev, uint32_t speed)
|
|
{
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
|
|
/* If configured for High Speed */
|
|
switch (speed) {
|
|
case I2C_BITRATE_FAST:
|
|
/* Fast mode */
|
|
data->speed_config = (struct i2c_omap_speed_config){
|
|
.pscstate = 9,
|
|
.scllstate = 7,
|
|
.sclhstate = 5,
|
|
};
|
|
break;
|
|
case I2C_BITRATE_STANDARD:
|
|
/* Standard mode */
|
|
data->speed_config = (struct i2c_omap_speed_config){
|
|
.pscstate = 23,
|
|
.scllstate = 13,
|
|
.sclhstate = 15,
|
|
};
|
|
break;
|
|
default:
|
|
return -ERANGE;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @brief Configure the OMAP I2C controller with the specified device configuration.
|
|
*
|
|
* This function configures the OMAP I2C controller with the specified device configuration.
|
|
*
|
|
* @param dev The pointer to the device structure.
|
|
* @param dev_config The device configuration to be applied.
|
|
*
|
|
* @return 0 on success, negative error code on failure.
|
|
*/
|
|
static int i2c_omap_configure(const struct device *dev, uint32_t dev_config)
|
|
{
|
|
uint32_t speed_cfg = I2C_BITRATE_STANDARD;
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
|
|
switch (I2C_SPEED_GET(dev_config)) {
|
|
case I2C_SPEED_STANDARD:
|
|
speed_cfg = I2C_BITRATE_STANDARD;
|
|
break;
|
|
case I2C_SPEED_FAST:
|
|
speed_cfg = I2C_BITRATE_FAST;
|
|
break;
|
|
default:
|
|
return -ENOTSUP;
|
|
}
|
|
if ((dev_config & I2C_MODE_CONTROLLER) != I2C_MODE_CONTROLLER) {
|
|
return -ENOTSUP;
|
|
}
|
|
k_sem_take(&data->lock, K_FOREVER);
|
|
i2c_omap_set_speed(dev, speed_cfg);
|
|
i2c_omap_init_ll(dev);
|
|
k_sem_give(&data->lock);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @brief Transmit or receive data over I2C bus
|
|
*
|
|
* This function transmits or receives data over the I2C bus using the OMAP I2C controller.
|
|
*
|
|
* @param dev Pointer to the I2C device structure
|
|
* @param num_bytes Number of bytes to transmit or receive
|
|
*/
|
|
static void i2c_omap_transmit_receive_data(const struct device *dev, uint8_t num_bytes)
|
|
{
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
uint8_t *buf_ptr = data->current_msg.buf;
|
|
|
|
while (num_bytes--) {
|
|
if (data->receiver) {
|
|
*buf_ptr++ = i2c_base_addr->DATA;
|
|
} else {
|
|
i2c_base_addr->DATA = *(buf_ptr++);
|
|
}
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Resize the FIFO buffer for the OMAP I2C controller.
|
|
*
|
|
* This function resizes the FIFO buffer for the OMAP I2C controller based on the specified size.
|
|
* It clears the RX threshold and sets the new size for the receiver, or clears the TX threshold
|
|
* and sets the new size for the transmitter.
|
|
*
|
|
* @param dev Pointer to the device structure.
|
|
* @param size The new size of the FIFO buffer.
|
|
*/
|
|
static void i2c_omap_resize_fifo(const struct device *dev, uint8_t size)
|
|
{
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
|
|
if (data->receiver) {
|
|
i2c_base_addr->BUF &= I2C_OMAP_BUF_RXFIF_CLR;
|
|
i2c_base_addr->BUF |= ((size) << 8) | I2C_OMAP_BUF_RXFIF_CLR;
|
|
} else {
|
|
i2c_base_addr->BUF &= I2C_OMAP_BUF_TXFIF_CLR;
|
|
i2c_base_addr->BUF |= (size) | I2C_OMAP_BUF_TXFIF_CLR;
|
|
}
|
|
}
|
|
|
|
#ifdef CONFIG_I2C_OMAP_BUS_RECOVERY
|
|
/**
|
|
* @brief Get the state of the SDA line.
|
|
*
|
|
* This function retrieves the state of the SDA (data) line for the OMAP I2C controller.
|
|
*
|
|
* @param io_context The I2C context.
|
|
* @return The state of the SDA line.
|
|
*/
|
|
static int i2c_omap_get_sda(void *io_context)
|
|
{
|
|
const struct device *dev = io_context;
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
|
|
return (i2c_base_addr->SYSTEST & I2C_OMAP_SYSTEST_SDA_I_FUNC) ? 1 : 0;
|
|
}
|
|
|
|
/**
|
|
* @brief Set the state of the SDA line.
|
|
*
|
|
* This function sets the state of the SDA (data) line for the OMAP I2C controller.
|
|
*
|
|
* @param io_context The I2C context.
|
|
* @param state The state to set (0 for low, 1 for high).
|
|
*/
|
|
static void i2c_omap_set_sda(void *io_context, int state)
|
|
{
|
|
const struct device *dev = io_context;
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
|
|
if (state) {
|
|
i2c_base_addr->SYSTEST |= I2C_OMAP_SYSTEST_SDA_O;
|
|
} else {
|
|
i2c_base_addr->SYSTEST &= ~I2C_OMAP_SYSTEST_SDA_O;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Set the state of the SCL line.
|
|
*
|
|
* This function sets the state of the SCL (clock) line for the OMAP I2C controller.
|
|
*
|
|
* @param io_context The I2C context.
|
|
* @param state The state to set (0 for low, 1 for high).
|
|
*/
|
|
static void i2c_omap_set_scl(void *io_context, int state)
|
|
{
|
|
const struct device *dev = io_context;
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
|
|
if (state) {
|
|
i2c_base_addr->SYSTEST |= I2C_OMAP_SYSTEST_SCL_O;
|
|
} else {
|
|
i2c_base_addr->SYSTEST &= ~I2C_OMAP_SYSTEST_SCL_O;
|
|
}
|
|
}
|
|
/**
|
|
* @brief Recovers the I2C bus using the OMAP I2C controller.
|
|
*
|
|
* This function attempts to recover the I2C bus by performing a bus recovery
|
|
* sequence using the OMAP I2C controller. It uses the provided device
|
|
* configuration and bit-banging operations to recover the bus.
|
|
*
|
|
* @param dev Pointer to the device structure.
|
|
* @return 0 on success, negative error code on failure.
|
|
*/
|
|
|
|
static int i2c_omap_recover_bus(const struct device *dev)
|
|
{
|
|
const struct i2c_omap_cfg *cfg = DEV_CFG(dev);
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
|
|
struct i2c_bitbang bitbang_omap;
|
|
struct i2c_bitbang_io bitbang_omap_io = {
|
|
.get_sda = i2c_omap_get_sda,
|
|
.set_scl = i2c_omap_set_scl,
|
|
.set_sda = i2c_omap_set_sda,
|
|
};
|
|
int error = 0;
|
|
|
|
k_sem_take(&data->lock, K_FOREVER);
|
|
i2c_base_addr->SYSTEST |= I2C_OMAP_SYSTEST_ST_EN | (3 << I2C_OMAP_SYSTEST_TMODE_SHIFT) |
|
|
I2C_OMAP_SYSTEST_SCL_O | I2C_OMAP_SYSTEST_SDA_O;
|
|
i2c_bitbang_init(&bitbang_omap, &bitbang_omap_io, (void *)dev);
|
|
error = i2c_bitbang_recover_bus(&bitbang_omap);
|
|
if (error != 0) {
|
|
LOG_ERR("failed to recover bus (err %d)", error);
|
|
goto restore;
|
|
}
|
|
|
|
restore:
|
|
i2c_base_addr->SYSTEST &= ~(I2C_OMAP_SYSTEST_ST_EN | I2C_OMAP_SYSTEST_TMODE_MASK |
|
|
I2C_OMAP_SYSTEST_SCL_O | I2C_OMAP_SYSTEST_SDA_O);
|
|
i2c_omap_reset(dev);
|
|
k_sem_give(&data->lock);
|
|
return error;
|
|
}
|
|
#endif /* CONFIG_I2C_OMAP_BUS_RECOVERY */
|
|
|
|
/**
|
|
* @brief Wait for the bus to become free (no longer busy).
|
|
*
|
|
* This function waits for the bus to become free by continuously checking the
|
|
* status register of the OMAP I2C controller. If the bus remains busy for a
|
|
* certain timeout period, the function will return attempts to recover the bus by calling
|
|
* i2c_omap_recover_bus().
|
|
*
|
|
* @param dev The I2C device structure.
|
|
* @return 0 if the bus becomes free, or a negative error code if the bus cannot
|
|
* be recovered.
|
|
*/
|
|
static int i2c_omap_wait_for_bb(const struct device *dev)
|
|
{
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
uint32_t timeout = k_uptime_get_32() + I2C_OMAP_TIMEOUT;
|
|
|
|
while (i2c_base_addr->STAT & I2C_OMAP_STAT_BB) {
|
|
if (k_uptime_get_32() > timeout) {
|
|
LOG_ERR("Bus busy timeout");
|
|
#ifdef CONFIG_I2C_OMAP_BUS_RECOVERY
|
|
return i2c_omap_recover_bus(dev);
|
|
#else
|
|
return -ETIMEDOUT;
|
|
#endif /* CONFIG_I2C_OMAP_BUS_RECOVERY */
|
|
}
|
|
k_busy_wait(100);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @brief Performs data transfer for the OMAP I2C driver.
|
|
*
|
|
* This function is responsible for handling the data transfer logic for the OMAP I2C driver.
|
|
* It reads the status register and performs the necessary actions based on the status flags.
|
|
* It handles both receive and transmit logic, and also handles error conditions such as NACK,
|
|
* arbitration lost, receive overrun, and transmit underflow.
|
|
*
|
|
* @param dev Pointer to the device structure.
|
|
*
|
|
* @return Returns 0 on success, or a negative error code on failure.
|
|
*/
|
|
static int i2c_omap_transfer_message_ll(const struct device *dev)
|
|
{
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
uint16_t stat = i2c_base_addr->STAT, result = 0;
|
|
|
|
if (data->receiver) {
|
|
stat &= ~(I2C_OMAP_STAT_XDR | I2C_OMAP_STAT_XRDY);
|
|
} else {
|
|
stat &= ~(I2C_OMAP_STAT_RDR | I2C_OMAP_STAT_RRDY);
|
|
}
|
|
if (stat & I2C_OMAP_STAT_NACK) {
|
|
result |= I2C_OMAP_STAT_NACK;
|
|
i2c_base_addr->STAT |= I2C_OMAP_STAT_NACK;
|
|
}
|
|
if (stat & I2C_OMAP_STAT_AL) {
|
|
result |= I2C_OMAP_STAT_AL;
|
|
i2c_base_addr->STAT |= I2C_OMAP_STAT_AL;
|
|
}
|
|
if (stat & I2C_OMAP_STAT_ARDY) {
|
|
i2c_base_addr->STAT |= I2C_OMAP_STAT_ARDY;
|
|
}
|
|
if (stat & (I2C_OMAP_STAT_ARDY | I2C_OMAP_STAT_NACK | I2C_OMAP_STAT_AL)) {
|
|
|
|
i2c_base_addr->STAT |=
|
|
(I2C_OMAP_STAT_RRDY | I2C_OMAP_STAT_RDR | I2C_OMAP_STAT_XRDY |
|
|
I2C_OMAP_STAT_XDR | I2C_OMAP_STAT_ARDY);
|
|
return result;
|
|
}
|
|
|
|
/* Handle receive logic */
|
|
if (stat & (I2C_OMAP_STAT_RRDY | I2C_OMAP_STAT_RDR)) {
|
|
int buffer =
|
|
(stat & I2C_OMAP_STAT_RRDY) ? i2c_base_addr->BUF : i2c_base_addr->BUFSTAT;
|
|
i2c_omap_transmit_receive_data(dev, buffer);
|
|
i2c_base_addr->STAT |=
|
|
(stat & I2C_OMAP_STAT_RRDY) ? I2C_OMAP_STAT_RRDY : I2C_OMAP_STAT_RDR;
|
|
return RETRY;
|
|
}
|
|
|
|
/* Handle transmit logic */
|
|
if (stat & (I2C_OMAP_STAT_XRDY | I2C_OMAP_STAT_XDR)) {
|
|
int buffer =
|
|
(stat & I2C_OMAP_STAT_XRDY) ? i2c_base_addr->BUF : i2c_base_addr->BUFSTAT;
|
|
i2c_omap_transmit_receive_data(dev, buffer);
|
|
i2c_base_addr->STAT |=
|
|
(stat & I2C_OMAP_STAT_XRDY) ? I2C_OMAP_STAT_XRDY : I2C_OMAP_STAT_XDR;
|
|
return RETRY;
|
|
}
|
|
|
|
if (stat & I2C_OMAP_STAT_ROVR) {
|
|
i2c_base_addr->STAT |= I2C_OMAP_STAT_ROVR;
|
|
return I2C_OMAP_STAT_ROVR;
|
|
}
|
|
if (stat & I2C_OMAP_STAT_XUDF) {
|
|
i2c_base_addr->STAT |= I2C_OMAP_STAT_XUDF;
|
|
return I2C_OMAP_STAT_XUDF;
|
|
}
|
|
return RETRY;
|
|
}
|
|
|
|
/**
|
|
* @brief Performs an I2C transfer of a single message.
|
|
*
|
|
* This function is responsible for performing an I2C transfer of a single message.
|
|
* It sets up the necessary configurations, writes the target device address,
|
|
* sets the buffer and buffer length, and handles various error conditions.
|
|
*
|
|
* @param dev The I2C device structure.
|
|
* @param msg Pointer to the I2C message structure.
|
|
* @param polling Flag indicating whether to use polling mode or not.
|
|
* @param addr The target device address.
|
|
*
|
|
* @return 0 on success, negative error code on failure.
|
|
* Possible error codes include:
|
|
* - ETIMEDOUT: Timeout occurred during the transfer.
|
|
* - EIO: I/O error due to receiver overrun or transmit underflow.
|
|
* - EAGAIN: Arbitration lost error, try again.
|
|
* - ENOMSG: Message error due to NACK.
|
|
*/
|
|
static int i2c_omap_transfer_message(const struct device *dev, struct i2c_msg *msg, bool polling,
|
|
uint16_t addr)
|
|
{
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
volatile i2c_omap_regs_t *i2c_base_addr = DEV_I2C_BASE(dev);
|
|
unsigned long time_left = 1000;
|
|
uint16_t control_reg;
|
|
int result = 0;
|
|
/* Determine message direction (read or write) and update the receiver flag */
|
|
data->receiver = msg->flags & I2C_MSG_READ;
|
|
/* Adjust the FIFO size according to the message length */
|
|
i2c_omap_resize_fifo(dev, msg->len);
|
|
/* Set the target I2C address for the transfer */
|
|
i2c_base_addr->SA = addr;
|
|
/* Store the message in the data structure */
|
|
data->current_msg = *msg;
|
|
/* Set the message length in the I2C controller */
|
|
i2c_base_addr->CNT = msg->len;
|
|
/* Clear FIFO buffers */
|
|
control_reg = i2c_base_addr->BUF;
|
|
control_reg |= I2C_OMAP_BUF_RXFIF_CLR | I2C_OMAP_BUF_TXFIF_CLR;
|
|
i2c_base_addr->BUF = control_reg;
|
|
/* If we're not polling, reset the command completion semaphore */
|
|
if (!polling) {
|
|
k_sem_reset(&data->lock);
|
|
}
|
|
/* Reset the command error status */
|
|
/* Prepare the control register for the I2C operation */
|
|
control_reg = I2C_OMAP_CON_EN | I2C_OMAP_CON_MST | I2C_OMAP_CON_STT;
|
|
/* Enable high-speed mode if required by the transfer speed */
|
|
if (data->speed > I2C_BITRATE_FAST) {
|
|
control_reg |= I2C_OMAP_CON_OPMODE_HS;
|
|
}
|
|
/* Set the STOP condition if it's specified in the message flags */
|
|
if (msg->flags & I2C_MSG_STOP) {
|
|
control_reg |= I2C_OMAP_CON_STP;
|
|
}
|
|
/* Set the transmission mode based on whether it's a read or write operation */
|
|
if (!(msg->flags & I2C_MSG_READ)) {
|
|
control_reg |= I2C_OMAP_CON_TRX;
|
|
}
|
|
/* Start the I2C transfer by writing the control register */
|
|
i2c_base_addr->CON = control_reg;
|
|
/* Poll for status until the transfer is complete */
|
|
/* Call a lower-level function to continue the transfer */
|
|
do {
|
|
result = i2c_omap_transfer_message_ll(dev);
|
|
time_left--;
|
|
} while (result == RETRY && time_left);
|
|
|
|
/* If no errors occurred, return success */
|
|
if (!result) {
|
|
return 0;
|
|
}
|
|
|
|
/* Handle timeout or specific error conditions */
|
|
if (result & (I2C_OMAP_STAT_ROVR | I2C_OMAP_STAT_XUDF)) {
|
|
i2c_omap_reset(dev);
|
|
i2c_omap_init_ll(dev);
|
|
/* Return an error code based on whether it was a timeout or buffer error */
|
|
return -EIO; /* Receiver overrun or transmitter underflow */
|
|
}
|
|
/* Handle arbitration loss and NACK errors */
|
|
if (result & (I2C_OMAP_STAT_AL | -EAGAIN)) {
|
|
return -EAGAIN;
|
|
}
|
|
if (result & I2C_OMAP_STAT_NACK) {
|
|
/* Issue a STOP condition after NACK */
|
|
i2c_base_addr->CON |= I2C_OMAP_CON_STP;
|
|
return -ENOMSG; /* Indicate a message error due to NACK */
|
|
}
|
|
|
|
/* Return a general I/O error if no specific error conditions matched */
|
|
return -EIO;
|
|
}
|
|
|
|
/**
|
|
* @brief Performs a common transfer operation for OMAP I2C devices.
|
|
*
|
|
* This function is responsible for transferring multiple I2C messages in a common way
|
|
* for OMAP I2C devices. It waits for the bus to be idle, then iterates through each
|
|
* message in the provided array and transfers them one by one using the i2c_omap_transfer_message()
|
|
* function. After all messages have been transferred, it waits for the bus to be idle again
|
|
* before returning.
|
|
*
|
|
* @param dev The pointer to the I2C device structure.
|
|
* @param msg An array of I2C messages to be transferred.
|
|
* @param num The number of messages in the array.
|
|
* @param polling Specifies whether to use polling or interrupt-based transfer.
|
|
* @param addr The I2C target address.
|
|
* @return 0 on success, or a negative error code on failure.
|
|
*/
|
|
static int i2c_omap_transfer_main(const struct device *dev, struct i2c_msg msg[], int num,
|
|
bool polling, uint16_t addr)
|
|
{
|
|
int ret;
|
|
|
|
ret = i2c_omap_wait_for_bb(dev);
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
|
|
k_sem_take(&data->lock, K_FOREVER);
|
|
if (ret < 0) {
|
|
return ret;
|
|
}
|
|
for (int msg_idx = 0; msg_idx < num; msg_idx++) {
|
|
ret = i2c_omap_transfer_message(dev, &msg[msg_idx], polling, addr);
|
|
if (ret < 0) {
|
|
break;
|
|
}
|
|
}
|
|
k_sem_give(&data->lock);
|
|
i2c_omap_wait_for_bb(dev);
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief OMAP I2C transfer function using polling.
|
|
*
|
|
* This function performs the I2C transfer using the OMAP I2C controller
|
|
* in polling mode. It calls the common transfer function with the
|
|
* specified messages, number of messages, and target address.
|
|
*
|
|
* @param dev Pointer to the I2C device structure.
|
|
* @param msgs Array of I2C messages to be transferred.
|
|
* @param num_msgs Number of I2C messages in the array.
|
|
* @param addr Target address.
|
|
* @return 0 on success, negative error code on failure.
|
|
*/
|
|
static int i2c_omap_transfer_polling(const struct device *dev, struct i2c_msg msgs[],
|
|
uint8_t num_msgs, uint16_t addr)
|
|
{
|
|
return i2c_omap_transfer_main(dev, msgs, num_msgs, true, addr);
|
|
}
|
|
|
|
static DEVICE_API(i2c, i2c_omap_api) = {
|
|
.transfer = i2c_omap_transfer_polling,
|
|
.configure = i2c_omap_configure,
|
|
#ifdef CONFIG_I2C_OMAP_BUS_RECOVERY
|
|
.recover_bus = i2c_omap_recover_bus,
|
|
#endif /* CONFIG_I2C_OMAP_BUS_RECOVERY */
|
|
};
|
|
|
|
/**
|
|
* @brief Initialize the OMAP I2C controller.
|
|
*
|
|
* This function initializes the OMAP I2C controller by setting the speed and
|
|
* performing any necessary initialization steps.
|
|
*
|
|
* @param dev Pointer to the device structure for the I2C controller.
|
|
* @return 0 if successful, negative error code otherwise.
|
|
*/
|
|
static int i2c_omap_init(const struct device *dev)
|
|
{
|
|
struct i2c_omap_data *data = DEV_DATA(dev);
|
|
const struct i2c_omap_cfg *cfg = DEV_CFG(dev);
|
|
int ret;
|
|
|
|
DEVICE_MMIO_MAP(dev, K_MEM_CACHE_NONE);
|
|
|
|
ret = pinctrl_apply_state(cfg->pcfg, PINCTRL_STATE_DEFAULT);
|
|
if (ret < 0) {
|
|
LOG_ERR("failed to apply pinctrl");
|
|
return ret;
|
|
}
|
|
|
|
k_sem_init(&data->lock, 1, 1);
|
|
/* Set the speed for I2C */
|
|
if (i2c_omap_set_speed(dev, cfg->speed)) {
|
|
LOG_ERR("Failed to set speed");
|
|
return -ENOTSUP;
|
|
}
|
|
i2c_omap_init_ll(dev);
|
|
return 0;
|
|
}
|
|
|
|
#define I2C_OMAP_INIT(inst) \
|
|
PINCTRL_DT_INST_DEFINE(inst); \
|
|
LOG_INSTANCE_REGISTER(omap_i2c, inst, CONFIG_I2C_LOG_LEVEL); \
|
|
static const struct i2c_omap_cfg i2c_omap_cfg_##inst = { \
|
|
DEVICE_MMIO_ROM_INIT(DT_DRV_INST(inst)), \
|
|
.irq = DT_INST_IRQN(inst), \
|
|
.speed = DT_INST_PROP(inst, clock_frequency), \
|
|
.pcfg = PINCTRL_DT_INST_DEV_CONFIG_GET(inst), \
|
|
}; \
|
|
\
|
|
static struct i2c_omap_data i2c_omap_data_##inst; \
|
|
\
|
|
I2C_DEVICE_DT_INST_DEFINE(inst, \
|
|
i2c_omap_init, \
|
|
NULL, \
|
|
&i2c_omap_data_##inst, \
|
|
&i2c_omap_cfg_##inst, \
|
|
POST_KERNEL, \
|
|
CONFIG_I2C_INIT_PRIORITY, \
|
|
&i2c_omap_api);
|
|
|
|
DT_INST_FOREACH_STATUS_OKAY(I2C_OMAP_INIT)
|