Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 1 | /* |
| 2 | * Freescale CPM1/CPM2 I2C interface. |
| 3 | * Copyright (c) 1999 Dan Malek (dmalek@jlc.net). |
| 4 | * |
| 5 | * moved into proper i2c interface; |
| 6 | * Brad Parker (brad@heeltoe.com) |
| 7 | * |
| 8 | * Parts from dbox2_i2c.c (cvs.tuxbox.org) |
| 9 | * (C) 2000-2001 Felix Domke (tmbinc@gmx.net), Gillem (htoa@gmx.net) |
| 10 | * |
| 11 | * (C) 2007 Montavista Software, Inc. |
| 12 | * Vitaly Bordug <vitb@kernel.crashing.org> |
| 13 | * |
| 14 | * Converted to of_platform_device. Renamed to i2c-cpm.c. |
| 15 | * (C) 2007,2008 Jochen Friedrich <jochen@scram.de> |
| 16 | * |
| 17 | * This program is free software; you can redistribute it and/or modify |
| 18 | * it under the terms of the GNU General Public License as published by |
| 19 | * the Free Software Foundation; either version 2 of the License, or |
| 20 | * (at your option) any later version. |
| 21 | * |
| 22 | * This program is distributed in the hope that it will be useful, |
| 23 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 24 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 25 | * GNU General Public License for more details. |
| 26 | * |
| 27 | * You should have received a copy of the GNU General Public License |
| 28 | * along with this program; if not, write to the Free Software |
| 29 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| 30 | */ |
| 31 | |
| 32 | #include <linux/kernel.h> |
| 33 | #include <linux/module.h> |
| 34 | #include <linux/delay.h> |
| 35 | #include <linux/slab.h> |
| 36 | #include <linux/init.h> |
| 37 | #include <linux/interrupt.h> |
| 38 | #include <linux/errno.h> |
| 39 | #include <linux/stddef.h> |
| 40 | #include <linux/i2c.h> |
| 41 | #include <linux/io.h> |
| 42 | #include <linux/dma-mapping.h> |
| 43 | #include <linux/of_device.h> |
| 44 | #include <linux/of_platform.h> |
| 45 | #include <linux/of_i2c.h> |
| 46 | #include <sysdev/fsl_soc.h> |
| 47 | #include <asm/cpm.h> |
| 48 | |
| 49 | /* Try to define this if you have an older CPU (earlier than rev D4) */ |
| 50 | /* However, better use a GPIO based bitbang driver in this case :/ */ |
| 51 | #undef I2C_CHIP_ERRATA |
| 52 | |
| 53 | #define CPM_MAX_READ 513 |
| 54 | #define CPM_MAXBD 4 |
| 55 | |
| 56 | #define I2C_EB (0x10) /* Big endian mode */ |
| 57 | #define I2C_EB_CPM2 (0x30) /* Big endian mode, memory snoop */ |
| 58 | |
| 59 | #define DPRAM_BASE ((u8 __iomem __force *)cpm_muram_addr(0)) |
| 60 | |
| 61 | /* I2C parameter RAM. */ |
| 62 | struct i2c_ram { |
| 63 | ushort rbase; /* Rx Buffer descriptor base address */ |
| 64 | ushort tbase; /* Tx Buffer descriptor base address */ |
| 65 | u_char rfcr; /* Rx function code */ |
| 66 | u_char tfcr; /* Tx function code */ |
| 67 | ushort mrblr; /* Max receive buffer length */ |
| 68 | uint rstate; /* Internal */ |
| 69 | uint rdp; /* Internal */ |
| 70 | ushort rbptr; /* Rx Buffer descriptor pointer */ |
| 71 | ushort rbc; /* Internal */ |
| 72 | uint rxtmp; /* Internal */ |
| 73 | uint tstate; /* Internal */ |
| 74 | uint tdp; /* Internal */ |
| 75 | ushort tbptr; /* Tx Buffer descriptor pointer */ |
| 76 | ushort tbc; /* Internal */ |
| 77 | uint txtmp; /* Internal */ |
| 78 | char res1[4]; /* Reserved */ |
| 79 | ushort rpbase; /* Relocation pointer */ |
| 80 | char res2[2]; /* Reserved */ |
| 81 | }; |
| 82 | |
| 83 | #define I2COM_START 0x80 |
| 84 | #define I2COM_MASTER 0x01 |
| 85 | #define I2CER_TXE 0x10 |
| 86 | #define I2CER_BUSY 0x04 |
| 87 | #define I2CER_TXB 0x02 |
| 88 | #define I2CER_RXB 0x01 |
| 89 | #define I2MOD_EN 0x01 |
| 90 | |
| 91 | /* I2C Registers */ |
| 92 | struct i2c_reg { |
| 93 | u8 i2mod; |
| 94 | u8 res1[3]; |
| 95 | u8 i2add; |
| 96 | u8 res2[3]; |
| 97 | u8 i2brg; |
| 98 | u8 res3[3]; |
| 99 | u8 i2com; |
| 100 | u8 res4[3]; |
| 101 | u8 i2cer; |
| 102 | u8 res5[3]; |
| 103 | u8 i2cmr; |
| 104 | }; |
| 105 | |
| 106 | struct cpm_i2c { |
| 107 | char *base; |
Grant Likely | 2dc1158 | 2010-08-06 09:25:50 -0600 | [diff] [blame] | 108 | struct platform_device *ofdev; |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 109 | struct i2c_adapter adap; |
| 110 | uint dp_addr; |
| 111 | int version; /* CPM1=1, CPM2=2 */ |
| 112 | int irq; |
| 113 | int cp_command; |
| 114 | int freq; |
| 115 | struct i2c_reg __iomem *i2c_reg; |
| 116 | struct i2c_ram __iomem *i2c_ram; |
| 117 | u16 i2c_addr; |
| 118 | wait_queue_head_t i2c_wait; |
| 119 | cbd_t __iomem *tbase; |
| 120 | cbd_t __iomem *rbase; |
| 121 | u_char *txbuf[CPM_MAXBD]; |
| 122 | u_char *rxbuf[CPM_MAXBD]; |
| 123 | u32 txdma[CPM_MAXBD]; |
| 124 | u32 rxdma[CPM_MAXBD]; |
| 125 | }; |
| 126 | |
| 127 | static irqreturn_t cpm_i2c_interrupt(int irq, void *dev_id) |
| 128 | { |
| 129 | struct cpm_i2c *cpm; |
| 130 | struct i2c_reg __iomem *i2c_reg; |
| 131 | struct i2c_adapter *adap = dev_id; |
| 132 | int i; |
| 133 | |
| 134 | cpm = i2c_get_adapdata(dev_id); |
| 135 | i2c_reg = cpm->i2c_reg; |
| 136 | |
| 137 | /* Clear interrupt. */ |
| 138 | i = in_8(&i2c_reg->i2cer); |
| 139 | out_8(&i2c_reg->i2cer, i); |
| 140 | |
| 141 | dev_dbg(&adap->dev, "Interrupt: %x\n", i); |
| 142 | |
Michael Trimarchi | dc1972d | 2009-06-19 14:50:02 +0200 | [diff] [blame] | 143 | wake_up(&cpm->i2c_wait); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 144 | |
| 145 | return i ? IRQ_HANDLED : IRQ_NONE; |
| 146 | } |
| 147 | |
| 148 | static void cpm_reset_i2c_params(struct cpm_i2c *cpm) |
| 149 | { |
| 150 | struct i2c_ram __iomem *i2c_ram = cpm->i2c_ram; |
| 151 | |
| 152 | /* Set up the I2C parameters in the parameter ram. */ |
| 153 | out_be16(&i2c_ram->tbase, (u8 __iomem *)cpm->tbase - DPRAM_BASE); |
| 154 | out_be16(&i2c_ram->rbase, (u8 __iomem *)cpm->rbase - DPRAM_BASE); |
| 155 | |
| 156 | if (cpm->version == 1) { |
| 157 | out_8(&i2c_ram->tfcr, I2C_EB); |
| 158 | out_8(&i2c_ram->rfcr, I2C_EB); |
| 159 | } else { |
| 160 | out_8(&i2c_ram->tfcr, I2C_EB_CPM2); |
| 161 | out_8(&i2c_ram->rfcr, I2C_EB_CPM2); |
| 162 | } |
| 163 | |
| 164 | out_be16(&i2c_ram->mrblr, CPM_MAX_READ); |
| 165 | |
| 166 | out_be32(&i2c_ram->rstate, 0); |
| 167 | out_be32(&i2c_ram->rdp, 0); |
| 168 | out_be16(&i2c_ram->rbptr, 0); |
| 169 | out_be16(&i2c_ram->rbc, 0); |
| 170 | out_be32(&i2c_ram->rxtmp, 0); |
| 171 | out_be32(&i2c_ram->tstate, 0); |
| 172 | out_be32(&i2c_ram->tdp, 0); |
| 173 | out_be16(&i2c_ram->tbptr, 0); |
| 174 | out_be16(&i2c_ram->tbc, 0); |
| 175 | out_be32(&i2c_ram->txtmp, 0); |
| 176 | } |
| 177 | |
| 178 | static void cpm_i2c_force_close(struct i2c_adapter *adap) |
| 179 | { |
| 180 | struct cpm_i2c *cpm = i2c_get_adapdata(adap); |
| 181 | struct i2c_reg __iomem *i2c_reg = cpm->i2c_reg; |
| 182 | |
| 183 | dev_dbg(&adap->dev, "cpm_i2c_force_close()\n"); |
| 184 | |
| 185 | cpm_command(cpm->cp_command, CPM_CR_CLOSE_RX_BD); |
| 186 | |
| 187 | out_8(&i2c_reg->i2cmr, 0x00); /* Disable all interrupts */ |
| 188 | out_8(&i2c_reg->i2cer, 0xff); |
| 189 | } |
| 190 | |
| 191 | static void cpm_i2c_parse_message(struct i2c_adapter *adap, |
| 192 | struct i2c_msg *pmsg, int num, int tx, int rx) |
| 193 | { |
| 194 | cbd_t __iomem *tbdf; |
| 195 | cbd_t __iomem *rbdf; |
| 196 | u_char addr; |
| 197 | u_char *tb; |
| 198 | u_char *rb; |
| 199 | struct cpm_i2c *cpm = i2c_get_adapdata(adap); |
| 200 | |
| 201 | tbdf = cpm->tbase + tx; |
| 202 | rbdf = cpm->rbase + rx; |
| 203 | |
| 204 | addr = pmsg->addr << 1; |
| 205 | if (pmsg->flags & I2C_M_RD) |
| 206 | addr |= 1; |
| 207 | |
| 208 | tb = cpm->txbuf[tx]; |
| 209 | rb = cpm->rxbuf[rx]; |
| 210 | |
| 211 | /* Align read buffer */ |
| 212 | rb = (u_char *) (((ulong) rb + 1) & ~1); |
| 213 | |
| 214 | tb[0] = addr; /* Device address byte w/rw flag */ |
| 215 | |
| 216 | out_be16(&tbdf->cbd_datlen, pmsg->len + 1); |
| 217 | out_be16(&tbdf->cbd_sc, 0); |
| 218 | |
| 219 | if (!(pmsg->flags & I2C_M_NOSTART)) |
| 220 | setbits16(&tbdf->cbd_sc, BD_I2C_START); |
| 221 | |
| 222 | if (tx + 1 == num) |
| 223 | setbits16(&tbdf->cbd_sc, BD_SC_LAST | BD_SC_WRAP); |
| 224 | |
| 225 | if (pmsg->flags & I2C_M_RD) { |
| 226 | /* |
| 227 | * To read, we need an empty buffer of the proper length. |
| 228 | * All that is used is the first byte for address, the remainder |
| 229 | * is just used for timing (and doesn't really have to exist). |
| 230 | */ |
| 231 | |
| 232 | dev_dbg(&adap->dev, "cpm_i2c_read(abyte=0x%x)\n", addr); |
| 233 | |
| 234 | out_be16(&rbdf->cbd_datlen, 0); |
| 235 | out_be16(&rbdf->cbd_sc, BD_SC_EMPTY | BD_SC_INTRPT); |
| 236 | |
| 237 | if (rx + 1 == CPM_MAXBD) |
| 238 | setbits16(&rbdf->cbd_sc, BD_SC_WRAP); |
| 239 | |
| 240 | eieio(); |
| 241 | setbits16(&tbdf->cbd_sc, BD_SC_READY); |
| 242 | } else { |
Wolfram Sang | 3b27080 | 2008-07-14 22:38:28 +0200 | [diff] [blame] | 243 | dev_dbg(&adap->dev, "cpm_i2c_write(abyte=0x%x)\n", addr); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 244 | |
| 245 | memcpy(tb+1, pmsg->buf, pmsg->len); |
| 246 | |
| 247 | eieio(); |
| 248 | setbits16(&tbdf->cbd_sc, BD_SC_READY | BD_SC_INTRPT); |
| 249 | } |
| 250 | } |
| 251 | |
| 252 | static int cpm_i2c_check_message(struct i2c_adapter *adap, |
| 253 | struct i2c_msg *pmsg, int tx, int rx) |
| 254 | { |
| 255 | cbd_t __iomem *tbdf; |
| 256 | cbd_t __iomem *rbdf; |
| 257 | u_char *tb; |
| 258 | u_char *rb; |
| 259 | struct cpm_i2c *cpm = i2c_get_adapdata(adap); |
| 260 | |
| 261 | tbdf = cpm->tbase + tx; |
| 262 | rbdf = cpm->rbase + rx; |
| 263 | |
| 264 | tb = cpm->txbuf[tx]; |
| 265 | rb = cpm->rxbuf[rx]; |
| 266 | |
| 267 | /* Align read buffer */ |
| 268 | rb = (u_char *) (((uint) rb + 1) & ~1); |
| 269 | |
| 270 | eieio(); |
| 271 | if (pmsg->flags & I2C_M_RD) { |
| 272 | dev_dbg(&adap->dev, "tx sc 0x%04x, rx sc 0x%04x\n", |
| 273 | in_be16(&tbdf->cbd_sc), in_be16(&rbdf->cbd_sc)); |
| 274 | |
| 275 | if (in_be16(&tbdf->cbd_sc) & BD_SC_NAK) { |
| 276 | dev_dbg(&adap->dev, "I2C read; No ack\n"); |
| 277 | return -ENXIO; |
| 278 | } |
| 279 | if (in_be16(&rbdf->cbd_sc) & BD_SC_EMPTY) { |
| 280 | dev_err(&adap->dev, |
| 281 | "I2C read; complete but rbuf empty\n"); |
| 282 | return -EREMOTEIO; |
| 283 | } |
| 284 | if (in_be16(&rbdf->cbd_sc) & BD_SC_OV) { |
| 285 | dev_err(&adap->dev, "I2C read; Overrun\n"); |
| 286 | return -EREMOTEIO; |
| 287 | } |
| 288 | memcpy(pmsg->buf, rb, pmsg->len); |
| 289 | } else { |
| 290 | dev_dbg(&adap->dev, "tx sc %d 0x%04x\n", tx, |
| 291 | in_be16(&tbdf->cbd_sc)); |
| 292 | |
| 293 | if (in_be16(&tbdf->cbd_sc) & BD_SC_NAK) { |
| 294 | dev_dbg(&adap->dev, "I2C write; No ack\n"); |
| 295 | return -ENXIO; |
| 296 | } |
| 297 | if (in_be16(&tbdf->cbd_sc) & BD_SC_UN) { |
| 298 | dev_err(&adap->dev, "I2C write; Underrun\n"); |
| 299 | return -EIO; |
| 300 | } |
| 301 | if (in_be16(&tbdf->cbd_sc) & BD_SC_CL) { |
| 302 | dev_err(&adap->dev, "I2C write; Collision\n"); |
| 303 | return -EIO; |
| 304 | } |
| 305 | } |
| 306 | return 0; |
| 307 | } |
| 308 | |
| 309 | static int cpm_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num) |
| 310 | { |
| 311 | struct cpm_i2c *cpm = i2c_get_adapdata(adap); |
| 312 | struct i2c_reg __iomem *i2c_reg = cpm->i2c_reg; |
| 313 | struct i2c_ram __iomem *i2c_ram = cpm->i2c_ram; |
| 314 | struct i2c_msg *pmsg; |
| 315 | int ret, i; |
| 316 | int tptr; |
| 317 | int rptr; |
| 318 | cbd_t __iomem *tbdf; |
| 319 | cbd_t __iomem *rbdf; |
| 320 | |
| 321 | if (num > CPM_MAXBD) |
| 322 | return -EINVAL; |
| 323 | |
| 324 | /* Check if we have any oversized READ requests */ |
| 325 | for (i = 0; i < num; i++) { |
| 326 | pmsg = &msgs[i]; |
| 327 | if (pmsg->len >= CPM_MAX_READ) |
| 328 | return -EINVAL; |
| 329 | } |
| 330 | |
| 331 | /* Reset to use first buffer */ |
| 332 | out_be16(&i2c_ram->rbptr, in_be16(&i2c_ram->rbase)); |
| 333 | out_be16(&i2c_ram->tbptr, in_be16(&i2c_ram->tbase)); |
| 334 | |
| 335 | tbdf = cpm->tbase; |
| 336 | rbdf = cpm->rbase; |
| 337 | |
| 338 | tptr = 0; |
| 339 | rptr = 0; |
| 340 | |
| 341 | while (tptr < num) { |
| 342 | pmsg = &msgs[tptr]; |
| 343 | dev_dbg(&adap->dev, "R: %d T: %d\n", rptr, tptr); |
| 344 | |
| 345 | cpm_i2c_parse_message(adap, pmsg, num, tptr, rptr); |
| 346 | if (pmsg->flags & I2C_M_RD) |
| 347 | rptr++; |
| 348 | tptr++; |
| 349 | } |
| 350 | /* Start transfer now */ |
| 351 | /* Enable RX/TX/Error interupts */ |
Wolfram Sang | 3b27080 | 2008-07-14 22:38:28 +0200 | [diff] [blame] | 352 | out_8(&i2c_reg->i2cmr, I2CER_TXE | I2CER_TXB | I2CER_RXB); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 353 | out_8(&i2c_reg->i2cer, 0xff); /* Clear interrupt status */ |
| 354 | /* Chip bug, set enable here */ |
| 355 | setbits8(&i2c_reg->i2mod, I2MOD_EN); /* Enable */ |
| 356 | /* Begin transmission */ |
| 357 | setbits8(&i2c_reg->i2com, I2COM_START); |
| 358 | |
| 359 | tptr = 0; |
| 360 | rptr = 0; |
| 361 | |
| 362 | while (tptr < num) { |
| 363 | /* Check for outstanding messages */ |
| 364 | dev_dbg(&adap->dev, "test ready.\n"); |
| 365 | pmsg = &msgs[tptr]; |
| 366 | if (pmsg->flags & I2C_M_RD) |
Michael Trimarchi | dc1972d | 2009-06-19 14:50:02 +0200 | [diff] [blame] | 367 | ret = wait_event_timeout(cpm->i2c_wait, |
Mike Ditto | a804644 | 2008-12-16 20:17:09 +0000 | [diff] [blame] | 368 | (in_be16(&tbdf[tptr].cbd_sc) & BD_SC_NAK) || |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 369 | !(in_be16(&rbdf[rptr].cbd_sc) & BD_SC_EMPTY), |
| 370 | 1 * HZ); |
| 371 | else |
Michael Trimarchi | dc1972d | 2009-06-19 14:50:02 +0200 | [diff] [blame] | 372 | ret = wait_event_timeout(cpm->i2c_wait, |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 373 | !(in_be16(&tbdf[tptr].cbd_sc) & BD_SC_READY), |
| 374 | 1 * HZ); |
| 375 | if (ret == 0) { |
| 376 | ret = -EREMOTEIO; |
| 377 | dev_err(&adap->dev, "I2C transfer: timeout\n"); |
| 378 | goto out_err; |
| 379 | } |
| 380 | if (ret > 0) { |
| 381 | dev_dbg(&adap->dev, "ready.\n"); |
| 382 | ret = cpm_i2c_check_message(adap, pmsg, tptr, rptr); |
| 383 | tptr++; |
| 384 | if (pmsg->flags & I2C_M_RD) |
| 385 | rptr++; |
| 386 | if (ret) |
| 387 | goto out_err; |
| 388 | } |
| 389 | } |
| 390 | #ifdef I2C_CHIP_ERRATA |
| 391 | /* |
| 392 | * Chip errata, clear enable. This is not needed on rev D4 CPUs. |
| 393 | * Disabling I2C too early may cause too short stop condition |
| 394 | */ |
| 395 | udelay(4); |
| 396 | clrbits8(&i2c_reg->i2mod, I2MOD_EN); |
| 397 | #endif |
| 398 | return (num); |
| 399 | |
| 400 | out_err: |
| 401 | cpm_i2c_force_close(adap); |
| 402 | #ifdef I2C_CHIP_ERRATA |
| 403 | /* |
| 404 | * Chip errata, clear enable. This is not needed on rev D4 CPUs. |
| 405 | */ |
| 406 | clrbits8(&i2c_reg->i2mod, I2MOD_EN); |
| 407 | #endif |
| 408 | return ret; |
| 409 | } |
| 410 | |
| 411 | static u32 cpm_i2c_func(struct i2c_adapter *adap) |
| 412 | { |
| 413 | return I2C_FUNC_I2C | (I2C_FUNC_SMBUS_EMUL & ~I2C_FUNC_SMBUS_QUICK); |
| 414 | } |
| 415 | |
| 416 | /* -----exported algorithm data: ------------------------------------- */ |
| 417 | |
| 418 | static const struct i2c_algorithm cpm_i2c_algo = { |
| 419 | .master_xfer = cpm_i2c_xfer, |
| 420 | .functionality = cpm_i2c_func, |
| 421 | }; |
| 422 | |
| 423 | static const struct i2c_adapter cpm_ops = { |
| 424 | .owner = THIS_MODULE, |
| 425 | .name = "i2c-cpm", |
| 426 | .algo = &cpm_i2c_algo, |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 427 | }; |
| 428 | |
| 429 | static int __devinit cpm_i2c_setup(struct cpm_i2c *cpm) |
| 430 | { |
Grant Likely | 2dc1158 | 2010-08-06 09:25:50 -0600 | [diff] [blame] | 431 | struct platform_device *ofdev = cpm->ofdev; |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 432 | const u32 *data; |
| 433 | int len, ret, i; |
| 434 | void __iomem *i2c_base; |
| 435 | cbd_t __iomem *tbdf; |
| 436 | cbd_t __iomem *rbdf; |
| 437 | unsigned char brg; |
| 438 | |
| 439 | dev_dbg(&cpm->ofdev->dev, "cpm_i2c_setup()\n"); |
| 440 | |
| 441 | init_waitqueue_head(&cpm->i2c_wait); |
| 442 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 443 | cpm->irq = of_irq_to_resource(ofdev->dev.of_node, 0, NULL); |
Wolfram Sang | b865a4e | 2009-10-04 13:08:16 +0200 | [diff] [blame] | 444 | if (!cpm->irq) |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 445 | return -EINVAL; |
| 446 | |
| 447 | /* Install interrupt handler. */ |
| 448 | ret = request_irq(cpm->irq, cpm_i2c_interrupt, 0, "cpm_i2c", |
| 449 | &cpm->adap); |
| 450 | if (ret) |
| 451 | return ret; |
| 452 | |
| 453 | /* I2C parameter RAM */ |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 454 | i2c_base = of_iomap(ofdev->dev.of_node, 1); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 455 | if (i2c_base == NULL) { |
| 456 | ret = -EINVAL; |
| 457 | goto out_irq; |
| 458 | } |
| 459 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 460 | if (of_device_is_compatible(ofdev->dev.of_node, "fsl,cpm1-i2c")) { |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 461 | |
| 462 | /* Check for and use a microcode relocation patch. */ |
| 463 | cpm->i2c_ram = i2c_base; |
| 464 | cpm->i2c_addr = in_be16(&cpm->i2c_ram->rpbase); |
| 465 | |
| 466 | /* |
| 467 | * Maybe should use cpm_muram_alloc instead of hardcoding |
| 468 | * this in micropatch.c |
| 469 | */ |
| 470 | if (cpm->i2c_addr) { |
| 471 | cpm->i2c_ram = cpm_muram_addr(cpm->i2c_addr); |
| 472 | iounmap(i2c_base); |
| 473 | } |
| 474 | |
| 475 | cpm->version = 1; |
| 476 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 477 | } else if (of_device_is_compatible(ofdev->dev.of_node, "fsl,cpm2-i2c")) { |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 478 | cpm->i2c_addr = cpm_muram_alloc(sizeof(struct i2c_ram), 64); |
| 479 | cpm->i2c_ram = cpm_muram_addr(cpm->i2c_addr); |
| 480 | out_be16(i2c_base, cpm->i2c_addr); |
| 481 | iounmap(i2c_base); |
| 482 | |
| 483 | cpm->version = 2; |
| 484 | |
| 485 | } else { |
| 486 | iounmap(i2c_base); |
| 487 | ret = -EINVAL; |
| 488 | goto out_irq; |
| 489 | } |
| 490 | |
| 491 | /* I2C control/status registers */ |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 492 | cpm->i2c_reg = of_iomap(ofdev->dev.of_node, 0); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 493 | if (cpm->i2c_reg == NULL) { |
| 494 | ret = -EINVAL; |
| 495 | goto out_ram; |
| 496 | } |
| 497 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 498 | data = of_get_property(ofdev->dev.of_node, "fsl,cpm-command", &len); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 499 | if (!data || len != 4) { |
| 500 | ret = -EINVAL; |
| 501 | goto out_reg; |
| 502 | } |
| 503 | cpm->cp_command = *data; |
| 504 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 505 | data = of_get_property(ofdev->dev.of_node, "linux,i2c-class", &len); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 506 | if (data && len == 4) |
| 507 | cpm->adap.class = *data; |
| 508 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 509 | data = of_get_property(ofdev->dev.of_node, "clock-frequency", &len); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 510 | if (data && len == 4) |
| 511 | cpm->freq = *data; |
| 512 | else |
| 513 | cpm->freq = 60000; /* use 60kHz i2c clock by default */ |
| 514 | |
| 515 | /* |
| 516 | * Allocate space for CPM_MAXBD transmit and receive buffer |
| 517 | * descriptors in the DP ram. |
| 518 | */ |
| 519 | cpm->dp_addr = cpm_muram_alloc(sizeof(cbd_t) * 2 * CPM_MAXBD, 8); |
| 520 | if (!cpm->dp_addr) { |
| 521 | ret = -ENOMEM; |
| 522 | goto out_reg; |
| 523 | } |
| 524 | |
| 525 | cpm->tbase = cpm_muram_addr(cpm->dp_addr); |
| 526 | cpm->rbase = cpm_muram_addr(cpm->dp_addr + sizeof(cbd_t) * CPM_MAXBD); |
| 527 | |
| 528 | /* Allocate TX and RX buffers */ |
| 529 | |
| 530 | tbdf = cpm->tbase; |
| 531 | rbdf = cpm->rbase; |
| 532 | |
| 533 | for (i = 0; i < CPM_MAXBD; i++) { |
Mark Ware | 36521c2 | 2009-04-21 22:49:02 +1000 | [diff] [blame] | 534 | cpm->rxbuf[i] = dma_alloc_coherent(&cpm->ofdev->dev, |
| 535 | CPM_MAX_READ + 1, |
| 536 | &cpm->rxdma[i], GFP_KERNEL); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 537 | if (!cpm->rxbuf[i]) { |
| 538 | ret = -ENOMEM; |
| 539 | goto out_muram; |
| 540 | } |
| 541 | out_be32(&rbdf[i].cbd_bufaddr, ((cpm->rxdma[i] + 1) & ~1)); |
| 542 | |
Mark Ware | 36521c2 | 2009-04-21 22:49:02 +1000 | [diff] [blame] | 543 | cpm->txbuf[i] = (unsigned char *)dma_alloc_coherent(&cpm->ofdev->dev, CPM_MAX_READ + 1, &cpm->txdma[i], GFP_KERNEL); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 544 | if (!cpm->txbuf[i]) { |
| 545 | ret = -ENOMEM; |
| 546 | goto out_muram; |
| 547 | } |
| 548 | out_be32(&tbdf[i].cbd_bufaddr, cpm->txdma[i]); |
| 549 | } |
| 550 | |
| 551 | /* Initialize Tx/Rx parameters. */ |
| 552 | |
| 553 | cpm_reset_i2c_params(cpm); |
| 554 | |
Wolfram Sang | 3b27080 | 2008-07-14 22:38:28 +0200 | [diff] [blame] | 555 | dev_dbg(&cpm->ofdev->dev, "i2c_ram 0x%p, i2c_addr 0x%04x, freq %d\n", |
| 556 | cpm->i2c_ram, cpm->i2c_addr, cpm->freq); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 557 | dev_dbg(&cpm->ofdev->dev, "tbase 0x%04x, rbase 0x%04x\n", |
| 558 | (u8 __iomem *)cpm->tbase - DPRAM_BASE, |
| 559 | (u8 __iomem *)cpm->rbase - DPRAM_BASE); |
| 560 | |
| 561 | cpm_command(cpm->cp_command, CPM_CR_INIT_TRX); |
| 562 | |
| 563 | /* |
| 564 | * Select an invalid address. Just make sure we don't use loopback mode |
| 565 | */ |
| 566 | out_8(&cpm->i2c_reg->i2add, 0x7f << 1); |
| 567 | |
| 568 | /* |
| 569 | * PDIV is set to 00 in i2mod, so brgclk/32 is used as input to the |
| 570 | * i2c baud rate generator. This is divided by 2 x (DIV + 3) to get |
| 571 | * the actual i2c bus frequency. |
| 572 | */ |
| 573 | brg = get_brgfreq() / (32 * 2 * cpm->freq) - 3; |
| 574 | out_8(&cpm->i2c_reg->i2brg, brg); |
| 575 | |
| 576 | out_8(&cpm->i2c_reg->i2mod, 0x00); |
| 577 | out_8(&cpm->i2c_reg->i2com, I2COM_MASTER); /* Master mode */ |
| 578 | |
| 579 | /* Disable interrupts. */ |
| 580 | out_8(&cpm->i2c_reg->i2cmr, 0); |
| 581 | out_8(&cpm->i2c_reg->i2cer, 0xff); |
| 582 | |
| 583 | return 0; |
| 584 | |
| 585 | out_muram: |
| 586 | for (i = 0; i < CPM_MAXBD; i++) { |
| 587 | if (cpm->rxbuf[i]) |
Mark Ware | 36521c2 | 2009-04-21 22:49:02 +1000 | [diff] [blame] | 588 | dma_free_coherent(&cpm->ofdev->dev, CPM_MAX_READ + 1, |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 589 | cpm->rxbuf[i], cpm->rxdma[i]); |
| 590 | if (cpm->txbuf[i]) |
Mark Ware | 36521c2 | 2009-04-21 22:49:02 +1000 | [diff] [blame] | 591 | dma_free_coherent(&cpm->ofdev->dev, CPM_MAX_READ + 1, |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 592 | cpm->txbuf[i], cpm->txdma[i]); |
| 593 | } |
| 594 | cpm_muram_free(cpm->dp_addr); |
| 595 | out_reg: |
| 596 | iounmap(cpm->i2c_reg); |
| 597 | out_ram: |
| 598 | if ((cpm->version == 1) && (!cpm->i2c_addr)) |
| 599 | iounmap(cpm->i2c_ram); |
| 600 | if (cpm->version == 2) |
| 601 | cpm_muram_free(cpm->i2c_addr); |
| 602 | out_irq: |
| 603 | free_irq(cpm->irq, &cpm->adap); |
| 604 | return ret; |
| 605 | } |
| 606 | |
| 607 | static void cpm_i2c_shutdown(struct cpm_i2c *cpm) |
| 608 | { |
| 609 | int i; |
| 610 | |
| 611 | /* Shut down I2C. */ |
| 612 | clrbits8(&cpm->i2c_reg->i2mod, I2MOD_EN); |
| 613 | |
| 614 | /* Disable interrupts */ |
| 615 | out_8(&cpm->i2c_reg->i2cmr, 0); |
| 616 | out_8(&cpm->i2c_reg->i2cer, 0xff); |
| 617 | |
| 618 | free_irq(cpm->irq, &cpm->adap); |
| 619 | |
| 620 | /* Free all memory */ |
| 621 | for (i = 0; i < CPM_MAXBD; i++) { |
Mark Ware | 36521c2 | 2009-04-21 22:49:02 +1000 | [diff] [blame] | 622 | dma_free_coherent(&cpm->ofdev->dev, CPM_MAX_READ + 1, |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 623 | cpm->rxbuf[i], cpm->rxdma[i]); |
Mark Ware | 36521c2 | 2009-04-21 22:49:02 +1000 | [diff] [blame] | 624 | dma_free_coherent(&cpm->ofdev->dev, CPM_MAX_READ + 1, |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 625 | cpm->txbuf[i], cpm->txdma[i]); |
| 626 | } |
| 627 | |
| 628 | cpm_muram_free(cpm->dp_addr); |
| 629 | iounmap(cpm->i2c_reg); |
| 630 | |
| 631 | if ((cpm->version == 1) && (!cpm->i2c_addr)) |
| 632 | iounmap(cpm->i2c_ram); |
| 633 | if (cpm->version == 2) |
| 634 | cpm_muram_free(cpm->i2c_addr); |
| 635 | } |
| 636 | |
Grant Likely | 1c48a5c | 2011-02-17 02:43:24 -0700 | [diff] [blame] | 637 | static int __devinit cpm_i2c_probe(struct platform_device *ofdev) |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 638 | { |
| 639 | int result, len; |
| 640 | struct cpm_i2c *cpm; |
| 641 | const u32 *data; |
| 642 | |
| 643 | cpm = kzalloc(sizeof(struct cpm_i2c), GFP_KERNEL); |
| 644 | if (!cpm) |
| 645 | return -ENOMEM; |
| 646 | |
| 647 | cpm->ofdev = ofdev; |
| 648 | |
| 649 | dev_set_drvdata(&ofdev->dev, cpm); |
| 650 | |
| 651 | cpm->adap = cpm_ops; |
| 652 | i2c_set_adapdata(&cpm->adap, cpm); |
| 653 | cpm->adap.dev.parent = &ofdev->dev; |
Grant Likely | 9fd0499 | 2010-06-08 07:48:18 -0600 | [diff] [blame] | 654 | cpm->adap.dev.of_node = of_node_get(ofdev->dev.of_node); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 655 | |
| 656 | result = cpm_i2c_setup(cpm); |
| 657 | if (result) { |
| 658 | dev_err(&ofdev->dev, "Unable to init hardware\n"); |
| 659 | goto out_free; |
| 660 | } |
| 661 | |
| 662 | /* register new adapter to i2c module... */ |
| 663 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 664 | data = of_get_property(ofdev->dev.of_node, "linux,i2c-index", &len); |
Grant Likely | 488bf31 | 2011-07-25 17:49:43 +0200 | [diff] [blame] | 665 | cpm->adap.nr = (data && len == 4) ? be32_to_cpup(data) : -1; |
| 666 | result = i2c_add_numbered_adapter(&cpm->adap); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 667 | |
| 668 | if (result < 0) { |
| 669 | dev_err(&ofdev->dev, "Unable to register with I2C\n"); |
| 670 | goto out_shut; |
| 671 | } |
| 672 | |
| 673 | dev_dbg(&ofdev->dev, "hw routines for %s registered.\n", |
| 674 | cpm->adap.name); |
| 675 | |
Grant Likely | 925bb9c | 2010-09-30 14:14:23 +0200 | [diff] [blame] | 676 | /* |
| 677 | * register OF I2C devices |
| 678 | */ |
| 679 | of_i2c_register_devices(&cpm->adap); |
| 680 | |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 681 | return 0; |
| 682 | out_shut: |
| 683 | cpm_i2c_shutdown(cpm); |
| 684 | out_free: |
| 685 | dev_set_drvdata(&ofdev->dev, NULL); |
| 686 | kfree(cpm); |
| 687 | |
| 688 | return result; |
| 689 | } |
| 690 | |
Grant Likely | 2dc1158 | 2010-08-06 09:25:50 -0600 | [diff] [blame] | 691 | static int __devexit cpm_i2c_remove(struct platform_device *ofdev) |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 692 | { |
| 693 | struct cpm_i2c *cpm = dev_get_drvdata(&ofdev->dev); |
| 694 | |
| 695 | i2c_del_adapter(&cpm->adap); |
| 696 | |
| 697 | cpm_i2c_shutdown(cpm); |
| 698 | |
| 699 | dev_set_drvdata(&ofdev->dev, NULL); |
| 700 | kfree(cpm); |
| 701 | |
| 702 | return 0; |
| 703 | } |
| 704 | |
| 705 | static const struct of_device_id cpm_i2c_match[] = { |
| 706 | { |
| 707 | .compatible = "fsl,cpm1-i2c", |
| 708 | }, |
| 709 | { |
| 710 | .compatible = "fsl,cpm2-i2c", |
| 711 | }, |
| 712 | {}, |
| 713 | }; |
| 714 | |
| 715 | MODULE_DEVICE_TABLE(of, cpm_i2c_match); |
| 716 | |
Grant Likely | 1c48a5c | 2011-02-17 02:43:24 -0700 | [diff] [blame] | 717 | static struct platform_driver cpm_i2c_driver = { |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 718 | .probe = cpm_i2c_probe, |
| 719 | .remove = __devexit_p(cpm_i2c_remove), |
Grant Likely | 4018294 | 2010-04-13 16:13:02 -0700 | [diff] [blame] | 720 | .driver = { |
| 721 | .name = "fsl-i2c-cpm", |
| 722 | .owner = THIS_MODULE, |
| 723 | .of_match_table = cpm_i2c_match, |
| 724 | }, |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 725 | }; |
| 726 | |
| 727 | static int __init cpm_i2c_init(void) |
| 728 | { |
Grant Likely | 1c48a5c | 2011-02-17 02:43:24 -0700 | [diff] [blame] | 729 | return platform_driver_register(&cpm_i2c_driver); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 730 | } |
| 731 | |
| 732 | static void __exit cpm_i2c_exit(void) |
| 733 | { |
Grant Likely | 1c48a5c | 2011-02-17 02:43:24 -0700 | [diff] [blame] | 734 | platform_driver_unregister(&cpm_i2c_driver); |
Jochen Friedrich | 61045db | 2008-07-14 22:38:27 +0200 | [diff] [blame] | 735 | } |
| 736 | |
| 737 | module_init(cpm_i2c_init); |
| 738 | module_exit(cpm_i2c_exit); |
| 739 | |
| 740 | MODULE_AUTHOR("Jochen Friedrich <jochen@scram.de>"); |
| 741 | MODULE_DESCRIPTION("I2C-Bus adapter routines for CPM boards"); |
| 742 | MODULE_LICENSE("GPL"); |