|
|
|
@ -43,12 +43,18 @@ static struct sh_i2c *base; |
|
|
|
|
#define SH_I2C_ICCR_SCP (1 << 0) |
|
|
|
|
|
|
|
|
|
/* ICSR / ICIC */ |
|
|
|
|
#define SH_IC_BUSY (1 << 3) |
|
|
|
|
#define SH_IC_BUSY (1 << 4) |
|
|
|
|
#define SH_IC_TACK (1 << 2) |
|
|
|
|
#define SH_IC_WAIT (1 << 1) |
|
|
|
|
#define SH_IC_DTE (1 << 0) |
|
|
|
|
|
|
|
|
|
static u8 iccl, icch; |
|
|
|
|
#ifdef CONFIG_SH_I2C_8BIT |
|
|
|
|
/* store 8th bit of iccl and icch in ICIC register */ |
|
|
|
|
#define SH_I2C_ICIC_ICCLB8 (1 << 7) |
|
|
|
|
#define SH_I2C_ICIC_ICCHB8 (1 << 6) |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
static u16 iccl, icch; |
|
|
|
|
|
|
|
|
|
#define IRQ_WAIT 1000 |
|
|
|
|
|
|
|
|
@ -63,6 +69,20 @@ static void irq_dte(struct sh_i2c *base) |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static int irq_dte_with_tack(struct sh_i2c *base) |
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
|
|
|
|
|
|
for (i = 0 ; i < IRQ_WAIT ; i++) { |
|
|
|
|
if (SH_IC_DTE & readb(&base->icsr)) |
|
|
|
|
break; |
|
|
|
|
if (SH_IC_TACK & readb(&base->icsr)) |
|
|
|
|
return -1; |
|
|
|
|
udelay(10); |
|
|
|
|
} |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void irq_busy(struct sh_i2c *base) |
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
@ -74,71 +94,97 @@ static void irq_busy(struct sh_i2c *base) |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void i2c_set_addr(struct sh_i2c *base, u8 id, u8 reg, int stop) |
|
|
|
|
static int i2c_set_addr(struct sh_i2c *base, u8 id, u8 reg, int stop) |
|
|
|
|
{ |
|
|
|
|
writeb(readb(&base->iccr) & ~SH_I2C_ICCR_ICE, &base->iccr); |
|
|
|
|
writeb(readb(&base->iccr) | SH_I2C_ICCR_ICE, &base->iccr); |
|
|
|
|
|
|
|
|
|
writeb(iccl, &base->iccl); |
|
|
|
|
writeb(icch, &base->icch); |
|
|
|
|
writeb(0, &base->icic); |
|
|
|
|
u8 icic = SH_IC_TACK; |
|
|
|
|
|
|
|
|
|
clrbits_8(&base->iccr, SH_I2C_ICCR_ICE); |
|
|
|
|
setbits_8(&base->iccr, SH_I2C_ICCR_ICE); |
|
|
|
|
|
|
|
|
|
writeb(iccl & 0xff, &base->iccl); |
|
|
|
|
writeb(icch & 0xff, &base->icch); |
|
|
|
|
#ifdef CONFIG_SH_I2C_8BIT |
|
|
|
|
if (iccl > 0xff) |
|
|
|
|
icic |= SH_I2C_ICIC_ICCLB8; |
|
|
|
|
if (icch > 0xff) |
|
|
|
|
icic |= SH_I2C_ICIC_ICCHB8; |
|
|
|
|
#endif |
|
|
|
|
writeb(icic, &base->icic); |
|
|
|
|
|
|
|
|
|
writeb((SH_I2C_ICCR_ICE|SH_I2C_ICCR_RTS|SH_I2C_ICCR_BUSY), &base->iccr); |
|
|
|
|
irq_dte(base); |
|
|
|
|
|
|
|
|
|
clrbits_8(&base->icsr, SH_IC_TACK); |
|
|
|
|
writeb(id << 1, &base->icdr); |
|
|
|
|
irq_dte(base); |
|
|
|
|
if (irq_dte_with_tack(base) != 0) |
|
|
|
|
return -1; |
|
|
|
|
|
|
|
|
|
writeb(reg, &base->icdr); |
|
|
|
|
if (stop) |
|
|
|
|
writeb((SH_I2C_ICCR_ICE|SH_I2C_ICCR_RTS), &base->iccr); |
|
|
|
|
|
|
|
|
|
irq_dte(base); |
|
|
|
|
if (irq_dte_with_tack(base) != 0) |
|
|
|
|
return -1; |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void i2c_finish(struct sh_i2c *base) |
|
|
|
|
{ |
|
|
|
|
writeb(0, &base->icsr); |
|
|
|
|
writeb(readb(&base->iccr) & ~SH_I2C_ICCR_ICE, &base->iccr); |
|
|
|
|
clrbits_8(&base->iccr, SH_I2C_ICCR_ICE); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void i2c_raw_write(struct sh_i2c *base, u8 id, u8 reg, u8 val) |
|
|
|
|
static int i2c_raw_write(struct sh_i2c *base, u8 id, u8 reg, u8 val) |
|
|
|
|
{ |
|
|
|
|
i2c_set_addr(base, id, reg, 0); |
|
|
|
|
int ret = -1; |
|
|
|
|
if (i2c_set_addr(base, id, reg, 0) != 0) |
|
|
|
|
goto exit0; |
|
|
|
|
udelay(10); |
|
|
|
|
|
|
|
|
|
writeb(val, &base->icdr); |
|
|
|
|
irq_dte(base); |
|
|
|
|
if (irq_dte_with_tack(base) != 0) |
|
|
|
|
goto exit0; |
|
|
|
|
|
|
|
|
|
writeb((SH_I2C_ICCR_ICE | SH_I2C_ICCR_RTS), &base->iccr); |
|
|
|
|
irq_dte(base); |
|
|
|
|
if (irq_dte_with_tack(base) != 0) |
|
|
|
|
goto exit0; |
|
|
|
|
irq_busy(base); |
|
|
|
|
|
|
|
|
|
ret = 0; |
|
|
|
|
exit0: |
|
|
|
|
i2c_finish(base); |
|
|
|
|
return ret; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static u8 i2c_raw_read(struct sh_i2c *base, u8 id, u8 reg) |
|
|
|
|
static int i2c_raw_read(struct sh_i2c *base, u8 id, u8 reg) |
|
|
|
|
{ |
|
|
|
|
u8 ret; |
|
|
|
|
|
|
|
|
|
i2c_set_addr(base, id, reg, 1); |
|
|
|
|
int ret = -1; |
|
|
|
|
|
|
|
|
|
#if defined(CONFIG_SH73A0) |
|
|
|
|
if (i2c_set_addr(base, id, reg, 0) != 0) |
|
|
|
|
goto exit0; |
|
|
|
|
#else |
|
|
|
|
if (i2c_set_addr(base, id, reg, 1) != 0) |
|
|
|
|
goto exit0; |
|
|
|
|
udelay(100); |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
writeb((SH_I2C_ICCR_ICE|SH_I2C_ICCR_RTS|SH_I2C_ICCR_BUSY), &base->iccr); |
|
|
|
|
irq_dte(base); |
|
|
|
|
|
|
|
|
|
writeb(id << 1 | 0x01, &base->icdr); |
|
|
|
|
irq_dte(base); |
|
|
|
|
if (irq_dte_with_tack(base) != 0) |
|
|
|
|
goto exit0; |
|
|
|
|
|
|
|
|
|
writeb((SH_I2C_ICCR_ICE|SH_I2C_ICCR_SCP), &base->iccr); |
|
|
|
|
irq_dte(base); |
|
|
|
|
if (irq_dte_with_tack(base) != 0) |
|
|
|
|
goto exit0; |
|
|
|
|
|
|
|
|
|
ret = readb(&base->icdr); |
|
|
|
|
ret = readb(&base->icdr) & 0xff; |
|
|
|
|
|
|
|
|
|
writeb((SH_I2C_ICCR_ICE|SH_I2C_ICCR_RACK), &base->iccr); |
|
|
|
|
readb(&base->icdr); /* Dummy read */ |
|
|
|
|
irq_busy(base); |
|
|
|
|
|
|
|
|
|
exit0: |
|
|
|
|
i2c_finish(base); |
|
|
|
|
|
|
|
|
|
return ret; |
|
|
|
@ -166,6 +212,21 @@ int i2c_set_bus_num(unsigned int bus) |
|
|
|
|
case 1: |
|
|
|
|
base = (void *)CONFIG_SH_I2C_BASE1; |
|
|
|
|
break; |
|
|
|
|
#ifdef CONFIG_SH_I2C_BASE2 |
|
|
|
|
case 2: |
|
|
|
|
base = (void *)CONFIG_SH_I2C_BASE2; |
|
|
|
|
break; |
|
|
|
|
#endif |
|
|
|
|
#ifdef CONFIG_SH_I2C_BASE3 |
|
|
|
|
case 3: |
|
|
|
|
base = (void *)CONFIG_SH_I2C_BASE3; |
|
|
|
|
break; |
|
|
|
|
#endif |
|
|
|
|
#ifdef CONFIG_SH_I2C_BASE4 |
|
|
|
|
case 4: |
|
|
|
|
base = (void *)CONFIG_SH_I2C_BASE4; |
|
|
|
|
break; |
|
|
|
|
#endif |
|
|
|
|
default: |
|
|
|
|
return -1; |
|
|
|
|
} |
|
|
|
@ -206,18 +267,18 @@ void i2c_init(int speed, int slaveaddr) |
|
|
|
|
denom = speed * (CONFIG_SH_I2C_DATA_HIGH + CONFIG_SH_I2C_DATA_LOW); |
|
|
|
|
tmp = num * 10 / denom; |
|
|
|
|
if (tmp % 10 >= 5) |
|
|
|
|
iccl = (u8)((num/denom) + 1); |
|
|
|
|
iccl = (u16)((num/denom) + 1); |
|
|
|
|
else |
|
|
|
|
iccl = (u8)(num/denom); |
|
|
|
|
iccl = (u16)(num/denom); |
|
|
|
|
|
|
|
|
|
/* Calculate the value for icch. From the data sheet:
|
|
|
|
|
icch = (p clock / transfer rate) * (H / (L + H)) */ |
|
|
|
|
num = CONFIG_SH_I2C_CLOCK * CONFIG_SH_I2C_DATA_HIGH; |
|
|
|
|
tmp = num * 10 / denom; |
|
|
|
|
if (tmp % 10 >= 5) |
|
|
|
|
icch = (u8)((num/denom) + 1); |
|
|
|
|
icch = (u16)((num/denom) + 1); |
|
|
|
|
else |
|
|
|
|
icch = (u8)(num/denom); |
|
|
|
|
icch = (u16)(num/denom); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
@ -235,10 +296,14 @@ void i2c_init(int speed, int slaveaddr) |
|
|
|
|
*/ |
|
|
|
|
int i2c_read(u8 chip, u32 addr, int alen, u8 *buffer, int len) |
|
|
|
|
{ |
|
|
|
|
int ret; |
|
|
|
|
int i = 0; |
|
|
|
|
for (i = 0 ; i < len ; i++) |
|
|
|
|
buffer[i] = i2c_raw_read(base, chip, addr + i); |
|
|
|
|
|
|
|
|
|
for (i = 0 ; i < len ; i++) { |
|
|
|
|
ret = i2c_raw_read(base, chip, addr + i); |
|
|
|
|
if (ret < 0) |
|
|
|
|
return -1; |
|
|
|
|
buffer[i] = ret & 0xff; |
|
|
|
|
} |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -259,8 +324,8 @@ int i2c_write(u8 chip, u32 addr, int alen, u8 *buffer, int len) |
|
|
|
|
{ |
|
|
|
|
int i = 0; |
|
|
|
|
for (i = 0; i < len ; i++) |
|
|
|
|
i2c_raw_write(base, chip, addr + i, buffer[i]); |
|
|
|
|
|
|
|
|
|
if (i2c_raw_write(base, chip, addr + i, buffer[i]) != 0) |
|
|
|
|
return -1; |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -272,5 +337,9 @@ int i2c_write(u8 chip, u32 addr, int alen, u8 *buffer, int len) |
|
|
|
|
*/ |
|
|
|
|
int i2c_probe(u8 chip) |
|
|
|
|
{ |
|
|
|
|
return 0; |
|
|
|
|
int ret; |
|
|
|
|
|
|
|
|
|
ret = i2c_set_addr(base, chip, 0, 1); |
|
|
|
|
i2c_finish(base); |
|
|
|
|
return ret; |
|
|
|
|
} |
|
|
|
|