| /* |
| * (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 100 |
| #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(1000); |
| 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(1000); |
| *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 { |
| 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()) { |
| printf("i2c_read: bus is busy\n"); |
| goto Done; |
| } |
| |
| mpc_reg_out(®s->mcr, I2C_STA, I2C_STA); |
| if (do_address(chip, 0)) { |
| printf("i2c_read: failed to address chip\n"); |
| goto Done; |
| } |
| |
| if (send_bytes(chip, &xaddr[4-alen], alen)) { |
| printf("i2c_read: send_bytes failed\n"); |
| goto Done; |
| } |
| |
| mpc_reg_out(®s->mcr, I2C_RSTA, I2C_RSTA); |
| if (do_address(chip, 1)) { |
| printf("i2c_read: failed to address chip\n"); |
| goto Done; |
| } |
| |
| if (receive_bytes(chip, (char *)buf, len)) { |
| 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()) { |
| printf("i2c_write: bus is busy\n"); |
| goto Done; |
| } |
| |
| mpc_reg_out(®s->mcr, I2C_STA, I2C_STA); |
| if (do_address(chip, 0)) { |
| printf("i2c_write: failed to address chip\n"); |
| goto Done; |
| } |
| |
| if (send_bytes(chip, &xaddr[4-alen], alen)) { |
| printf("i2c_write: send_bytes failed\n"); |
| goto Done; |
| } |
| |
| if (send_bytes(chip, (char *)buf, len)) { |
| printf("i2c_write: send_bytes failed\n"); |
| goto Done; |
| } |
| |
| ret = 0; |
| Done: |
| mpc_reg_out(®s->mcr, 0, I2C_STA); |
| return ret; |
| } |
| |
| uchar i2c_reg_read(uchar chip, uchar reg) |
| { |
| uchar buf; |
| |
| i2c_read(chip, reg, 1, &buf, 1); |
| |
| return buf; |
| } |
| |
| void i2c_reg_write(uchar chip, uchar reg, uchar val) |
| { |
| i2c_write(chip, reg, 1, &val, 1); |
| |
| return; |
| } |
| |
| #endif /* CONFIG_HARD_I2C */ |