| 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 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 745 | iic_init(iic_adap); | 
| Mark M. Hoffman | b39ad0c | 2006-07-01 17:16:06 +0200 | [diff] [blame] | 746 | return i2c_add_adapter(adap); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 747 | } | 
|  | 748 |  | 
|  | 749 |  | 
|  | 750 | int i2c_iic_del_bus(struct i2c_adapter *adap) | 
|  | 751 | { | 
|  | 752 | int res; | 
|  | 753 | if ((res = i2c_del_adapter(adap)) < 0) | 
|  | 754 | return res; | 
|  | 755 | DEB2(printk("i2c-algo-ite: adapter unregistered: %s\n",adap->name)); | 
|  | 756 |  | 
|  | 757 | return 0; | 
|  | 758 | } | 
|  | 759 |  | 
|  | 760 |  | 
|  | 761 | int __init i2c_algo_iic_init (void) | 
|  | 762 | { | 
|  | 763 | printk(KERN_INFO "ITE iic (i2c) algorithm module\n"); | 
|  | 764 | return 0; | 
|  | 765 | } | 
|  | 766 |  | 
|  | 767 |  | 
|  | 768 | void i2c_algo_iic_exit(void) | 
|  | 769 | { | 
|  | 770 | return; | 
|  | 771 | } | 
|  | 772 |  | 
|  | 773 |  | 
|  | 774 | EXPORT_SYMBOL(i2c_iic_add_bus); | 
|  | 775 | EXPORT_SYMBOL(i2c_iic_del_bus); | 
|  | 776 |  | 
|  | 777 | /* The MODULE_* macros resolve to nothing if MODULES is not defined | 
|  | 778 | * when this file is compiled. | 
|  | 779 | */ | 
|  | 780 | MODULE_AUTHOR("MontaVista Software <www.mvista.com>"); | 
|  | 781 | MODULE_DESCRIPTION("ITE iic algorithm"); | 
|  | 782 | MODULE_LICENSE("GPL"); | 
|  | 783 |  | 
|  | 784 | module_param(iic_test, bool, 0); | 
|  | 785 | module_param(i2c_debug, int, S_IRUGO | S_IWUSR); | 
|  | 786 |  | 
|  | 787 | MODULE_PARM_DESC(iic_test, "Test if the I2C bus is available"); | 
|  | 788 | MODULE_PARM_DESC(i2c_debug, | 
|  | 789 | "debug level - 0 off; 1 normal; 2,3 more verbose; 9 iic-protocol"); | 
|  | 790 |  | 
|  | 791 |  | 
|  | 792 | /* This function resolves to init_module (the function invoked when a module | 
|  | 793 | * is loaded via insmod) when this file is compiled with MODULES defined. | 
|  | 794 | * Otherwise (i.e. if you want this driver statically linked to the kernel), | 
|  | 795 | * a pointer to this function is stored in a table and called | 
|  | 796 | * during the initialization of the kernel (in do_basic_setup in /init/main.c) | 
|  | 797 | * | 
|  | 798 | * All this functionality is complements of the macros defined in linux/init.h | 
|  | 799 | */ | 
|  | 800 | module_init(i2c_algo_iic_init); | 
|  | 801 |  | 
|  | 802 |  | 
|  | 803 | /* If MODULES is defined when this file is compiled, then this function will | 
|  | 804 | * resolved to cleanup_module. | 
|  | 805 | */ | 
|  | 806 | module_exit(i2c_algo_iic_exit); |