mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-16 09:34:18 +00:00

found using codespell (https://github.com/codespell-project/codespell). Signed-off-by: Elyes Haouas <ehaouas@noos.fr> Change-Id: I1bfa797e3460adddeefa916bb68e22beddaf6373
886 lines
21 KiB
C
886 lines
21 KiB
C
/*
|
|
* 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 register.
|
|
*
|
|
* 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 register.
|
|
*
|
|
* 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;
|
|
}
|
|
|