blob: 2096a825957d39b94466afc941324ac0274ecf77 [file] [log] [blame]
/*
* Copyright (c) 2016 - 2021, Broadcom
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <common/debug.h>
#include <drivers/delay_timer.h>
#include <i2c.h>
#include <i2c_regs.h>
#include <lib/mmio.h>
#include <platform_def.h>
/* Max instances */
#define MAX_I2C 2U
/* Transaction error codes defined in Master command register (0x30) */
#define MSTR_STS_XACT_SUCCESS 0U
#define MSTR_STS_LOST_ARB 1U
#define MSTR_STS_NACK_FIRST_BYTE 2U
/* NACK on a byte other than the first byte */
#define MSTR_STS_NACK_NON_FIRST_BYTE 3U
#define MSTR_STS_TTIMEOUT_EXCEEDED 4U
#define MSTR_STS_TX_TLOW_MEXT_EXCEEDED 5U
#define MSTR_STS_RX_TLOW_MEXT_EXCEEDED 6U
/* SMBUS protocol values defined in register 0x30 */
#define SMBUS_PROT_QUICK_CMD 0U
#define SMBUS_PROT_SEND_BYTE 1U
#define SMBUS_PROT_RECV_BYTE 2U
#define SMBUS_PROT_WR_BYTE 3U
#define SMBUS_PROT_RD_BYTE 4U
#define SMBUS_PROT_WR_WORD 5U
#define SMBUS_PROT_RD_WORD 6U
#define SMBUS_PROT_BLK_WR 7U
#define SMBUS_PROT_BLK_RD 8U
#define SMBUS_PROT_PROC_CALL 9U
#define SMBUS_PROT_BLK_WR_BLK_RD_PROC_CALL 10U
/* Number can be changed later */
#define BUS_BUSY_COUNT 100000U
#define IPROC_I2C_INVALID_ADDR 0xFFU
#define I2C_SMBUS_BLOCK_MAX 32U
/*
* Enum to specify clock speed. The user will provide it during initialization.
* If needed, it can be changed dynamically
*/
typedef enum iproc_smb_clk_freq {
IPROC_SMB_SPEED_100KHz = 0,
IPROC_SMB_SPEED_400KHz = 1,
IPROC_SMB_SPEED_INVALID = 255
} smb_clk_freq_t;
/* Structure used to pass information to read/write functions. */
struct iproc_xact_info {
/* Bus Identifier */
uint32_t bus_id;
/* Device Address */
uint8_t devaddr;
/* Passed by caller to send SMBus command cod e*/
uint8_t command;
/* actual data passed by the caller */
uint8_t *data;
/* Size of data buffer passed */
uint32_t size;
/* Sent by caller specifying PEC, 10-bit addresses */
uint16_t flags;
/* SMBus protocol to use to perform transaction */
uint8_t smb_proto;
/* true if command field below is valid. Otherwise, false */
uint32_t cmd_valid;
};
static const uintptr_t smbus_base_reg_addr[MAX_I2C] = {
SMBUS0_REGS_BASE,
SMBUS1_REGS_BASE
};
/* Function to read a value from specified register. */
static uint32_t iproc_i2c_reg_read(uint32_t bus_id, unsigned long reg_addr)
{
uint32_t val;
uintptr_t smbus;
smbus = smbus_base_reg_addr[bus_id];
val = mmio_read_32(smbus + reg_addr);
VERBOSE("i2c %u: reg %p read 0x%x\n", bus_id,
(void *)(smbus + reg_addr), val);
return val;
}
/* Function to write a value ('val') in to a specified register. */
static void iproc_i2c_reg_write(uint32_t bus_id,
unsigned long reg_addr,
uint32_t val)
{
uintptr_t smbus;
smbus = smbus_base_reg_addr[bus_id];
mmio_write_32((smbus + reg_addr), val);
VERBOSE("i2c %u: reg %p wrote 0x%x\n", bus_id,
(void *)(smbus + reg_addr), val);
}
/* Function to clear and set bits in a specified register. */
static void iproc_i2c_reg_clearset(uint32_t bus_id,
unsigned long reg_addr,
uint32_t clear,
uint32_t set)
{
uintptr_t smbus;
smbus = smbus_base_reg_addr[bus_id];
mmio_clrsetbits_32((smbus + reg_addr), clear, set);
VERBOSE("i2c %u: reg %p clear 0x%x, set 0x%x\n", bus_id,
(void *)(smbus + reg_addr), clear, set);
}
/* Function to dump all SMBUS register */
#ifdef BCM_I2C_DEBUG
static int iproc_dump_i2c_regs(uint32_t bus_id)
{
uint32_t regval;
if (bus_id > MAX_I2C) {
return -1;
}
INFO("----------------------------------------------\n");
INFO("%s: Dumping SMBus %u registers...\n", __func__, bus_id);
regval = iproc_i2c_reg_read(bus_id, SMB_CFG_REG);
INFO("SMB_CFG_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_TIMGCFG_REG);
INFO("SMB_TIMGCFG_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_ADDR_REG);
INFO("SMB_ADDR_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_MSTRFIFOCTL_REG);
INFO("SMB_MSTRFIFOCTL_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_SLVFIFOCTL_REG);
INFO("SMB_SLVFIFOCTL_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_BITBANGCTL_REG);
INFO("SMB_BITBANGCTL_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_MSTRCMD_REG);
INFO("SMB_MSTRCMD_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_SLVCMD_REG);
INFO("SMB_SLVCMD_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_EVTEN_REG);
INFO("SMB_EVTEN_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_EVTSTS_REG);
INFO("SMB_EVTSTS_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_MSTRDATAWR_REG);
INFO("SMB_MSTRDATAWR_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_MSTRDATARD_REG);
INFO("SMB_MSTRDATARD_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_SLVDATAWR_REG);
INFO("SMB_SLVDATAWR_REG=0x%x\n", regval);
regval = iproc_i2c_reg_read(bus_id, SMB_SLVDATARD_REG);
INFO("SMB_SLVDATARD_REG=0x%x\n", regval);
INFO("----------------------------------------------\n");
return 0;
}
#endif
/*
* Function to ensure that the previous transaction was completed before
* initiating a new transaction. It can also be used in polling mode to
* check status of completion of a command
*/
static int iproc_i2c_startbusy_wait(uint32_t bus_id)
{
uint32_t regval;
uint32_t retry = 0U;
/*
* Check if an operation is in progress. During probe it won't be.
* Want to make sure that the transaction in progress is completed.
*/
do {
udelay(1U);
regval = iproc_i2c_reg_read(bus_id, SMB_MSTRCMD_REG);
regval &= SMB_MSTRSTARTBUSYCMD_MASK;
if (retry++ > BUS_BUSY_COUNT) {
ERROR("%s: START_BUSY bit didn't clear, exiting\n",
__func__);
return -1;
}
} while (regval != 0U);
return 0;
}
/*
* This function copies data to SMBus's Tx FIFO. Valid for write transactions
* info: Data to copy in to Tx FIFO. For read commands, the size should be
* set to zero by the caller
*/
static void iproc_i2c_write_trans_data(struct iproc_xact_info *info)
{
uint32_t regval;
uint8_t devaddr;
uint32_t i;
uint32_t num_data_bytes = 0U;
#ifdef BCM_I2C_DEBUG
INFO("%s:dev_addr=0x%x,cmd_valid=%d, cmd=0x%x, size=%u proto=%d\n",
__func__, info->devaddr, info->cmd_valid, info->command,
info->size, info->smb_proto);
#endif
/* Shift devaddr by 1 bit since SMBus uses the low bit[0] for R/W_n */
devaddr = (info->devaddr << 1);
/*
* Depending on the SMBus protocol, we need to write additional
* transaction data in to Tx FIFO. Refer to section 5.5 of SMBus spec
* for sequence for a transaction
*/
switch (info->smb_proto) {
case SMBUS_PROT_RECV_BYTE:
/* No additional data to be written */
iproc_i2c_reg_write(info->bus_id, SMB_MSTRDATAWR_REG,
devaddr | 0x1U | SMB_MSTRWRSTS_MASK);
break;
case SMBUS_PROT_SEND_BYTE:
num_data_bytes = info->size;
iproc_i2c_reg_write(info->bus_id, SMB_MSTRDATAWR_REG,
devaddr);
break;
case SMBUS_PROT_RD_BYTE:
case SMBUS_PROT_RD_WORD:
case SMBUS_PROT_BLK_RD:
/* Write slave address with R/W~ set (bit #0) */
iproc_i2c_reg_write(info->bus_id, SMB_MSTRDATAWR_REG,
devaddr | 0x1U);
break;
case SMBUS_PROT_BLK_WR_BLK_RD_PROC_CALL:
iproc_i2c_reg_write(info->bus_id, SMB_MSTRDATAWR_REG,
devaddr | 0x1U | SMB_MSTRWRSTS_MASK);
break;
case SMBUS_PROT_WR_BYTE:
case SMBUS_PROT_WR_WORD:
iproc_i2c_reg_write(info->bus_id, SMB_MSTRDATAWR_REG,
devaddr);
/*
* No additional bytes to be written. Data portion is written
* in the 'for' loop below
*/
num_data_bytes = info->size;
break;
case SMBUS_PROT_BLK_WR:
iproc_i2c_reg_write(info->bus_id, SMB_MSTRDATAWR_REG,
devaddr);
/* 3rd byte is byte count */
iproc_i2c_reg_write(info->bus_id, SMB_MSTRDATAWR_REG,
info->size);
num_data_bytes = info->size;
break;
default:
return;
}
/* If the protocol needs command code, copy it */
if (info->cmd_valid) {
iproc_i2c_reg_write(info->bus_id, SMB_MSTRDATAWR_REG,
info->command);
}
/*
* Copy actual data from caller. In general, for reads,
* no data is copied.
*/
for (i = 0U; num_data_bytes; --num_data_bytes, i++) {
/* For the last byte, set MASTER_WR_STATUS bit */
regval = (num_data_bytes == 1U) ?
info->data[i] | SMB_MSTRWRSTS_MASK : info->data[i];
iproc_i2c_reg_write(info->bus_id, SMB_MSTRDATAWR_REG,
regval);
}
}
/*
* This function writes to the master command register and
* then polls for completion
*/
static int iproc_i2c_write_master_command(uint32_t mastercmd,
struct iproc_xact_info *info)
{
uint32_t retry = 0U;
uint32_t regval;
iproc_i2c_reg_write(info->bus_id, SMB_MSTRCMD_REG, mastercmd);
/* Check for Master Busy status */
regval = iproc_i2c_reg_read(info->bus_id, SMB_MSTRCMD_REG);
while ((regval & SMB_MSTRSTARTBUSYCMD_MASK) != 0U) {
udelay(1U);
if (retry++ > BUS_BUSY_COUNT) {
ERROR("%s: START_BUSY bit didn't clear, exiting\n",
__func__);
return -1;
}
regval = iproc_i2c_reg_read(info->bus_id, SMB_MSTRCMD_REG);
}
/* If start_busy bit cleared, check if there are any errors */
if (!(regval & SMB_MSTRSTARTBUSYCMD_MASK)) {
/* start_busy bit cleared, check master_status field now */
regval &= SMB_MSTRSTS_MASK;
regval >>= SMB_MSTRSTS_SHIFT;
if (regval != MSTR_STS_XACT_SUCCESS) {
/* Error We can flush Tx FIFO here */
ERROR("%s: ERROR: %u exiting\n", __func__, regval);
return -1;
}
}
return 0;
}
/* Function to initiate data send and verify completion status */
static int iproc_i2c_data_send(struct iproc_xact_info *info)
{
int rc;
uint32_t mastercmd;
/* Make sure the previous transaction completed */
rc = iproc_i2c_startbusy_wait(info->bus_id);
if (rc < 0) {
WARN("%s: Send: bus is busy, exiting\n", __func__);
return rc;
}
/* Write transaction bytes to Tx FIFO */
iproc_i2c_write_trans_data(info);
/*
* Program master command register (0x30) with protocol type and set
* start_busy_command bit to initiate the write transaction
*/
mastercmd = (info->smb_proto << SMB_MSTRSMBUSPROTO_SHIFT) |
SMB_MSTRSTARTBUSYCMD_MASK;
if (iproc_i2c_write_master_command(mastercmd, info)) {
return -1;
}
return 0;
}
/*
* Function to initiate data receive, verify completion status,
* and read from SMBUS Read FIFO
*/
static int iproc_i2c_data_recv(struct iproc_xact_info *info,
uint32_t *num_bytes_read)
{
int rc;
uint32_t mastercmd;
uint32_t regval;
/* Make sure the previous transaction completed */
rc = iproc_i2c_startbusy_wait(info->bus_id);
if (rc < 0) {
WARN("%s: Receive: Bus is busy, exiting\n", __func__);
return rc;
}
/* Program all transaction bytes into master Tx FIFO */
iproc_i2c_write_trans_data(info);
/*
* Program master command register (0x30) with protocol type and set
* start_busy_command bit to initiate the write transaction
*/
mastercmd = (info->smb_proto << SMB_MSTRSMBUSPROTO_SHIFT) |
SMB_MSTRSTARTBUSYCMD_MASK | info->size;
if (iproc_i2c_write_master_command(mastercmd, info)) {
return -1;
}
/* Read received byte(s), after TX out address etc */
regval = iproc_i2c_reg_read(info->bus_id, SMB_MSTRDATARD_REG);
/* For block read, protocol (hw) returns byte count,as the first byte */
if (info->smb_proto == SMBUS_PROT_BLK_RD) {
uint32_t i;
*num_bytes_read = regval & SMB_MSTRRDDATA_MASK;
/*
* Limit to reading a max of 32 bytes only; just a safeguard.
* If # bytes read is a number > 32, check transaction set up,
* and contact hw engg.
* Assumption: PEC is disabled
*/
for (i = 0U; (i < *num_bytes_read) &&
(i < I2C_SMBUS_BLOCK_MAX); i++) {
/* Read Rx FIFO for data bytes */
regval = iproc_i2c_reg_read(info->bus_id,
SMB_MSTRDATARD_REG);
info->data[i] = regval & SMB_MSTRRDDATA_MASK;
}
} else {
/* 1 Byte data */
*info->data = regval & SMB_MSTRRDDATA_MASK;
*num_bytes_read = 1U;
}
return 0;
}
/*
* This function set clock frequency for SMBus block. As per hardware
* engineering, the clock frequency can be changed dynamically.
*/
static int iproc_i2c_set_clk_freq(uint32_t bus_id, smb_clk_freq_t freq)
{
uint32_t val;
switch (freq) {
case IPROC_SMB_SPEED_100KHz:
val = 0U;
break;
case IPROC_SMB_SPEED_400KHz:
val = 1U;
break;
default:
return -1;
}
iproc_i2c_reg_clearset(bus_id, SMB_TIMGCFG_REG,
SMB_TIMGCFG_MODE400_MASK,
val << SMB_TIMGCFG_MODE400_SHIFT);
return 0;
}
/* Helper function to fill the iproc_xact_info structure */
static void iproc_i2c_fill_info(struct iproc_xact_info *info, uint32_t bus_id,
uint8_t devaddr, uint8_t cmd, uint8_t *value,
uint8_t smb_proto, uint32_t cmd_valid)
{
info->bus_id = bus_id;
info->devaddr = devaddr;
info->command = (uint8_t)cmd;
info->smb_proto = smb_proto;
info->data = value;
info->size = 1U;
info->flags = 0U;
info->cmd_valid = cmd_valid;
}
/* This function initializes the SMBUS */
static void iproc_i2c_init(uint32_t bus_id, int speed)
{
uint32_t regval;
#ifdef BCM_I2C_DEBUG
INFO("%s: Enter Init\n", __func__);
#endif
/* Put controller in reset */
regval = iproc_i2c_reg_read(bus_id, SMB_CFG_REG);
regval |= BIT(SMB_CFG_RST_SHIFT);
regval &= ~(BIT(SMB_CFG_SMBEN_SHIFT));
iproc_i2c_reg_write(bus_id, SMB_CFG_REG, regval);
/* Wait 100 usec per spec */
udelay(100U);
/* Bring controller out of reset */
regval &= ~(BIT(SMB_CFG_RST_SHIFT));
iproc_i2c_reg_write(bus_id, SMB_CFG_REG, regval);
/*
* Flush Tx, Rx FIFOs. Note we are setting the Rx FIFO threshold to 0.
* May be OK since we are setting RX_EVENT and RX_FIFO_FULL interrupts
*/
regval = SMB_MSTRRXFIFOFLSH_MASK | SMB_MSTRTXFIFOFLSH_MASK;
iproc_i2c_reg_write(bus_id, SMB_MSTRFIFOCTL_REG, regval);
/*
* Enable SMbus block. Note, we are setting MASTER_RETRY_COUNT to zero
* since there will be only one master
*/
regval = iproc_i2c_reg_read(bus_id, SMB_CFG_REG);
regval |= SMB_CFG_SMBEN_MASK;
iproc_i2c_reg_write(bus_id, SMB_CFG_REG, regval);
/* Wait a minimum of 50 Usec, as per SMB hw doc. But we wait longer */
mdelay(10U);
/* If error then set default speed */
if (i2c_set_bus_speed(bus_id, speed)) {
i2c_set_bus_speed(bus_id, I2C_SPEED_DEFAULT);
}
/* Disable intrs */
regval = 0x0U;
iproc_i2c_reg_write(bus_id, SMB_EVTEN_REG, regval);
/* Clear intrs (W1TC) */
regval = iproc_i2c_reg_read(bus_id, SMB_EVTSTS_REG);
iproc_i2c_reg_write(bus_id, SMB_EVTSTS_REG, regval);
#ifdef BCM_I2C_DEBUG
iproc_dump_i2c_regs(bus_id);
INFO("%s: Exit Init Successfully\n", __func__);
#endif
}
/*
* Function Name: i2c_init
*
* Description:
* This function initializes the SMBUS.
*
* Parameters:
* bus_id - I2C bus ID
* speed - I2C bus speed in Hz
*
* Return:
* 0 on success, or -1 on failure.
*/
int i2c_init(uint32_t bus_id, int speed)
{
if (bus_id > MAX_I2C) {
WARN("%s: Invalid Bus %u\n", __func__, bus_id);
return -1;
}
iproc_i2c_init(bus_id, speed);
return 0U;
}
/*
* Function Name: i2c_probe
*
* Description:
* This function probes the I2C bus for the existence of the specified
* device.
*
* Parameters:
* bus_id - I2C bus ID
* devaddr - Device Address
*
* Return:
* 0 on success, or -1 on failure.
*/
int i2c_probe(uint32_t bus_id, uint8_t devaddr)
{
uint32_t regval;
int rc;
/*
* i2c_init() Initializes internal regs, disable intrs (and then clear intrs),
* set fifo thresholds, etc.
* Shift devaddr by 1 bit since SMBus uses the low bit[0] for R/W_n
*/
regval = (devaddr << 1U);
iproc_i2c_reg_write(bus_id, SMB_MSTRDATAWR_REG, regval);
regval = ((SMBUS_PROT_QUICK_CMD << SMB_MSTRSMBUSPROTO_SHIFT) |
SMB_MSTRSTARTBUSYCMD_MASK);
iproc_i2c_reg_write(bus_id, SMB_MSTRCMD_REG, regval);
rc = iproc_i2c_startbusy_wait(bus_id);
if (rc < 0) {
WARN("%s: Probe: bus is busy, exiting\n", __func__);
return rc;
}
regval = iproc_i2c_reg_read(bus_id, SMB_MSTRCMD_REG);
if (((regval & SMB_MSTRSTS_MASK) >> SMB_MSTRSTS_SHIFT) == 0)
VERBOSE("i2c device address: 0x%x\n", devaddr);
else
return -1;
#ifdef BCM_I2C_DEBUG
iproc_dump_i2c_regs(bus_id);
#endif
return 0;
}
/*
* Function Name: i2c_recv_byte
*
* Description:
* This function reads I2C data from a device without specifying
* a command regsiter.
*
* Parameters:
* bus_id - I2C bus ID
* devaddr - Device Address
* value - Data Read
*
* Return:
* 0 on success, or -1 on failure.
*/
int i2c_recv_byte(uint32_t bus_id, uint8_t devaddr, uint8_t *value)
{
int rc;
struct iproc_xact_info info;
uint32_t num_bytes_read = 0;
iproc_i2c_fill_info(&info, bus_id, devaddr, 0U, value,
SMBUS_PROT_RECV_BYTE, 0U);
/* Refer to i2c_smbus_read_byte for params passed. */
rc = iproc_i2c_data_recv(&info, &num_bytes_read);
if (rc < 0) {
printf("%s: %s error accessing device 0x%x\n",
__func__, "Read", devaddr);
}
return rc;
}
/*
* Function Name: i2c_send_byte
*
* Description:
* This function send I2C data to a device without specifying
* a command regsiter.
*
* Parameters:
* bus_id - I2C bus ID
* devaddr - Device Address
* value - Data Send
*
* Return:
* 0 on success, or -1 on failure.
*/
int i2c_send_byte(uint32_t bus_id, uint8_t devaddr, uint8_t value)
{
int rc;
struct iproc_xact_info info;
iproc_i2c_fill_info(&info, bus_id, devaddr, 0U, &value,
SMBUS_PROT_SEND_BYTE, 0U);
/* Refer to i2c_smbus_write_byte params passed. */
rc = iproc_i2c_data_send(&info);
if (rc < 0) {
ERROR("%s: %s error accessing device 0x%x\n",
__func__, "Write", devaddr);
}
return rc;
}
/* Helper function to read a single byte */
static int i2c_read_byte(uint32_t bus_id,
uint8_t devaddr,
uint8_t regoffset,
uint8_t *value)
{
int rc;
struct iproc_xact_info info;
uint32_t num_bytes_read = 0U;
iproc_i2c_fill_info(&info, bus_id, devaddr, regoffset, value,
SMBUS_PROT_RD_BYTE, 1U);
/* Refer to i2c_smbus_read_byte for params passed. */
rc = iproc_i2c_data_recv(&info, &num_bytes_read);
if (rc < 0) {
ERROR("%s: %s error accessing device 0x%x\n",
__func__, "Read", devaddr);
}
return rc;
}
/*
* Function Name: i2c_read
*
* Description:
* This function reads I2C data from a device with a designated
* command register
*
* Parameters:
* bus_id - I2C bus ID
* devaddr - Device Address
* addr - Register Offset
* alen - Address Length, 1 for byte, 2 for word (not supported)
* buffer - Data Buffer
* len - Data Length in bytes
*
* Return:
* 0 on success, or -1 on failure.
*/
int i2c_read(uint32_t bus_id,
uint8_t devaddr,
uint32_t addr,
int alen,
uint8_t *buffer,
int len)
{
uint32_t i;
if (alen > 1) {
WARN("I2C read: addr len %d not supported\n", alen);
return -1;
}
if (addr + len > 256) {
WARN("I2C read: address out of range\n");
return -1;
}
for (i = 0U; i < len; i++) {
if (i2c_read_byte(bus_id, devaddr, addr + i, &buffer[i])) {
ERROR("I2C read: I/O error\n");
iproc_i2c_init(bus_id, i2c_get_bus_speed(bus_id));
return -1;
}
}
return 0;
}
/* Helper function to write a single byte */
static int i2c_write_byte(uint32_t bus_id,
uint8_t devaddr,
uint8_t regoffset,
uint8_t value)
{
int rc;
struct iproc_xact_info info;
iproc_i2c_fill_info(&info, bus_id, devaddr, regoffset, &value,
SMBUS_PROT_WR_BYTE, 1U);
/* Refer to i2c_smbus_write_byte params passed. */
rc = iproc_i2c_data_send(&info);
if (rc < 0) {
ERROR("%s: %s error accessing device 0x%x\n",
__func__, "Write", devaddr);
return -1;
}
return 0;
}
/*
* Function Name: i2c_write
*
* Description:
* This function write I2C data to a device with a designated
* command register
*
* Parameters:
* bus_id - I2C bus ID
* devaddr - Device Address
* addr - Register Offset
* alen - Address Length, 1 for byte, 2 for word (not supported)
* buffer - Data Buffer
* len - Data Length in bytes
*
* Return:
* 0 on success, or -1 on failure.
*/
int i2c_write(uint32_t bus_id,
uint8_t devaddr,
uint32_t addr,
int alen,
uint8_t *buffer,
int len)
{
uint32_t i;
if (alen > 1) {
WARN("I2C write: addr len %d not supported\n", alen);
return -1;
}
if (addr + len > 256U) {
WARN("I2C write: address out of range\n");
return -1;
}
for (i = 0U; i < len; i++) {
if (i2c_write_byte(bus_id, devaddr, addr + i, buffer[i])) {
ERROR("I2C write: I/O error\n");
iproc_i2c_init(bus_id, i2c_get_bus_speed(bus_id));
return -1;
}
}
return 0;
}
/*
* Function Name: i2c_set_bus_speed
*
* Description:
* This function configures the SMBUS speed
*
* Parameters:
* bus_id - I2C bus ID
* speed - I2C bus speed in Hz
*
* Return:
* 0 on success, or -1 on failure.
*/
int i2c_set_bus_speed(uint32_t bus_id, uint32_t speed)
{
switch (speed) {
case I2C_SPEED_100KHz:
iproc_i2c_set_clk_freq(bus_id, IPROC_SMB_SPEED_100KHz);
break;
case I2C_SPEED_400KHz:
iproc_i2c_set_clk_freq(bus_id, IPROC_SMB_SPEED_400KHz);
break;
default:
return -1;
}
return 0;
}
/*
* Function Name: i2c_get_bus_speed
*
* Description:
* This function returns the SMBUS speed.
*
* Parameters:
* bus_id - I2C bus ID
*
* Return:
* Bus speed in Hz, 0 on failure
*/
uint32_t i2c_get_bus_speed(uint32_t bus_id)
{
uint32_t regval;
uint32_t retval = 0U;
regval = iproc_i2c_reg_read(bus_id, SMB_TIMGCFG_REG);
regval &= SMB_TIMGCFG_MODE400_MASK;
regval >>= SMB_TIMGCFG_MODE400_SHIFT;
switch (regval) {
case IPROC_SMB_SPEED_100KHz:
retval = I2C_SPEED_100KHz;
break;
case IPROC_SMB_SPEED_400KHz:
retval = I2C_SPEED_400KHz;
break;
default:
break;
}
return retval;
}