Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | ------------------------------------------------------------------------- |
| 3 | i2c-algo-ite.c i2c driver algorithms for ITE adapters |
| 4 | |
| 5 | Hai-Pao Fan, MontaVista Software, Inc. |
| 6 | hpfan@mvista.com or source@mvista.com |
| 7 | |
| 8 | Copyright 2000 MontaVista Software Inc. |
| 9 | |
| 10 | --------------------------------------------------------------------------- |
| 11 | This file was highly leveraged from i2c-algo-pcf.c, which was created |
| 12 | by Simon G. Vogl and Hans Berglund: |
| 13 | |
| 14 | |
| 15 | Copyright (C) 1995-1997 Simon G. Vogl |
| 16 | 1998-2000 Hans Berglund |
| 17 | |
| 18 | This program is free software; you can redistribute it and/or modify |
| 19 | it under the terms of the GNU General Public License as published by |
| 20 | the Free Software Foundation; either version 2 of the License, or |
| 21 | (at your option) any later version. |
| 22 | |
| 23 | This program is distributed in the hope that it will be useful, |
| 24 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 25 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 26 | GNU General Public License for more details. |
| 27 | |
| 28 | You should have received a copy of the GNU General Public License |
| 29 | along with this program; if not, write to the Free Software |
| 30 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ |
| 31 | /* ------------------------------------------------------------------------- */ |
| 32 | |
| 33 | /* With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi> and |
| 34 | Frodo Looijaard <frodol@dds.nl> ,and also from Martin Bailey |
| 35 | <mbailey@littlefeet-inc.com> */ |
| 36 | |
| 37 | #include <linux/kernel.h> |
| 38 | #include <linux/module.h> |
| 39 | #include <linux/delay.h> |
| 40 | #include <linux/slab.h> |
| 41 | #include <linux/init.h> |
| 42 | #include <asm/uaccess.h> |
| 43 | #include <linux/ioport.h> |
| 44 | #include <linux/errno.h> |
| 45 | #include <linux/sched.h> |
| 46 | |
| 47 | #include <linux/i2c.h> |
| 48 | #include <linux/i2c-algo-ite.h> |
| 49 | #include "i2c-algo-ite.h" |
| 50 | |
| 51 | #define PM_DSR IT8172_PCI_IO_BASE + IT_PM_DSR |
| 52 | #define PM_IBSR IT8172_PCI_IO_BASE + IT_PM_DSR + 0x04 |
| 53 | #define GPIO_CCR IT8172_PCI_IO_BASE + IT_GPCCR |
| 54 | |
| 55 | #define DEB2(x) if (i2c_debug>=2) x |
| 56 | #define DEB3(x) if (i2c_debug>=3) x /* print several statistical values*/ |
| 57 | #define DEF_TIMEOUT 16 |
| 58 | |
| 59 | |
| 60 | /* module parameters: |
| 61 | */ |
| 62 | static int i2c_debug; |
| 63 | static int iic_test; /* see if the line-setting functions work */ |
| 64 | |
| 65 | /* --- setting states on the bus with the right timing: --------------- */ |
| 66 | |
| 67 | #define get_clock(adap) adap->getclock(adap->data) |
| 68 | #define iic_outw(adap, reg, val) adap->setiic(adap->data, reg, val) |
| 69 | #define iic_inw(adap, reg) adap->getiic(adap->data, reg) |
| 70 | |
| 71 | |
| 72 | /* --- other auxiliary functions -------------------------------------- */ |
| 73 | |
| 74 | static void iic_start(struct i2c_algo_iic_data *adap) |
| 75 | { |
| 76 | iic_outw(adap,ITE_I2CHCR,ITE_CMD); |
| 77 | } |
| 78 | |
| 79 | static void iic_stop(struct i2c_algo_iic_data *adap) |
| 80 | { |
| 81 | iic_outw(adap,ITE_I2CHCR,0); |
| 82 | iic_outw(adap,ITE_I2CHSR,ITE_I2CHSR_TDI); |
| 83 | } |
| 84 | |
| 85 | static void iic_reset(struct i2c_algo_iic_data *adap) |
| 86 | { |
| 87 | iic_outw(adap, PM_IBSR, iic_inw(adap, PM_IBSR) | 0x80); |
| 88 | } |
| 89 | |
| 90 | |
| 91 | static int wait_for_bb(struct i2c_algo_iic_data *adap) |
| 92 | { |
| 93 | int timeout = DEF_TIMEOUT; |
| 94 | short status; |
| 95 | |
| 96 | status = iic_inw(adap, ITE_I2CHSR); |
| 97 | #ifndef STUB_I2C |
| 98 | while (timeout-- && (status & ITE_I2CHSR_HB)) { |
| 99 | udelay(1000); /* How much is this? */ |
| 100 | status = iic_inw(adap, ITE_I2CHSR); |
| 101 | } |
| 102 | #endif |
| 103 | if (timeout<=0) { |
| 104 | printk(KERN_ERR "Timeout, host is busy\n"); |
| 105 | iic_reset(adap); |
| 106 | } |
| 107 | return(timeout<=0); |
| 108 | } |
| 109 | |
| 110 | /* After we issue a transaction on the IIC bus, this function |
| 111 | * is called. It puts this process to sleep until we get an interrupt from |
| 112 | * from the controller telling us that the transaction we requested in complete. |
| 113 | */ |
| 114 | static int wait_for_pin(struct i2c_algo_iic_data *adap, short *status) { |
| 115 | |
| 116 | int timeout = DEF_TIMEOUT; |
| 117 | |
| 118 | timeout = wait_for_bb(adap); |
| 119 | if (timeout) { |
| 120 | DEB2(printk("Timeout waiting for host not busy\n");) |
| 121 | return -EIO; |
| 122 | } |
| 123 | timeout = DEF_TIMEOUT; |
| 124 | |
| 125 | *status = iic_inw(adap, ITE_I2CHSR); |
| 126 | #ifndef STUB_I2C |
| 127 | while (timeout-- && !(*status & ITE_I2CHSR_TDI)) { |
| 128 | adap->waitforpin(); |
| 129 | *status = iic_inw(adap, ITE_I2CHSR); |
| 130 | } |
| 131 | #endif |
| 132 | if (timeout <= 0) |
| 133 | return(-1); |
| 134 | else |
| 135 | return(0); |
| 136 | } |
| 137 | |
| 138 | static int wait_for_fe(struct i2c_algo_iic_data *adap, short *status) |
| 139 | { |
| 140 | int timeout = DEF_TIMEOUT; |
| 141 | |
| 142 | *status = iic_inw(adap, ITE_I2CFSR); |
| 143 | #ifndef STUB_I2C |
| 144 | while (timeout-- && (*status & ITE_I2CFSR_FE)) { |
| 145 | udelay(1000); |
| 146 | iic_inw(adap, ITE_I2CFSR); |
| 147 | } |
| 148 | #endif |
| 149 | if (timeout <= 0) |
| 150 | return(-1); |
| 151 | else |
| 152 | return(0); |
| 153 | } |
| 154 | |
| 155 | static int iic_init (struct i2c_algo_iic_data *adap) |
| 156 | { |
| 157 | short i; |
| 158 | |
| 159 | /* Clear bit 7 to set I2C to normal operation mode */ |
| 160 | i=iic_inw(adap, PM_DSR)& 0xff7f; |
| 161 | iic_outw(adap, PM_DSR, i); |
| 162 | |
| 163 | /* set IT_GPCCR port C bit 2&3 as function 2 */ |
| 164 | i = iic_inw(adap, GPIO_CCR) & 0xfc0f; |
| 165 | iic_outw(adap,GPIO_CCR,i); |
| 166 | |
| 167 | /* Clear slave address/sub-address */ |
| 168 | iic_outw(adap,ITE_I2CSAR, 0); |
| 169 | iic_outw(adap,ITE_I2CSSAR, 0); |
| 170 | |
| 171 | /* Set clock counter register */ |
| 172 | iic_outw(adap,ITE_I2CCKCNT, get_clock(adap)); |
| 173 | |
| 174 | /* Set START/reSTART/STOP time registers */ |
| 175 | iic_outw(adap,ITE_I2CSHDR, 0x0a); |
| 176 | iic_outw(adap,ITE_I2CRSUR, 0x0a); |
| 177 | iic_outw(adap,ITE_I2CPSUR, 0x0a); |
| 178 | |
| 179 | /* Enable interrupts on completing the current transaction */ |
| 180 | iic_outw(adap,ITE_I2CHCR, ITE_I2CHCR_IE | ITE_I2CHCR_HCE); |
| 181 | |
| 182 | /* Clear transfer count */ |
| 183 | iic_outw(adap,ITE_I2CFBCR, 0x0); |
| 184 | |
| 185 | DEB2(printk("iic_init: Initialized IIC on ITE 0x%x\n", |
| 186 | iic_inw(adap, ITE_I2CHSR))); |
| 187 | return 0; |
| 188 | } |
| 189 | |
| 190 | |
| 191 | /* |
| 192 | * Sanity check for the adapter hardware - check the reaction of |
| 193 | * the bus lines only if it seems to be idle. |
| 194 | */ |
| 195 | static int test_bus(struct i2c_algo_iic_data *adap, char *name) { |
| 196 | #if 0 |
| 197 | int scl,sda; |
| 198 | sda=getsda(adap); |
| 199 | if (adap->getscl==NULL) { |
| 200 | printk("test_bus: Warning: Adapter can't read from clock line - skipping test.\n"); |
| 201 | return 0; |
| 202 | } |
| 203 | scl=getscl(adap); |
| 204 | printk("test_bus: Adapter: %s scl: %d sda: %d -- testing...\n", |
| 205 | name,getscl(adap),getsda(adap)); |
| 206 | if (!scl || !sda ) { |
| 207 | printk("test_bus: %s seems to be busy.\n",adap->name); |
| 208 | goto bailout; |
| 209 | } |
| 210 | sdalo(adap); |
Jean Delvare | 541e6a0 | 2005-06-23 22:18:08 +0200 | [diff] [blame] | 211 | printk("test_bus:1 scl: %d sda: %d\n", getscl(adap), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 212 | getsda(adap)); |
| 213 | if ( 0 != getsda(adap) ) { |
| 214 | printk("test_bus: %s SDA stuck high!\n",name); |
| 215 | sdahi(adap); |
| 216 | goto bailout; |
| 217 | } |
| 218 | if ( 0 == getscl(adap) ) { |
| 219 | printk("test_bus: %s SCL unexpected low while pulling SDA low!\n", |
| 220 | name); |
| 221 | goto bailout; |
| 222 | } |
| 223 | sdahi(adap); |
Jean Delvare | 541e6a0 | 2005-06-23 22:18:08 +0200 | [diff] [blame] | 224 | printk("test_bus:2 scl: %d sda: %d\n", getscl(adap), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 225 | getsda(adap)); |
| 226 | if ( 0 == getsda(adap) ) { |
| 227 | printk("test_bus: %s SDA stuck low!\n",name); |
| 228 | sdahi(adap); |
| 229 | goto bailout; |
| 230 | } |
| 231 | if ( 0 == getscl(adap) ) { |
| 232 | printk("test_bus: %s SCL unexpected low while SDA high!\n", |
| 233 | adap->name); |
| 234 | goto bailout; |
| 235 | } |
| 236 | scllo(adap); |
Jean Delvare | 541e6a0 | 2005-06-23 22:18:08 +0200 | [diff] [blame] | 237 | printk("test_bus:3 scl: %d sda: %d\n", getscl(adap), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 | getsda(adap)); |
| 239 | if ( 0 != getscl(adap) ) { |
| 240 | |
| 241 | sclhi(adap); |
| 242 | goto bailout; |
| 243 | } |
| 244 | if ( 0 == getsda(adap) ) { |
| 245 | printk("test_bus: %s SDA unexpected low while pulling SCL low!\n", |
| 246 | name); |
| 247 | goto bailout; |
| 248 | } |
| 249 | sclhi(adap); |
Jean Delvare | 541e6a0 | 2005-06-23 22:18:08 +0200 | [diff] [blame] | 250 | printk("test_bus:4 scl: %d sda: %d\n", getscl(adap), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 251 | getsda(adap)); |
| 252 | if ( 0 == getscl(adap) ) { |
| 253 | printk("test_bus: %s SCL stuck low!\n",name); |
| 254 | sclhi(adap); |
| 255 | goto bailout; |
| 256 | } |
| 257 | if ( 0 == getsda(adap) ) { |
| 258 | printk("test_bus: %s SDA unexpected low while SCL high!\n", |
| 259 | name); |
| 260 | goto bailout; |
| 261 | } |
| 262 | printk("test_bus: %s passed test.\n",name); |
| 263 | return 0; |
| 264 | bailout: |
| 265 | sdahi(adap); |
| 266 | sclhi(adap); |
| 267 | return -ENODEV; |
| 268 | #endif |
| 269 | return (0); |
| 270 | } |
| 271 | |
| 272 | /* ----- Utility functions |
| 273 | */ |
| 274 | |
| 275 | |
| 276 | /* Verify the device we want to talk to on the IIC bus really exists. */ |
| 277 | static inline int try_address(struct i2c_algo_iic_data *adap, |
| 278 | unsigned int addr, int retries) |
| 279 | { |
| 280 | int i, ret = -1; |
| 281 | short status; |
| 282 | |
| 283 | for (i=0;i<retries;i++) { |
| 284 | iic_outw(adap, ITE_I2CSAR, addr); |
| 285 | iic_start(adap); |
| 286 | if (wait_for_pin(adap, &status) == 0) { |
| 287 | if ((status & ITE_I2CHSR_DNE) == 0) { |
| 288 | iic_stop(adap); |
| 289 | iic_outw(adap, ITE_I2CFCR, ITE_I2CFCR_FLUSH); |
| 290 | ret=1; |
| 291 | break; /* success! */ |
| 292 | } |
| 293 | } |
| 294 | iic_stop(adap); |
| 295 | udelay(adap->udelay); |
| 296 | } |
| 297 | DEB2(if (i) printk("try_address: needed %d retries for 0x%x\n",i, |
| 298 | addr)); |
| 299 | return ret; |
| 300 | } |
| 301 | |
| 302 | |
| 303 | static int iic_sendbytes(struct i2c_adapter *i2c_adap,const char *buf, |
| 304 | int count) |
| 305 | { |
| 306 | struct i2c_algo_iic_data *adap = i2c_adap->algo_data; |
| 307 | int wrcount=0, timeout; |
| 308 | short status; |
| 309 | int loops, remainder, i, j; |
| 310 | union { |
| 311 | char byte[2]; |
| 312 | unsigned short word; |
| 313 | } tmp; |
| 314 | |
| 315 | iic_outw(adap, ITE_I2CSSAR, (unsigned short)buf[wrcount++]); |
| 316 | count--; |
| 317 | if (count == 0) |
| 318 | return -EIO; |
| 319 | |
| 320 | loops = count / 32; /* 32-byte FIFO */ |
| 321 | remainder = count % 32; |
| 322 | |
| 323 | if(loops) { |
| 324 | for(i=0; i<loops; i++) { |
| 325 | |
| 326 | iic_outw(adap, ITE_I2CFBCR, 32); |
| 327 | for(j=0; j<32/2; j++) { |
| 328 | tmp.byte[1] = buf[wrcount++]; |
| 329 | tmp.byte[0] = buf[wrcount++]; |
| 330 | iic_outw(adap, ITE_I2CFDR, tmp.word); |
| 331 | } |
| 332 | |
| 333 | /* status FIFO overrun */ |
| 334 | iic_inw(adap, ITE_I2CFSR); |
| 335 | iic_inw(adap, ITE_I2CFBCR); |
| 336 | |
| 337 | iic_outw(adap, ITE_I2CHCR, ITE_WRITE); /* Issue WRITE command */ |
| 338 | |
| 339 | /* Wait for transmission to complete */ |
| 340 | timeout = wait_for_pin(adap, &status); |
| 341 | if(timeout) { |
| 342 | iic_stop(adap); |
| 343 | printk("iic_sendbytes: %s write timeout.\n", i2c_adap->name); |
| 344 | return -EREMOTEIO; /* got a better one ?? */ |
| 345 | } |
| 346 | if (status & ITE_I2CHSR_DB) { |
| 347 | iic_stop(adap); |
| 348 | printk("iic_sendbytes: %s write error - no ack.\n", i2c_adap->name); |
| 349 | return -EREMOTEIO; /* got a better one ?? */ |
| 350 | } |
| 351 | } |
| 352 | } |
| 353 | if(remainder) { |
| 354 | iic_outw(adap, ITE_I2CFBCR, remainder); |
| 355 | for(i=0; i<remainder/2; i++) { |
| 356 | tmp.byte[1] = buf[wrcount++]; |
| 357 | tmp.byte[0] = buf[wrcount++]; |
| 358 | iic_outw(adap, ITE_I2CFDR, tmp.word); |
| 359 | } |
| 360 | |
| 361 | /* status FIFO overrun */ |
| 362 | iic_inw(adap, ITE_I2CFSR); |
| 363 | iic_inw(adap, ITE_I2CFBCR); |
| 364 | |
| 365 | iic_outw(adap, ITE_I2CHCR, ITE_WRITE); /* Issue WRITE command */ |
| 366 | |
| 367 | timeout = wait_for_pin(adap, &status); |
| 368 | if(timeout) { |
| 369 | iic_stop(adap); |
| 370 | printk("iic_sendbytes: %s write timeout.\n", i2c_adap->name); |
| 371 | return -EREMOTEIO; /* got a better one ?? */ |
| 372 | } |
| 373 | #ifndef STUB_I2C |
| 374 | if (status & ITE_I2CHSR_DB) { |
| 375 | iic_stop(adap); |
| 376 | printk("iic_sendbytes: %s write error - no ack.\n", i2c_adap->name); |
| 377 | return -EREMOTEIO; /* got a better one ?? */ |
| 378 | } |
| 379 | #endif |
| 380 | } |
| 381 | iic_stop(adap); |
| 382 | return wrcount; |
| 383 | } |
| 384 | |
| 385 | |
| 386 | static int iic_readbytes(struct i2c_adapter *i2c_adap, char *buf, int count, |
| 387 | int sread) |
| 388 | { |
| 389 | int rdcount=0, i, timeout; |
| 390 | short status; |
| 391 | struct i2c_algo_iic_data *adap = i2c_adap->algo_data; |
| 392 | int loops, remainder, j; |
| 393 | union { |
| 394 | char byte[2]; |
| 395 | unsigned short word; |
| 396 | } tmp; |
| 397 | |
| 398 | loops = count / 32; /* 32-byte FIFO */ |
| 399 | remainder = count % 32; |
| 400 | |
| 401 | if(loops) { |
| 402 | for(i=0; i<loops; i++) { |
| 403 | iic_outw(adap, ITE_I2CFBCR, 32); |
| 404 | if (sread) |
| 405 | iic_outw(adap, ITE_I2CHCR, ITE_SREAD); |
| 406 | else |
| 407 | iic_outw(adap, ITE_I2CHCR, ITE_READ); /* Issue READ command */ |
| 408 | |
| 409 | timeout = wait_for_pin(adap, &status); |
| 410 | if(timeout) { |
| 411 | iic_stop(adap); |
| 412 | printk("iic_readbytes: %s read timeout.\n", i2c_adap->name); |
| 413 | return (-1); |
| 414 | } |
| 415 | #ifndef STUB_I2C |
| 416 | if (status & ITE_I2CHSR_DB) { |
| 417 | iic_stop(adap); |
| 418 | printk("iic_readbytes: %s read error - no ack.\n", i2c_adap->name); |
| 419 | return (-1); |
| 420 | } |
| 421 | #endif |
| 422 | |
| 423 | timeout = wait_for_fe(adap, &status); |
| 424 | if(timeout) { |
| 425 | iic_stop(adap); |
| 426 | printk("iic_readbytes: %s FIFO is empty\n", i2c_adap->name); |
| 427 | return (-1); |
| 428 | } |
| 429 | |
| 430 | for(j=0; j<32/2; j++) { |
| 431 | tmp.word = iic_inw(adap, ITE_I2CFDR); |
| 432 | buf[rdcount++] = tmp.byte[1]; |
| 433 | buf[rdcount++] = tmp.byte[0]; |
| 434 | } |
| 435 | |
| 436 | /* status FIFO underrun */ |
| 437 | iic_inw(adap, ITE_I2CFSR); |
| 438 | |
| 439 | } |
| 440 | } |
| 441 | |
| 442 | |
| 443 | if(remainder) { |
| 444 | remainder=(remainder+1)/2 * 2; |
| 445 | iic_outw(adap, ITE_I2CFBCR, remainder); |
| 446 | if (sread) |
| 447 | iic_outw(adap, ITE_I2CHCR, ITE_SREAD); |
| 448 | else |
| 449 | iic_outw(adap, ITE_I2CHCR, ITE_READ); /* Issue READ command */ |
| 450 | |
| 451 | timeout = wait_for_pin(adap, &status); |
| 452 | if(timeout) { |
| 453 | iic_stop(adap); |
| 454 | printk("iic_readbytes: %s read timeout.\n", i2c_adap->name); |
| 455 | return (-1); |
| 456 | } |
| 457 | #ifndef STUB_I2C |
| 458 | if (status & ITE_I2CHSR_DB) { |
| 459 | iic_stop(adap); |
| 460 | printk("iic_readbytes: %s read error - no ack.\n", i2c_adap->name); |
| 461 | return (-1); |
| 462 | } |
| 463 | #endif |
| 464 | timeout = wait_for_fe(adap, &status); |
| 465 | if(timeout) { |
| 466 | iic_stop(adap); |
| 467 | printk("iic_readbytes: %s FIFO is empty\n", i2c_adap->name); |
| 468 | return (-1); |
| 469 | } |
| 470 | |
| 471 | for(i=0; i<(remainder+1)/2; i++) { |
| 472 | tmp.word = iic_inw(adap, ITE_I2CFDR); |
| 473 | buf[rdcount++] = tmp.byte[1]; |
| 474 | buf[rdcount++] = tmp.byte[0]; |
| 475 | } |
| 476 | |
| 477 | /* status FIFO underrun */ |
| 478 | iic_inw(adap, ITE_I2CFSR); |
| 479 | |
| 480 | } |
| 481 | |
| 482 | iic_stop(adap); |
| 483 | return rdcount; |
| 484 | } |
| 485 | |
| 486 | |
| 487 | /* This function implements combined transactions. Combined |
| 488 | * transactions consist of combinations of reading and writing blocks of data. |
| 489 | * Each transfer (i.e. a read or a write) is separated by a repeated start |
| 490 | * condition. |
| 491 | */ |
| 492 | #if 0 |
| 493 | static int iic_combined_transaction(struct i2c_adapter *i2c_adap, struct i2c_msg *msgs, int num) |
| 494 | { |
| 495 | int i; |
| 496 | struct i2c_msg *pmsg; |
| 497 | int ret; |
| 498 | |
| 499 | DEB2(printk("Beginning combined transaction\n")); |
| 500 | |
| 501 | for(i=0; i<(num-1); i++) { |
| 502 | pmsg = &msgs[i]; |
| 503 | if(pmsg->flags & I2C_M_RD) { |
| 504 | DEB2(printk(" This one is a read\n")); |
| 505 | ret = iic_readbytes(i2c_adap, pmsg->buf, pmsg->len, IIC_COMBINED_XFER); |
| 506 | } |
| 507 | else if(!(pmsg->flags & I2C_M_RD)) { |
| 508 | DEB2(printk("This one is a write\n")); |
| 509 | ret = iic_sendbytes(i2c_adap, pmsg->buf, pmsg->len, IIC_COMBINED_XFER); |
| 510 | } |
| 511 | } |
| 512 | /* Last read or write segment needs to be terminated with a stop */ |
| 513 | pmsg = &msgs[i]; |
| 514 | |
| 515 | if(pmsg->flags & I2C_M_RD) { |
| 516 | DEB2(printk("Doing the last read\n")); |
| 517 | ret = iic_readbytes(i2c_adap, pmsg->buf, pmsg->len, IIC_SINGLE_XFER); |
| 518 | } |
| 519 | else if(!(pmsg->flags & I2C_M_RD)) { |
| 520 | DEB2(printk("Doing the last write\n")); |
| 521 | ret = iic_sendbytes(i2c_adap, pmsg->buf, pmsg->len, IIC_SINGLE_XFER); |
| 522 | } |
| 523 | |
| 524 | return ret; |
| 525 | } |
| 526 | #endif |
| 527 | |
| 528 | |
| 529 | /* Whenever we initiate a transaction, the first byte clocked |
| 530 | * onto the bus after the start condition is the address (7 bit) of the |
| 531 | * device we want to talk to. This function manipulates the address specified |
| 532 | * so that it makes sense to the hardware when written to the IIC peripheral. |
| 533 | * |
| 534 | * Note: 10 bit addresses are not supported in this driver, although they are |
| 535 | * supported by the hardware. This functionality needs to be implemented. |
| 536 | */ |
| 537 | static inline int iic_doAddress(struct i2c_algo_iic_data *adap, |
| 538 | struct i2c_msg *msg, int retries) |
| 539 | { |
| 540 | unsigned short flags = msg->flags; |
| 541 | unsigned int addr; |
| 542 | int ret; |
| 543 | |
| 544 | /* Ten bit addresses not supported right now */ |
| 545 | if ( (flags & I2C_M_TEN) ) { |
| 546 | #if 0 |
| 547 | addr = 0xf0 | (( msg->addr >> 7) & 0x03); |
| 548 | DEB2(printk("addr0: %d\n",addr)); |
| 549 | ret = try_address(adap, addr, retries); |
| 550 | if (ret!=1) { |
| 551 | printk("iic_doAddress: died at extended address code.\n"); |
| 552 | return -EREMOTEIO; |
| 553 | } |
| 554 | iic_outw(adap,msg->addr & 0x7f); |
| 555 | if (ret != 1) { |
| 556 | printk("iic_doAddress: died at 2nd address code.\n"); |
| 557 | return -EREMOTEIO; |
| 558 | } |
| 559 | if ( flags & I2C_M_RD ) { |
| 560 | i2c_repstart(adap); |
| 561 | addr |= 0x01; |
| 562 | ret = try_address(adap, addr, retries); |
| 563 | if (ret!=1) { |
| 564 | printk("iic_doAddress: died at extended address code.\n"); |
| 565 | return -EREMOTEIO; |
| 566 | } |
| 567 | } |
| 568 | #endif |
| 569 | } else { |
| 570 | |
| 571 | addr = ( msg->addr << 1 ); |
| 572 | |
| 573 | #if 0 |
| 574 | if (flags & I2C_M_RD ) |
| 575 | addr |= 1; |
| 576 | if (flags & I2C_M_REV_DIR_ADDR ) |
| 577 | addr ^= 1; |
| 578 | #endif |
| 579 | |
| 580 | if (iic_inw(adap, ITE_I2CSAR) != addr) { |
| 581 | iic_outw(adap, ITE_I2CSAR, addr); |
| 582 | ret = try_address(adap, addr, retries); |
| 583 | if (ret!=1) { |
| 584 | printk("iic_doAddress: died at address code.\n"); |
| 585 | return -EREMOTEIO; |
| 586 | } |
| 587 | } |
| 588 | |
| 589 | } |
| 590 | |
| 591 | return 0; |
| 592 | } |
| 593 | |
| 594 | |
| 595 | /* Description: Prepares the controller for a transaction (clearing status |
| 596 | * registers, data buffers, etc), and then calls either iic_readbytes or |
| 597 | * iic_sendbytes to do the actual transaction. |
| 598 | * |
| 599 | * still to be done: Before we issue a transaction, we should |
| 600 | * verify that the bus is not busy or in some unknown state. |
| 601 | */ |
| 602 | static int iic_xfer(struct i2c_adapter *i2c_adap, |
| 603 | struct i2c_msg *msgs, |
| 604 | int num) |
| 605 | { |
| 606 | struct i2c_algo_iic_data *adap = i2c_adap->algo_data; |
| 607 | struct i2c_msg *pmsg; |
| 608 | int i = 0; |
| 609 | int ret, timeout; |
| 610 | |
| 611 | pmsg = &msgs[i]; |
| 612 | |
| 613 | if(!pmsg->len) { |
| 614 | DEB2(printk("iic_xfer: read/write length is 0\n");) |
| 615 | return -EIO; |
| 616 | } |
| 617 | if(!(pmsg->flags & I2C_M_RD) && (!(pmsg->len)%2) ) { |
| 618 | DEB2(printk("iic_xfer: write buffer length is not odd\n");) |
| 619 | return -EIO; |
| 620 | } |
| 621 | |
| 622 | /* Wait for any pending transfers to complete */ |
| 623 | timeout = wait_for_bb(adap); |
| 624 | if (timeout) { |
| 625 | DEB2(printk("iic_xfer: Timeout waiting for host not busy\n");) |
| 626 | return -EIO; |
| 627 | } |
| 628 | |
| 629 | /* Flush FIFO */ |
| 630 | iic_outw(adap, ITE_I2CFCR, ITE_I2CFCR_FLUSH); |
| 631 | |
| 632 | /* Load address */ |
| 633 | ret = iic_doAddress(adap, pmsg, i2c_adap->retries); |
| 634 | if (ret) |
| 635 | return -EIO; |
| 636 | |
| 637 | #if 0 |
| 638 | /* Combined transaction (read and write) */ |
| 639 | if(num > 1) { |
| 640 | DEB2(printk("iic_xfer: Call combined transaction\n")); |
| 641 | ret = iic_combined_transaction(i2c_adap, msgs, num); |
| 642 | } |
| 643 | #endif |
| 644 | |
| 645 | DEB3(printk("iic_xfer: Msg %d, addr=0x%x, flags=0x%x, len=%d\n", |
| 646 | i, msgs[i].addr, msgs[i].flags, msgs[i].len);) |
| 647 | |
| 648 | if(pmsg->flags & I2C_M_RD) /* Read */ |
| 649 | ret = iic_readbytes(i2c_adap, pmsg->buf, pmsg->len, 0); |
| 650 | else { /* Write */ |
| 651 | udelay(1000); |
| 652 | ret = iic_sendbytes(i2c_adap, pmsg->buf, pmsg->len); |
| 653 | } |
| 654 | |
| 655 | if (ret != pmsg->len) |
| 656 | DEB3(printk("iic_xfer: error or fail on read/write %d bytes.\n",ret)); |
| 657 | else |
| 658 | DEB3(printk("iic_xfer: read/write %d bytes.\n",ret)); |
| 659 | |
| 660 | return ret; |
| 661 | } |
| 662 | |
| 663 | |
| 664 | /* Implements device specific ioctls. Higher level ioctls can |
| 665 | * be found in i2c-core.c and are typical of any i2c controller (specifying |
| 666 | * slave address, timeouts, etc). These ioctls take advantage of any hardware |
| 667 | * features built into the controller for which this algorithm-adapter set |
| 668 | * was written. These ioctls allow you to take control of the data and clock |
| 669 | * lines and set the either high or low, |
| 670 | * similar to a GPIO pin. |
| 671 | */ |
| 672 | static int algo_control(struct i2c_adapter *adapter, |
| 673 | unsigned int cmd, unsigned long arg) |
| 674 | { |
| 675 | |
| 676 | struct i2c_algo_iic_data *adap = adapter->algo_data; |
| 677 | struct i2c_iic_msg s_msg; |
| 678 | char *buf; |
| 679 | int ret; |
| 680 | |
| 681 | if (cmd == I2C_SREAD) { |
| 682 | if(copy_from_user(&s_msg, (struct i2c_iic_msg *)arg, |
| 683 | sizeof(struct i2c_iic_msg))) |
| 684 | return -EFAULT; |
| 685 | buf = kmalloc(s_msg.len, GFP_KERNEL); |
| 686 | if (buf== NULL) |
| 687 | return -ENOMEM; |
| 688 | |
| 689 | /* Flush FIFO */ |
| 690 | iic_outw(adap, ITE_I2CFCR, ITE_I2CFCR_FLUSH); |
| 691 | |
| 692 | /* Load address */ |
| 693 | iic_outw(adap, ITE_I2CSAR,s_msg.addr<<1); |
| 694 | iic_outw(adap, ITE_I2CSSAR,s_msg.waddr & 0xff); |
| 695 | |
| 696 | ret = iic_readbytes(adapter, buf, s_msg.len, 1); |
| 697 | if (ret>=0) { |
| 698 | if(copy_to_user( s_msg.buf, buf, s_msg.len) ) |
| 699 | ret = -EFAULT; |
| 700 | } |
| 701 | kfree(buf); |
| 702 | } |
| 703 | return 0; |
| 704 | } |
| 705 | |
| 706 | |
| 707 | static u32 iic_func(struct i2c_adapter *adap) |
| 708 | { |
| 709 | return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_10BIT_ADDR | |
| 710 | I2C_FUNC_PROTOCOL_MANGLING; |
| 711 | } |
| 712 | |
| 713 | /* -----exported algorithm data: ------------------------------------- */ |
| 714 | |
| 715 | static struct i2c_algorithm iic_algo = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 716 | .master_xfer = iic_xfer, |
| 717 | .algo_control = algo_control, /* ioctl */ |
| 718 | .functionality = iic_func, |
| 719 | }; |
| 720 | |
| 721 | |
| 722 | /* |
| 723 | * registering functions to load algorithms at runtime |
| 724 | */ |
| 725 | int i2c_iic_add_bus(struct i2c_adapter *adap) |
| 726 | { |
| 727 | struct i2c_algo_iic_data *iic_adap = adap->algo_data; |
| 728 | |
| 729 | if (iic_test) { |
| 730 | int ret = test_bus(iic_adap, adap->name); |
| 731 | if (ret<0) |
| 732 | return -ENODEV; |
| 733 | } |
| 734 | |
| 735 | DEB2(printk("i2c-algo-ite: hw routines for %s registered.\n", |
| 736 | adap->name)); |
| 737 | |
| 738 | /* register new adapter to i2c module... */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 739 | adap->algo = &iic_algo; |
| 740 | |
| 741 | adap->timeout = 100; /* default values, should */ |
| 742 | adap->retries = 3; /* be replaced by defines */ |
| 743 | adap->flags = 0; |
| 744 | |
| 745 | i2c_add_adapter(adap); |
| 746 | iic_init(iic_adap); |
| 747 | |
| 748 | return 0; |
| 749 | } |
| 750 | |
| 751 | |
| 752 | int i2c_iic_del_bus(struct i2c_adapter *adap) |
| 753 | { |
| 754 | int res; |
| 755 | if ((res = i2c_del_adapter(adap)) < 0) |
| 756 | return res; |
| 757 | DEB2(printk("i2c-algo-ite: adapter unregistered: %s\n",adap->name)); |
| 758 | |
| 759 | return 0; |
| 760 | } |
| 761 | |
| 762 | |
| 763 | int __init i2c_algo_iic_init (void) |
| 764 | { |
| 765 | printk(KERN_INFO "ITE iic (i2c) algorithm module\n"); |
| 766 | return 0; |
| 767 | } |
| 768 | |
| 769 | |
| 770 | void i2c_algo_iic_exit(void) |
| 771 | { |
| 772 | return; |
| 773 | } |
| 774 | |
| 775 | |
| 776 | EXPORT_SYMBOL(i2c_iic_add_bus); |
| 777 | EXPORT_SYMBOL(i2c_iic_del_bus); |
| 778 | |
| 779 | /* The MODULE_* macros resolve to nothing if MODULES is not defined |
| 780 | * when this file is compiled. |
| 781 | */ |
| 782 | MODULE_AUTHOR("MontaVista Software <www.mvista.com>"); |
| 783 | MODULE_DESCRIPTION("ITE iic algorithm"); |
| 784 | MODULE_LICENSE("GPL"); |
| 785 | |
| 786 | module_param(iic_test, bool, 0); |
| 787 | module_param(i2c_debug, int, S_IRUGO | S_IWUSR); |
| 788 | |
| 789 | MODULE_PARM_DESC(iic_test, "Test if the I2C bus is available"); |
| 790 | MODULE_PARM_DESC(i2c_debug, |
| 791 | "debug level - 0 off; 1 normal; 2,3 more verbose; 9 iic-protocol"); |
| 792 | |
| 793 | |
| 794 | /* This function resolves to init_module (the function invoked when a module |
| 795 | * is loaded via insmod) when this file is compiled with MODULES defined. |
| 796 | * Otherwise (i.e. if you want this driver statically linked to the kernel), |
| 797 | * a pointer to this function is stored in a table and called |
| 798 | * during the initialization of the kernel (in do_basic_setup in /init/main.c) |
| 799 | * |
| 800 | * All this functionality is complements of the macros defined in linux/init.h |
| 801 | */ |
| 802 | module_init(i2c_algo_iic_init); |
| 803 | |
| 804 | |
| 805 | /* If MODULES is defined when this file is compiled, then this function will |
| 806 | * resolved to cleanup_module. |
| 807 | */ |
| 808 | module_exit(i2c_algo_iic_exit); |