git.oblomov.eu Git - linux-2.6/blob - drivers/i2c/algos/i2c-algo-ite.c

   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);
 211         printk("test_bus:1 scl: %d  sda: %d\n", getscl(adap),
 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);
 224         printk("test_bus:2 scl: %d  sda: %d\n", getscl(adap),
 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);
 237         printk("test_bus:3 scl: %d  sda: %d\n", getscl(adap),
 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);
 250         printk("test_bus:4 scl: %d  sda: %d\n", getscl(adap),
 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 = {
 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... */
 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         iic_init(iic_adap);
 746         return i2c_add_adapter(adap);
 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);