589 lines
12 KiB
C
589 lines
12 KiB
C
|
/*
|
||
|
|
* Copyright (C) 2016 Allwinner.
|
||
|
|
* zhouhuacai <zhouhuacai@allwinnertech.com>
|
||
|
|
*
|
||
|
|
* SUNXI TWI Controller Driver
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: GPL-2.0+
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <common.h>
|
||
|
|
#include <asm/arch/ccmu.h>
|
||
|
|
#include <asm/arch/twi.h>
|
||
|
|
#include <sys_config.h>
|
||
|
|
#include <asm/arch/timer.h>
|
||
|
|
#include <asm/io.h>
|
||
|
|
#include <asm/arch/platform.h>
|
||
|
|
#include <sys_config.h>
|
||
|
|
#include <sys_config_old.h>
|
||
|
|
#include <fdt_support.h>
|
||
|
|
#include <sunxi_i2c.h>
|
||
|
|
|
||
|
|
#define I2C_DBG(fmt, arg...) printf("[I2C-DEBUG]:%s() %d \n", __func__, __LINE__)
|
||
|
|
#define I2C_ERR(fmt, arg...) printf("[I2C-ERROR]:%s() %d "fmt, __func__, __LINE__)
|
||
|
|
|
||
|
|
#define MAX_SUNXI_I2C_NUM 4
|
||
|
|
|
||
|
|
__attribute__((section(".data")))
|
||
|
|
static struct sunxi_twi_reg *sunxi_i2c[MAX_SUNXI_I2C_NUM] = {NULL, NULL, NULL, NULL};
|
||
|
|
|
||
|
|
static s32 i2c_io_null(int bus_num, uchar chip, uint addr, int alen, uchar *buffer, int len);
|
||
|
|
s32 (* i2c_read_pt)(int bus_num, uchar chip, uint addr, int alen, uchar *buffer, int len) = i2c_io_null;
|
||
|
|
s32 (* i2c_write_pt)(int bus_num, uchar chip, uint addr, int alen, uchar *buffer, int len) = i2c_io_null;
|
||
|
|
|
||
|
|
static inline void twi_soft_reset(int bus_num)
|
||
|
|
{
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
i2c->eft = 0;
|
||
|
|
i2c->srst = 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void twi_set_start(int bus_num)
|
||
|
|
{
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
|
||
|
|
i2c->ctl |= TWI_CTL_STA;
|
||
|
|
i2c->ctl &= ~TWI_CTL_INTFLG;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline u32 twi_get_start(int bus_num)
|
||
|
|
{
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
i2c->ctl >>= 5;
|
||
|
|
return i2c->ctl & 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void twi_clear_irq_flag(int bus_num)
|
||
|
|
{
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
/* start and stop bit should be 0 */
|
||
|
|
i2c->ctl |= TWI_CTL_INTFLG;
|
||
|
|
i2c->ctl &= ~(TWI_CTL_STA | TWI_CTL_STP);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline int twi_wait_irq_flag_clear(int bus_num, u32 time)
|
||
|
|
{
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
|
||
|
|
while ( (time--) && (!(i2c->ctl & TWI_CTL_INTFLG)) );
|
||
|
|
|
||
|
|
if (time <= 0)
|
||
|
|
return SUNXI_I2C_TOUT;
|
||
|
|
|
||
|
|
return SUNXI_I2C_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void twi_enable_ack(int bus_num)
|
||
|
|
{
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
i2c->ctl |= TWI_CTL_ACK;
|
||
|
|
i2c->ctl &= ~TWI_CTL_INTFLG;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void twi_disable_ack(int bus_num)
|
||
|
|
{
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
i2c->ctl &= ~TWI_CTL_ACK;
|
||
|
|
i2c->ctl &= ~TWI_CTL_INTFLG;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void twi_set_stop(int bus_num)
|
||
|
|
{
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
i2c->ctl |= TWI_CTL_STP;
|
||
|
|
i2c->ctl &= ~TWI_CTL_INTFLG;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline u32 twi_get_stop(int bus_num)
|
||
|
|
{
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
int reg_val = i2c->ctl;
|
||
|
|
reg_val >>= 4;
|
||
|
|
return reg_val & 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void twi_enable_lcr(int bus_num)
|
||
|
|
{
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
|
||
|
|
i2c->lcr |= TWI_LCR_SCL_EN;
|
||
|
|
i2c->lcr |= TWI_LCR_SDA_EN;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* send 9 clock to release sda */
|
||
|
|
static int twi_send_clk_9pulse(int bus_num)
|
||
|
|
{
|
||
|
|
int cycle = 10;
|
||
|
|
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
twi_enable_lcr(bus_num);
|
||
|
|
__usdelay(500);
|
||
|
|
|
||
|
|
/* toggle I2C SCL and SDA until bus idle */
|
||
|
|
while ((cycle > 0) && ((i2c->lcr & TWI_LCR_SDA_CTL) != TWI_LCR_SDA_CTL)) {
|
||
|
|
/*control scl and sda output high level*/
|
||
|
|
i2c->lcr |= TWI_LCR_SCL_CTL;
|
||
|
|
i2c->lcr |= TWI_LCR_SDA_CTL;
|
||
|
|
__usdelay(1000);
|
||
|
|
/*control scl and sda output low level*/
|
||
|
|
i2c->lcr &= ~TWI_LCR_SCL_CTL;
|
||
|
|
i2c->lcr &= ~TWI_LCR_SDA_CTL;
|
||
|
|
__usdelay(1000);
|
||
|
|
cycle--;
|
||
|
|
}
|
||
|
|
|
||
|
|
if ((i2c->lcr & TWI_LCR_SDA_CTL) != TWI_LCR_SDA_CTL) {
|
||
|
|
I2C_ERR("SDA is still Stuck Low, failed. \n");
|
||
|
|
return SUNXI_I2C_FAIL;
|
||
|
|
}
|
||
|
|
|
||
|
|
i2c->lcr = 0x0;
|
||
|
|
__usdelay(500);
|
||
|
|
|
||
|
|
return SUNXI_I2C_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int twi_start(int bus_num)
|
||
|
|
{
|
||
|
|
u32 timeout = 0xff;
|
||
|
|
twi_soft_reset(bus_num);
|
||
|
|
twi_set_start(bus_num);
|
||
|
|
|
||
|
|
if (twi_wait_irq_flag_clear(bus_num,timeout)) {
|
||
|
|
I2C_ERR("START can't sendout!\n");
|
||
|
|
return SUNXI_I2C_FAIL;
|
||
|
|
}
|
||
|
|
|
||
|
|
return SUNXI_I2C_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int twi_restart(int bus_num)
|
||
|
|
{
|
||
|
|
u32 timeout = 0xff;
|
||
|
|
|
||
|
|
twi_set_start(bus_num);
|
||
|
|
twi_clear_irq_flag(bus_num);
|
||
|
|
if (twi_wait_irq_flag_clear(bus_num,timeout)) {
|
||
|
|
I2C_ERR("Restart can't sendout!\n");
|
||
|
|
return SUNXI_I2C_FAIL;
|
||
|
|
}
|
||
|
|
|
||
|
|
return SUNXI_I2C_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int twi_send_slave_addr(int bus_num, u32 saddr, u32 rw)
|
||
|
|
{
|
||
|
|
u32 time = 0xff;
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
|
||
|
|
rw &= 1;
|
||
|
|
i2c->data = ((saddr & 0xff) << 1) | rw;
|
||
|
|
twi_clear_irq_flag(bus_num);
|
||
|
|
|
||
|
|
if (twi_wait_irq_flag_clear(bus_num, time))
|
||
|
|
return SUNXI_I2C_TOUT;
|
||
|
|
|
||
|
|
if ((rw == I2C_WRITE) && (i2c->status != I2C_ADDRWRITE_ACK))
|
||
|
|
return -I2C_ADDRWRITE_ACK;
|
||
|
|
else if ((rw == I2C_READ) && (i2c->status != I2C_ADDRREAD_ACK))
|
||
|
|
return -I2C_ADDRREAD_ACK;
|
||
|
|
|
||
|
|
return SUNXI_I2C_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int twi_send_byte_addr(int bus_num, u32 byteaddr)
|
||
|
|
{
|
||
|
|
int time = 0xff;
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
|
||
|
|
i2c->data = byteaddr & 0xff;
|
||
|
|
twi_clear_irq_flag(bus_num);
|
||
|
|
|
||
|
|
if (twi_wait_irq_flag_clear(bus_num, time))
|
||
|
|
return SUNXI_I2C_TOUT;
|
||
|
|
|
||
|
|
if (i2c->status != I2C_DATAWRITE_ACK)
|
||
|
|
return -I2C_DATAWRITE_ACK;
|
||
|
|
|
||
|
|
return SUNXI_I2C_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int twi_send_addr(int bus_num, uint addr, int alen)
|
||
|
|
{
|
||
|
|
int i, ret, addr_len;
|
||
|
|
char *slave_reg;
|
||
|
|
|
||
|
|
if (alen >= 3)
|
||
|
|
addr_len = 2;
|
||
|
|
else if (alen <= 1)
|
||
|
|
addr_len = 0;
|
||
|
|
else
|
||
|
|
addr_len = 1;
|
||
|
|
|
||
|
|
slave_reg = (char *)&addr;
|
||
|
|
|
||
|
|
for (i = addr_len; i >= 0; i--) {
|
||
|
|
ret = twi_send_byte_addr(bus_num, slave_reg[i] & 0xff);
|
||
|
|
|
||
|
|
if (ret != SUNXI_I2C_OK)
|
||
|
|
goto twi_send_addr_err;
|
||
|
|
}
|
||
|
|
|
||
|
|
twi_send_addr_err:
|
||
|
|
return ret;
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
static int twi_get_data(int bus_num, u8 *data_addr, u32 data_count)
|
||
|
|
{
|
||
|
|
int time = 0xff;
|
||
|
|
u32 i;
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
|
||
|
|
if (data_count == 1) {
|
||
|
|
/*no need ack */
|
||
|
|
twi_clear_irq_flag(bus_num);
|
||
|
|
|
||
|
|
if (twi_wait_irq_flag_clear(bus_num, time))
|
||
|
|
return SUNXI_I2C_TOUT;
|
||
|
|
|
||
|
|
*data_addr = i2c->data;
|
||
|
|
|
||
|
|
if ( i2c->status != I2C_DATAREAD_NACK)
|
||
|
|
return -I2C_DATAREAD_NACK;
|
||
|
|
} else {
|
||
|
|
for (i = 0; i < data_count - 1; i++) {
|
||
|
|
/*need ack */
|
||
|
|
twi_enable_ack(bus_num);
|
||
|
|
twi_clear_irq_flag(bus_num);
|
||
|
|
|
||
|
|
if (twi_wait_irq_flag_clear(bus_num, time))
|
||
|
|
return SUNXI_I2C_TOUT;
|
||
|
|
|
||
|
|
data_addr[i] = i2c->data;
|
||
|
|
|
||
|
|
while ( (time--) && (i2c->status != I2C_DATAREAD_ACK) );
|
||
|
|
|
||
|
|
if (time <= 0)
|
||
|
|
return SUNXI_I2C_TOUT;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* received the last byte */
|
||
|
|
twi_disable_ack(bus_num);
|
||
|
|
twi_clear_irq_flag(bus_num);
|
||
|
|
|
||
|
|
if (twi_wait_irq_flag_clear(bus_num, time))
|
||
|
|
return SUNXI_I2C_TOUT;
|
||
|
|
|
||
|
|
data_addr[data_count - 1] = i2c->data;
|
||
|
|
|
||
|
|
while ( (time--) && (i2c->status != I2C_DATAREAD_NACK) );
|
||
|
|
|
||
|
|
if (time <= 0)
|
||
|
|
return SUNXI_I2C_TOUT;
|
||
|
|
}
|
||
|
|
|
||
|
|
return SUNXI_I2C_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int twi_send_data(int bus_num, u8 *data_addr, u32 data_count)
|
||
|
|
{
|
||
|
|
int time = 0xff;
|
||
|
|
u32 i;
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
|
||
|
|
for (i = 0; i < data_count; i++) {
|
||
|
|
i2c->data = data_addr[i];
|
||
|
|
twi_clear_irq_flag(bus_num);
|
||
|
|
|
||
|
|
if (twi_wait_irq_flag_clear(bus_num, time))
|
||
|
|
return SUNXI_I2C_TOUT;
|
||
|
|
|
||
|
|
time = 0xff;
|
||
|
|
|
||
|
|
while ( (time--) && (i2c->status != I2C_DATAWRITE_ACK) );
|
||
|
|
|
||
|
|
if (time <= 0)
|
||
|
|
return SUNXI_I2C_TOUT;
|
||
|
|
}
|
||
|
|
|
||
|
|
return SUNXI_I2C_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int twi_stop(int bus_num)
|
||
|
|
{
|
||
|
|
int time = 0xff;
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
|
||
|
|
i2c->ctl |= (0x01 << 4);
|
||
|
|
i2c->ctl |= (0x01 << 3);
|
||
|
|
|
||
|
|
twi_set_stop(bus_num);
|
||
|
|
twi_clear_irq_flag(bus_num);
|
||
|
|
|
||
|
|
while (( 1 == twi_get_stop(bus_num)) && (--time));
|
||
|
|
|
||
|
|
if (time == 0) {
|
||
|
|
I2C_ERR("STOP can't sendout!\n");
|
||
|
|
return SUNXI_I2C_TFAIL;
|
||
|
|
}
|
||
|
|
|
||
|
|
time = 0xff;
|
||
|
|
|
||
|
|
while ((TWI_STAT_IDLE != i2c->status) && (--time));
|
||
|
|
|
||
|
|
if (time <= 0) {
|
||
|
|
I2C_ERR("i2c state isn't idle(0xf8)\n");
|
||
|
|
return SUNXI_I2C_TFAIL;
|
||
|
|
}
|
||
|
|
|
||
|
|
return SUNXI_I2C_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void i2c_set_clock(int bus_num, int speed)
|
||
|
|
{
|
||
|
|
int timeout, clk_n, clk_m, i, pow_2_clk_n;
|
||
|
|
struct sunxi_twi_reg * i2c = sunxi_i2c[bus_num];
|
||
|
|
|
||
|
|
timeout = 0xff;
|
||
|
|
twi_soft_reset(bus_num);
|
||
|
|
|
||
|
|
while ((i2c->srst) && (timeout--));
|
||
|
|
|
||
|
|
if ((i2c->lcr & TWI_LCR_NORM_STATUS) != TWI_LCR_NORM_STATUS ) {
|
||
|
|
I2C_DBG("[i2c%d] bus is busy, lcr = %x\n", bus_num, i2c->lcr);
|
||
|
|
twi_send_clk_9pulse(bus_num);
|
||
|
|
}
|
||
|
|
|
||
|
|
speed /= 1000; /*khz*/
|
||
|
|
|
||
|
|
if (speed < 100)
|
||
|
|
speed = 100;
|
||
|
|
else if (speed > 400)
|
||
|
|
speed = 400;
|
||
|
|
|
||
|
|
/*Foscl=24000/(2^CLK_N*(CLK_M+1)*10)*/
|
||
|
|
clk_n = (speed == 100) ? 1 : 0;
|
||
|
|
pow_2_clk_n = 1;
|
||
|
|
for (i = 0; i < clk_n; ++i)
|
||
|
|
pow_2_clk_n *= 2;
|
||
|
|
clk_m = 2400 / (pow_2_clk_n * speed) - 1;
|
||
|
|
|
||
|
|
i2c->clk = (clk_m << 3) | clk_n;
|
||
|
|
i2c->ctl |= TWI_CTL_BUSEN;
|
||
|
|
i2c->eft = 0;
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
static void sunxi_i2c_bus_setting(int bus_num)
|
||
|
|
{
|
||
|
|
int reg_value = 0;
|
||
|
|
#ifdef CCMU_TWI_BGR_REG
|
||
|
|
//de-assert
|
||
|
|
reg_value = readl(CCMU_TWI_BGR_REG);
|
||
|
|
reg_value |= (1 << (16 + bus_num));
|
||
|
|
writel(reg_value, CCMU_TWI_BGR_REG);
|
||
|
|
|
||
|
|
//gating clock pass
|
||
|
|
reg_value = readl(CCMU_TWI_BGR_REG);
|
||
|
|
reg_value &= ~(1 << bus_num);
|
||
|
|
writel(reg_value, CCMU_TWI_BGR_REG);
|
||
|
|
__msdelay(1);
|
||
|
|
reg_value |= (1 << bus_num);
|
||
|
|
writel(reg_value, CCMU_TWI_BGR_REG);
|
||
|
|
#else
|
||
|
|
/* reset i2c clock */
|
||
|
|
/* reset apb2 twi0 */
|
||
|
|
reg_value = readl(CCMU_BUS_SOFT_RST_REG4);
|
||
|
|
reg_value |= 0x01 << bus_num;
|
||
|
|
writel(reg_value, CCMU_BUS_SOFT_RST_REG4);
|
||
|
|
__msdelay(1);
|
||
|
|
|
||
|
|
reg_value = readl(CCMU_BUS_CLK_GATING_REG3);
|
||
|
|
reg_value &= ~(1 << bus_num);
|
||
|
|
writel(reg_value, CCMU_BUS_CLK_GATING_REG3);
|
||
|
|
__msdelay(1);
|
||
|
|
reg_value |= (1 << bus_num);
|
||
|
|
writel(reg_value, CCMU_BUS_CLK_GATING_REG3);
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int sunxi_i2c_init(int bus_num, int speed, int slaveaddr)
|
||
|
|
{
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
if (sunxi_i2c[bus_num] != NULL) {
|
||
|
|
I2C_ERR("error:i2c has been initialized\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
sunxi_i2c[bus_num] = (struct sunxi_twi_reg *)
|
||
|
|
(SUNXI_TWI0_BASE + (bus_num * TWI_CONTROL_OFFSET));
|
||
|
|
|
||
|
|
ret = gpio_request_simple("twi_para", NULL);
|
||
|
|
|
||
|
|
if (ret) {
|
||
|
|
I2C_ERR("error:fail to set the i2c gpio\n");
|
||
|
|
sunxi_i2c[bus_num] = NULL;
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
sunxi_i2c_bus_setting(bus_num);
|
||
|
|
i2c_set_clock(bus_num, speed);
|
||
|
|
printf("i2c_init ok\n");
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void sunxi_i2c_exit(int bus_num)
|
||
|
|
{
|
||
|
|
int reg_value = 0;
|
||
|
|
#ifdef CCMU_TWI_BGR_REG
|
||
|
|
//gating clock mask
|
||
|
|
reg_value = readl(CCMU_TWI_BGR_REG);
|
||
|
|
reg_value &= ~(1 << bus_num);
|
||
|
|
writel(reg_value, CCMU_TWI_BGR_REG);
|
||
|
|
|
||
|
|
//assert
|
||
|
|
reg_value = readl(CCMU_TWI_BGR_REG);
|
||
|
|
reg_value &= ~(1 << (16 + bus_num));
|
||
|
|
writel(reg_value, CCMU_TWI_BGR_REG);
|
||
|
|
#else
|
||
|
|
reg_value = readl(CCMU_BUS_CLK_GATING_REG3);
|
||
|
|
reg_value &= ~(1 << bus_num);
|
||
|
|
writel(reg_value, CCMU_BUS_CLK_GATING_REG3);
|
||
|
|
#endif
|
||
|
|
sunxi_i2c[bus_num] = NULL;
|
||
|
|
return ;
|
||
|
|
}
|
||
|
|
|
||
|
|
int sunxi_i2c_read(int bus_num, uchar chip, uint addr, int alen, uchar *buffer, int len)
|
||
|
|
{
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
ret = twi_start(bus_num);
|
||
|
|
if (ret)
|
||
|
|
goto i2c_read_err_occur;
|
||
|
|
|
||
|
|
ret = twi_send_slave_addr(bus_num, chip, I2C_WRITE);
|
||
|
|
if (ret)
|
||
|
|
goto i2c_read_err_occur;
|
||
|
|
|
||
|
|
ret = twi_send_addr(bus_num, addr, alen);
|
||
|
|
if (ret)
|
||
|
|
goto i2c_read_err_occur;
|
||
|
|
|
||
|
|
ret = twi_restart(bus_num);
|
||
|
|
if (ret) {
|
||
|
|
goto i2c_read_err_occur;
|
||
|
|
}
|
||
|
|
|
||
|
|
ret = twi_send_slave_addr(bus_num, chip, I2C_READ);
|
||
|
|
if (ret) {
|
||
|
|
goto i2c_read_err_occur;
|
||
|
|
}
|
||
|
|
|
||
|
|
ret = twi_get_data(bus_num, buffer, len);
|
||
|
|
if (ret) {
|
||
|
|
goto i2c_read_err_occur;
|
||
|
|
}
|
||
|
|
|
||
|
|
i2c_read_err_occur:
|
||
|
|
twi_stop(bus_num);
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
int sunxi_i2c_write(int bus_num, uchar chip, uint addr, int alen, uchar *buffer, int len)
|
||
|
|
{
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
ret = twi_start(bus_num);
|
||
|
|
if (ret)
|
||
|
|
goto i2c_write_err_occur;
|
||
|
|
|
||
|
|
ret = twi_send_slave_addr(bus_num, chip, I2C_WRITE);
|
||
|
|
if (ret)
|
||
|
|
goto i2c_write_err_occur;
|
||
|
|
|
||
|
|
ret = twi_send_addr(bus_num, addr, alen);
|
||
|
|
if (ret)
|
||
|
|
goto i2c_write_err_occur;
|
||
|
|
|
||
|
|
ret = twi_send_data(bus_num, buffer, len);
|
||
|
|
if (ret)
|
||
|
|
goto i2c_write_err_occur;
|
||
|
|
|
||
|
|
i2c_write_err_occur:
|
||
|
|
twi_stop(bus_num);
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static s32 i2c_io_null(int bus_num, uchar chip, uint addr, int alen, uchar *buffer, int len)
|
||
|
|
{
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
int i2c_read(uchar chip, uint addr, int alen, uchar *buffer, int len)
|
||
|
|
{
|
||
|
|
return i2c_read_pt(0, chip, addr, alen, buffer, len);
|
||
|
|
}
|
||
|
|
|
||
|
|
int i2c_write(uchar chip, uint addr, int alen, uchar *buffer, int len)
|
||
|
|
{
|
||
|
|
return i2c_write_pt(0, chip, addr, alen, buffer, len);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
#if defined(CONFIG_USE_SECURE_I2C)||defined(CONFIG_CPUS_I2C)
|
||
|
|
|
||
|
|
#include <smc.h>
|
||
|
|
extern int sunxi_probe_secure_monitor(void);
|
||
|
|
static s32 sunxi_i2c_secure_read(int bus_num, uchar chip, uint addr, int alen, uchar *buffer, int len)
|
||
|
|
{
|
||
|
|
int ret = 0;
|
||
|
|
ret = (u8)(arm_svc_arisc_read_pmu((ulong)addr));
|
||
|
|
|
||
|
|
if (ret < 0 ) {
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
*buffer = ret & 0xff;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static s32 sunxi_i2c_secure_write(int bus_num, uchar chip, uint addr, int alen, uchar *buffer, int len)
|
||
|
|
{
|
||
|
|
return arm_svc_arisc_write_pmu((ulong)addr, (u32)(*buffer));
|
||
|
|
}
|
||
|
|
|
||
|
|
void i2c_init(int speed, int slaveaddr)
|
||
|
|
{
|
||
|
|
printf("%s: by cpus\n", __func__);
|
||
|
|
|
||
|
|
if (sunxi_probe_secure_monitor()) {
|
||
|
|
i2c_read_pt = sunxi_i2c_secure_read;
|
||
|
|
i2c_write_pt = sunxi_i2c_secure_write;
|
||
|
|
}
|
||
|
|
|
||
|
|
return ;
|
||
|
|
}
|
||
|
|
|
||
|
|
#else
|
||
|
|
|
||
|
|
static int bus_num = 0;
|
||
|
|
void i2c_init(int speed, int slaveaddr)
|
||
|
|
{
|
||
|
|
printf("%s: by cpux\n", __func__);
|
||
|
|
|
||
|
|
if (!sunxi_i2c_init(bus_num, speed, slaveaddr)) {
|
||
|
|
i2c_read_pt = sunxi_i2c_read;
|
||
|
|
i2c_write_pt = sunxi_i2c_write;
|
||
|
|
}
|
||
|
|
|
||
|
|
return ;
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
|