mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-09-13 00:03:26 +09:00
![Jon Smirl](/assets/img/avatar_default.png)
The previous code waited 1000us before checking i2c status. Measurement shows i2c is usually ready in under 50us. Change the polling interval to 15us, loop 6,667 times to keep the polling timeout constant at 100ms.
394 lines
8.0 KiB
C
394 lines
8.0 KiB
C
/*
|
|
* (C) Copyright 2003
|
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
*
|
|
* See file CREDITS for list of people who contributed to this
|
|
* project.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License as
|
|
* published by the Free Software Foundation; either version 2 of
|
|
* the License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
* MA 02111-1307 USA
|
|
*/
|
|
|
|
#include <common.h>
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
#ifdef CONFIG_HARD_I2C
|
|
|
|
#include <mpc5xxx.h>
|
|
#include <i2c.h>
|
|
|
|
#if (CONFIG_SYS_I2C_MODULE == 2)
|
|
#define I2C_BASE MPC5XXX_I2C2
|
|
#elif (CONFIG_SYS_I2C_MODULE == 1)
|
|
#define I2C_BASE MPC5XXX_I2C1
|
|
#else
|
|
#error CONFIG_SYS_I2C_MODULE is not properly configured
|
|
#endif
|
|
|
|
#define I2C_TIMEOUT 6667
|
|
#define I2C_RETRIES 3
|
|
|
|
struct mpc5xxx_i2c_tap {
|
|
int scl2tap;
|
|
int tap2tap;
|
|
};
|
|
|
|
static int mpc_reg_in (volatile u32 *reg);
|
|
static void mpc_reg_out (volatile u32 *reg, int val, int mask);
|
|
static int wait_for_bb (void);
|
|
static int wait_for_pin (int *status);
|
|
static int do_address (uchar chip, char rdwr_flag);
|
|
static int send_bytes (uchar chip, char *buf, int len);
|
|
static int receive_bytes (uchar chip, char *buf, int len);
|
|
static int mpc_get_fdr (int);
|
|
|
|
static int mpc_reg_in(volatile u32 *reg)
|
|
{
|
|
int ret = *reg >> 24;
|
|
__asm__ __volatile__ ("eieio");
|
|
return ret;
|
|
}
|
|
|
|
static void mpc_reg_out(volatile u32 *reg, int val, int mask)
|
|
{
|
|
int tmp;
|
|
|
|
if (!mask) {
|
|
*reg = val << 24;
|
|
} else {
|
|
tmp = mpc_reg_in(reg);
|
|
*reg = ((tmp & ~mask) | (val & mask)) << 24;
|
|
}
|
|
__asm__ __volatile__ ("eieio");
|
|
|
|
return;
|
|
}
|
|
|
|
static int wait_for_bb(void)
|
|
{
|
|
struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
|
|
int timeout = I2C_TIMEOUT;
|
|
int status;
|
|
|
|
status = mpc_reg_in(®s->msr);
|
|
|
|
while (timeout-- && (status & I2C_BB)) {
|
|
#if 1
|
|
volatile int temp;
|
|
mpc_reg_out(®s->mcr, I2C_STA, I2C_STA);
|
|
temp = mpc_reg_in(®s->mdr);
|
|
mpc_reg_out(®s->mcr, 0, I2C_STA);
|
|
mpc_reg_out(®s->mcr, 0, 0);
|
|
mpc_reg_out(®s->mcr, I2C_EN, 0);
|
|
#endif
|
|
udelay(15);
|
|
status = mpc_reg_in(®s->msr);
|
|
}
|
|
|
|
return (status & I2C_BB);
|
|
}
|
|
|
|
static int wait_for_pin(int *status)
|
|
{
|
|
struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
|
|
int timeout = I2C_TIMEOUT;
|
|
|
|
*status = mpc_reg_in(®s->msr);
|
|
|
|
while (timeout-- && !(*status & I2C_IF)) {
|
|
udelay(15);
|
|
*status = mpc_reg_in(®s->msr);
|
|
}
|
|
|
|
if (!(*status & I2C_IF)) {
|
|
return -1;
|
|
}
|
|
|
|
mpc_reg_out(®s->msr, 0, I2C_IF);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int do_address(uchar chip, char rdwr_flag)
|
|
{
|
|
struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
|
|
int status;
|
|
|
|
chip <<= 1;
|
|
|
|
if (rdwr_flag) {
|
|
chip |= 1;
|
|
}
|
|
|
|
mpc_reg_out(®s->mcr, I2C_TX, I2C_TX);
|
|
mpc_reg_out(®s->mdr, chip, 0);
|
|
|
|
if (wait_for_pin(&status)) {
|
|
return -2;
|
|
}
|
|
|
|
if (status & I2C_RXAK) {
|
|
return -3;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int send_bytes(uchar chip, char *buf, int len)
|
|
{
|
|
struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
|
|
int wrcount;
|
|
int status;
|
|
|
|
for (wrcount = 0; wrcount < len; ++wrcount) {
|
|
|
|
mpc_reg_out(®s->mdr, buf[wrcount], 0);
|
|
|
|
if (wait_for_pin(&status)) {
|
|
break;
|
|
}
|
|
|
|
if (status & I2C_RXAK) {
|
|
break;
|
|
}
|
|
|
|
}
|
|
|
|
return !(wrcount == len);
|
|
}
|
|
|
|
static int receive_bytes(uchar chip, char *buf, int len)
|
|
{
|
|
struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
|
|
int dummy = 1;
|
|
int rdcount = 0;
|
|
int status;
|
|
int i;
|
|
|
|
mpc_reg_out(®s->mcr, 0, I2C_TX);
|
|
|
|
for (i = 0; i < len; ++i) {
|
|
buf[rdcount] = mpc_reg_in(®s->mdr);
|
|
|
|
if (dummy) {
|
|
dummy = 0;
|
|
} else {
|
|
rdcount++;
|
|
}
|
|
|
|
|
|
if (wait_for_pin(&status)) {
|
|
return -4;
|
|
}
|
|
}
|
|
|
|
mpc_reg_out(®s->mcr, I2C_TXAK, I2C_TXAK);
|
|
buf[rdcount++] = mpc_reg_in(®s->mdr);
|
|
|
|
if (wait_for_pin(&status)) {
|
|
return -5;
|
|
}
|
|
|
|
mpc_reg_out(®s->mcr, 0, I2C_TXAK);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**************** I2C API ****************/
|
|
|
|
void i2c_init(int speed, int saddr)
|
|
{
|
|
struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
|
|
|
|
mpc_reg_out(®s->mcr, 0, 0);
|
|
mpc_reg_out(®s->madr, saddr << 1, 0);
|
|
|
|
/* Set clock
|
|
*/
|
|
mpc_reg_out(®s->mfdr, mpc_get_fdr(speed), 0);
|
|
|
|
/* Enable module
|
|
*/
|
|
mpc_reg_out(®s->mcr, I2C_EN, I2C_INIT_MASK);
|
|
mpc_reg_out(®s->msr, 0, I2C_IF);
|
|
|
|
return;
|
|
}
|
|
|
|
static int mpc_get_fdr(int speed)
|
|
{
|
|
static int fdr = -1;
|
|
|
|
if (fdr == -1) {
|
|
ulong best_speed = 0;
|
|
ulong divider;
|
|
ulong ipb, scl;
|
|
ulong bestmatch = 0xffffffffUL;
|
|
int best_i = 0, best_j = 0, i, j;
|
|
int SCL_Tap[] = { 9, 10, 12, 15, 5, 6, 7, 8};
|
|
struct mpc5xxx_i2c_tap scltap[] = {
|
|
{4, 1},
|
|
{4, 2},
|
|
{6, 4},
|
|
{6, 8},
|
|
{14, 16},
|
|
{30, 32},
|
|
{62, 64},
|
|
{126, 128}
|
|
};
|
|
|
|
ipb = gd->ipb_clk;
|
|
for (i = 7; i >= 0; i--) {
|
|
for (j = 7; j >= 0; j--) {
|
|
scl = 2 * (scltap[j].scl2tap +
|
|
(SCL_Tap[i] - 1) * scltap[j].tap2tap + 2);
|
|
if (ipb <= speed*scl) {
|
|
if ((speed*scl - ipb) < bestmatch) {
|
|
bestmatch = speed*scl - ipb;
|
|
best_i = i;
|
|
best_j = j;
|
|
best_speed = ipb/scl;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
divider = (best_i & 3) | ((best_i & 4) << 3) | (best_j << 2);
|
|
if (gd->flags & GD_FLG_RELOC) {
|
|
fdr = divider;
|
|
} else {
|
|
if (gd->have_console)
|
|
printf("%ld kHz, ", best_speed / 1000);
|
|
return divider;
|
|
}
|
|
}
|
|
|
|
return fdr;
|
|
}
|
|
|
|
int i2c_probe(uchar chip)
|
|
{
|
|
struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
|
|
int i;
|
|
|
|
for (i = 0; i < I2C_RETRIES; i++) {
|
|
mpc_reg_out(®s->mcr, I2C_STA, I2C_STA);
|
|
|
|
if (! do_address(chip, 0)) {
|
|
mpc_reg_out(®s->mcr, 0, I2C_STA);
|
|
udelay(500);
|
|
break;
|
|
}
|
|
|
|
mpc_reg_out(®s->mcr, 0, I2C_STA);
|
|
udelay(500);
|
|
}
|
|
|
|
return (i == I2C_RETRIES);
|
|
}
|
|
|
|
int i2c_read(uchar chip, uint addr, int alen, uchar *buf, int len)
|
|
{
|
|
char xaddr[4];
|
|
struct mpc5xxx_i2c * regs = (struct mpc5xxx_i2c *)I2C_BASE;
|
|
int ret = -1;
|
|
|
|
xaddr[0] = (addr >> 24) & 0xFF;
|
|
xaddr[1] = (addr >> 16) & 0xFF;
|
|
xaddr[2] = (addr >> 8) & 0xFF;
|
|
xaddr[3] = addr & 0xFF;
|
|
|
|
if (wait_for_bb()) {
|
|
if (gd->have_console)
|
|
printf("i2c_read: bus is busy\n");
|
|
goto Done;
|
|
}
|
|
|
|
mpc_reg_out(®s->mcr, I2C_STA, I2C_STA);
|
|
if (do_address(chip, 0)) {
|
|
if (gd->have_console)
|
|
printf("i2c_read: failed to address chip\n");
|
|
goto Done;
|
|
}
|
|
|
|
if (send_bytes(chip, &xaddr[4-alen], alen)) {
|
|
if (gd->have_console)
|
|
printf("i2c_read: send_bytes failed\n");
|
|
goto Done;
|
|
}
|
|
|
|
mpc_reg_out(®s->mcr, I2C_RSTA, I2C_RSTA);
|
|
if (do_address(chip, 1)) {
|
|
if (gd->have_console)
|
|
printf("i2c_read: failed to address chip\n");
|
|
goto Done;
|
|
}
|
|
|
|
if (receive_bytes(chip, (char *)buf, len)) {
|
|
if (gd->have_console)
|
|
printf("i2c_read: receive_bytes failed\n");
|
|
goto Done;
|
|
}
|
|
|
|
ret = 0;
|
|
Done:
|
|
mpc_reg_out(®s->mcr, 0, I2C_STA);
|
|
return ret;
|
|
}
|
|
|
|
int i2c_write(uchar chip, uint addr, int alen, uchar *buf, int len)
|
|
{
|
|
char xaddr[4];
|
|
struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
|
|
int ret = -1;
|
|
|
|
xaddr[0] = (addr >> 24) & 0xFF;
|
|
xaddr[1] = (addr >> 16) & 0xFF;
|
|
xaddr[2] = (addr >> 8) & 0xFF;
|
|
xaddr[3] = addr & 0xFF;
|
|
|
|
if (wait_for_bb()) {
|
|
if (gd->have_console)
|
|
printf("i2c_write: bus is busy\n");
|
|
goto Done;
|
|
}
|
|
|
|
mpc_reg_out(®s->mcr, I2C_STA, I2C_STA);
|
|
if (do_address(chip, 0)) {
|
|
if (gd->have_console)
|
|
printf("i2c_write: failed to address chip\n");
|
|
goto Done;
|
|
}
|
|
|
|
if (send_bytes(chip, &xaddr[4-alen], alen)) {
|
|
if (gd->have_console)
|
|
printf("i2c_write: send_bytes failed\n");
|
|
goto Done;
|
|
}
|
|
|
|
if (send_bytes(chip, (char *)buf, len)) {
|
|
if (gd->have_console)
|
|
printf("i2c_write: send_bytes failed\n");
|
|
goto Done;
|
|
}
|
|
|
|
ret = 0;
|
|
Done:
|
|
mpc_reg_out(®s->mcr, 0, I2C_STA);
|
|
return ret;
|
|
}
|
|
|
|
#endif /* CONFIG_HARD_I2C */
|