cpu/mpc5xxx/i2c.c

   1 /*
   2  * (C) Copyright 2003
   3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23
  24 #include <common.h>
  25
  26 #ifdef CONFIG_HARD_I2C
  27
  28 #include <mpc5xxx.h>
  29 #include <i2c.h>
  30
  31 #if (CFG_I2C_MODULE == 2)
  32 #define I2C_BASE        MPC5XXX_I2C2
  33 #elif (CFG_I2C_MODULE == 1)
  34 #define I2C_BASE        MPC5XXX_I2C1
  35 #else
  36 #error CFG_I2C_MODULE is not properly configured
  37 #endif
  38
  39 #define I2C_TIMEOUT     100
  40 #define I2C_RETRIES     3
  41
  42 struct mpc5xxx_i2c_tap {
  43         int scl2tap;
  44         int tap2tap;
  45 };
  46
  47 static int  mpc_reg_in    (volatile u32 *reg);
  48 static void mpc_reg_out   (volatile u32 *reg, int val, int mask);
  49 static int  wait_for_bb   (void);
  50 static int  wait_for_pin  (int *status);
  51 static int  do_address    (uchar chip, char rdwr_flag);
  52 static int  send_bytes    (uchar chip, char *buf, int len);
  53 static int  receive_bytes (uchar chip, char *buf, int len);
  54 static int  mpc_get_fdr   (int);
  55
  56 static int mpc_reg_in(volatile u32 *reg)
  57 {
  58         int ret = *reg >> 24;
  59         __asm__ __volatile__ ("eieio");
  60         return ret;
  61 }
  62
  63 static void mpc_reg_out(volatile u32 *reg, int val, int mask)
  64 {
  65         int tmp;
  66
  67         if (!mask) {
  68                 *reg = val << 24;
  69         } else {
  70                 tmp = mpc_reg_in(reg);
  71                 *reg = ((tmp & ~mask) | (val & mask)) << 24;
  72         }
  73         __asm__ __volatile__ ("eieio");
  74
  75         return;
  76 }
  77
  78 static int wait_for_bb(void)
  79 {
  80         struct mpc5xxx_i2c *regs    = (struct mpc5xxx_i2c *)I2C_BASE;
  81         int                 timeout = I2C_TIMEOUT;
  82         int                 status;
  83
  84         status = mpc_reg_in(&regs->msr);
  85
  86         while (timeout-- && (status & I2C_BB)) {
  87 #if 1
  88                 volatile int temp;
  89                 mpc_reg_out(&regs->mcr, I2C_STA, I2C_STA);
  90                 temp = mpc_reg_in(&regs->mdr);
  91                 mpc_reg_out(&regs->mcr, 0, I2C_STA);
  92                 mpc_reg_out(&regs->mcr, 0, 0);
  93                 mpc_reg_out(&regs->mcr, I2C_EN, 0);
  94 #endif
  95                 udelay(1000);
  96                 status = mpc_reg_in(&regs->msr);
  97         }
  98
  99         return (status & I2C_BB);
 100 }
 101
 102 static int wait_for_pin(int *status)
 103 {
 104         struct mpc5xxx_i2c *regs    = (struct mpc5xxx_i2c *)I2C_BASE;
 105         int                 timeout = I2C_TIMEOUT;
 106
 107         *status = mpc_reg_in(&regs->msr);
 108
 109         while (timeout-- && !(*status & I2C_IF)) {
 110                 udelay(1000);
 111                 *status = mpc_reg_in(&regs->msr);
 112         }
 113
 114         if (!(*status & I2C_IF)) {
 115                 return -1;
 116         }
 117
 118         mpc_reg_out(&regs->msr, 0, I2C_IF);
 119
 120         return 0;
 121 }
 122
 123 static int do_address(uchar chip, char rdwr_flag)
 124 {
 125         struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
 126         int                 status;
 127
 128         chip <<= 1;
 129
 130         if (rdwr_flag) {
 131                 chip |= 1;
 132         }
 133
 134         mpc_reg_out(&regs->mcr, I2C_TX, I2C_TX);
 135         mpc_reg_out(&regs->mdr, chip, 0);
 136
 137         if (wait_for_pin(&status)) {
 138                 return -2;
 139         }
 140
 141         if (status & I2C_RXAK) {
 142                 return -3;
 143         }
 144
 145         return 0;
 146 }
 147
 148 static int send_bytes(uchar chip, char *buf, int len)
 149 {
 150         struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
 151         int                 wrcount;
 152         int                 status;
 153
 154         for (wrcount = 0; wrcount < len; ++wrcount) {
 155
 156                 mpc_reg_out(&regs->mdr, buf[wrcount], 0);
 157
 158                 if (wait_for_pin(&status)) {
 159                         break;
 160                 }
 161
 162                 if (status & I2C_RXAK) {
 163                         break;
 164                 }
 165
 166         }
 167
 168         return !(wrcount == len);
 169 }
 170
 171 static int receive_bytes(uchar chip, char *buf, int len)
 172 {
 173         struct mpc5xxx_i2c *regs    = (struct mpc5xxx_i2c *)I2C_BASE;
 174         int                 dummy   = 1;
 175         int                 rdcount = 0;
 176         int                 status;
 177         int                 i;
 178
 179         mpc_reg_out(&regs->mcr, 0, I2C_TX);
 180
 181         for (i = 0; i < len; ++i) {
 182                 buf[rdcount] = mpc_reg_in(&regs->mdr);
 183
 184                 if (dummy) {
 185                         dummy = 0;
 186                 } else {
 187                         rdcount++;
 188                 }
 189
 190
 191                 if (wait_for_pin(&status)) {
 192                         return -4;
 193                 }
 194         }
 195
 196         mpc_reg_out(&regs->mcr, I2C_TXAK, I2C_TXAK);
 197         buf[rdcount++] = mpc_reg_in(&regs->mdr);
 198
 199         if (wait_for_pin(&status)) {
 200                 return -5;
 201         }
 202
 203         mpc_reg_out(&regs->mcr, 0, I2C_TXAK);
 204
 205         return 0;
 206 }
 207
 208 /**************** I2C API ****************/
 209
 210 void i2c_init(int speed, int saddr)
 211 {
 212         struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
 213
 214         mpc_reg_out(&regs->mcr, 0, 0);
 215         mpc_reg_out(&regs->madr, saddr << 1, 0);
 216
 217         /* Set clock
 218          */
 219         mpc_reg_out(&regs->mfdr, mpc_get_fdr(speed), 0);
 220
 221         /* Enable module
 222          */
 223         mpc_reg_out(&regs->mcr, I2C_EN, I2C_INIT_MASK);
 224         mpc_reg_out(&regs->msr, 0, I2C_IF);
 225
 226         return;
 227 }
 228
 229 static int mpc_get_fdr(int speed)
 230 {
 231         DECLARE_GLOBAL_DATA_PTR;
 232         static int fdr = -1;
 233
 234         if (fdr == -1) {
 235                 ulong best_speed = 0;
 236                 ulong divider;
 237                 ulong ipb, scl;
 238                 ulong bestmatch = 0xffffffffUL;
 239                 int best_i = 0, best_j = 0, i, j;
 240                 int SCL_Tap[] = { 9, 10, 12, 15, 5, 6, 7, 8};
 241                 struct mpc5xxx_i2c_tap scltap[] = {
 242                         {4, 1},
 243                         {4, 2},
 244                         {6, 4},
 245                         {6, 8},
 246                         {14, 16},
 247                         {30, 32},
 248                         {62, 64},
 249                         {126, 128}
 250                 };
 251
 252                 ipb = gd->ipb_clk;
 253                 for (i = 7; i >= 0; i--) {
 254                         for (j = 7; j >= 0; j--) {
 255                                 scl = 2 * (scltap[j].scl2tap +
 256                                         (SCL_Tap[i] - 1) * scltap[j].tap2tap + 2);
 257                                 if (ipb <= speed*scl) {
 258                                         if ((speed*scl - ipb) < bestmatch) {
 259                                                 bestmatch = speed*scl - ipb;
 260                                                 best_i = i;
 261                                                 best_j = j;
 262                                                 best_speed = ipb/scl;
 263                                         }
 264                                 }
 265                         }
 266                 }
 267                 divider = (best_i & 3) | ((best_i & 4) << 3) | (best_j << 2);
 268                 if (gd->flags & GD_FLG_RELOC) {
 269                         fdr = divider;
 270                 } else {
 271                         printf("%ld kHz, ", best_speed / 1000);
 272                         return divider;
 273                 }
 274         }
 275
 276         return fdr;
 277 }
 278
 279 int i2c_probe(uchar chip)
 280 {
 281         struct mpc5xxx_i2c *regs = (struct mpc5xxx_i2c *)I2C_BASE;
 282         int                 i;
 283
 284         for (i = 0; i < I2C_RETRIES; i++) {
 285                 mpc_reg_out(&regs->mcr, I2C_STA, I2C_STA);
 286
 287                 if (! do_address(chip, 0)) {
 288                         mpc_reg_out(&regs->mcr, 0, I2C_STA);
 289                         udelay(500);
 290                         break;
 291                 }
 292
 293                 mpc_reg_out(&regs->mcr, 0, I2C_STA);
 294                 udelay(500);
 295         }
 296
 297         return (i == I2C_RETRIES);
 298 }
 299
 300 int i2c_read(uchar chip, uint addr, int alen, uchar *buf, int len)
 301 {
 302         char                xaddr[4];
 303         struct mpc5xxx_i2c * regs        = (struct mpc5xxx_i2c *)I2C_BASE;
 304         int                  ret         = -1;
 305
 306         xaddr[0] = (addr >> 24) & 0xFF;
 307         xaddr[1] = (addr >> 16) & 0xFF;
 308         xaddr[2] = (addr >>  8) & 0xFF;
 309         xaddr[3] =  addr        & 0xFF;
 310
 311         if (wait_for_bb()) {
 312                 printf("i2c_read: bus is busy\n");
 313                 goto Done;
 314         }
 315
 316         mpc_reg_out(&regs->mcr, I2C_STA, I2C_STA);
 317         if (do_address(chip, 0)) {
 318                 printf("i2c_read: failed to address chip\n");
 319                 goto Done;
 320         }
 321
 322         if (send_bytes(chip, &xaddr[4-alen], alen)) {
 323                 printf("i2c_read: send_bytes failed\n");
 324                 goto Done;
 325         }
 326
 327         mpc_reg_out(&regs->mcr, I2C_RSTA, I2C_RSTA);
 328         if (do_address(chip, 1)) {
 329                 printf("i2c_read: failed to address chip\n");
 330                 goto Done;
 331         }
 332
 333         if (receive_bytes(chip, (char *)buf, len)) {
 334                 printf("i2c_read: receive_bytes failed\n");
 335                 goto Done;
 336         }
 337
 338         ret = 0;
 339 Done:
 340         mpc_reg_out(&regs->mcr, 0, I2C_STA);
 341         return ret;
 342 }
 343
 344 int i2c_write(uchar chip, uint addr, int alen, uchar *buf, int len)
 345 {
 346         char               xaddr[4];
 347         struct mpc5xxx_i2c *regs        = (struct mpc5xxx_i2c *)I2C_BASE;
 348         int                 ret         = -1;
 349
 350         xaddr[0] = (addr >> 24) & 0xFF;
 351         xaddr[1] = (addr >> 16) & 0xFF;
 352         xaddr[2] = (addr >>  8) & 0xFF;
 353         xaddr[3] =  addr        & 0xFF;
 354
 355         if (wait_for_bb()) {
 356                 printf("i2c_write: bus is busy\n");
 357                 goto Done;
 358         }
 359
 360         mpc_reg_out(&regs->mcr, I2C_STA, I2C_STA);
 361         if (do_address(chip, 0)) {
 362                 printf("i2c_write: failed to address chip\n");
 363                 goto Done;
 364         }
 365
 366         if (send_bytes(chip, &xaddr[4-alen], alen)) {
 367                 printf("i2c_write: send_bytes failed\n");
 368                 goto Done;
 369         }
 370
 371         if (send_bytes(chip, (char *)buf, len)) {
 372                 printf("i2c_write: send_bytes failed\n");
 373                 goto Done;
 374         }
 375
 376         ret = 0;
 377 Done:
 378         mpc_reg_out(&regs->mcr, 0, I2C_STA);
 379         return ret;
 380 }
 381
 382 uchar i2c_reg_read(uchar chip, uchar reg)
 383 {
 384         uchar buf;
 385
 386         i2c_read(chip, reg, 1, &buf, 1);
 387
 388         return buf;
 389 }
 390
 391 void i2c_reg_write(uchar chip, uchar reg, uchar val)
 392 {
 393         i2c_write(chip, reg, 1, &val, 1);
 394
 395         return;
 396 }
 397
 398 #endif  /* CONFIG_HARD_I2C */