|  | /* | 
|  | ------------------------------------------------------------------------- | 
|  | i2c-algo-ite.c i2c driver algorithms for ITE adapters | 
|  |  | 
|  | Hai-Pao Fan, MontaVista Software, Inc. | 
|  | hpfan@mvista.com or source@mvista.com | 
|  |  | 
|  | Copyright 2000 MontaVista Software Inc. | 
|  |  | 
|  | --------------------------------------------------------------------------- | 
|  | This file was highly leveraged from i2c-algo-pcf.c, which was created | 
|  | by Simon G. Vogl and Hans Berglund: | 
|  |  | 
|  |  | 
|  | Copyright (C) 1995-1997 Simon G. Vogl | 
|  | 1998-2000 Hans Berglund | 
|  |  | 
|  | This program is free software; you can redistribute it and/or modify | 
|  | it under the terms of the GNU General Public License as published by | 
|  | the Free Software Foundation; either version 2 of the License, or | 
|  | (at your option) any later version. | 
|  |  | 
|  | This program is distributed in the hope that it will be useful, | 
|  | but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | GNU General Public License for more details. | 
|  |  | 
|  | You should have received a copy of the GNU General Public License | 
|  | along with this program; if not, write to the Free Software | 
|  | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.		     */ | 
|  | /* ------------------------------------------------------------------------- */ | 
|  |  | 
|  | /* With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi> and | 
|  | Frodo Looijaard <frodol@dds.nl> ,and also from Martin Bailey | 
|  | <mbailey@littlefeet-inc.com> */ | 
|  |  | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/delay.h> | 
|  | #include <linux/slab.h> | 
|  | #include <linux/init.h> | 
|  | #include <asm/uaccess.h> | 
|  | #include <linux/ioport.h> | 
|  | #include <linux/errno.h> | 
|  | #include <linux/sched.h> | 
|  |  | 
|  | #include <linux/i2c.h> | 
|  | #include <linux/i2c-algo-ite.h> | 
|  | #include "i2c-algo-ite.h" | 
|  |  | 
|  | #define	PM_DSR		IT8172_PCI_IO_BASE + IT_PM_DSR | 
|  | #define	PM_IBSR		IT8172_PCI_IO_BASE + IT_PM_DSR + 0x04 | 
|  | #define GPIO_CCR	IT8172_PCI_IO_BASE + IT_GPCCR | 
|  |  | 
|  | #define DEB2(x) if (i2c_debug>=2) x | 
|  | #define DEB3(x) if (i2c_debug>=3) x /* print several statistical values*/ | 
|  | #define DEF_TIMEOUT 16 | 
|  |  | 
|  |  | 
|  | /* module parameters: | 
|  | */ | 
|  | static int i2c_debug; | 
|  | static int iic_test;	/* see if the line-setting functions work	*/ | 
|  |  | 
|  | /* --- setting states on the bus with the right timing: ---------------	*/ | 
|  |  | 
|  | #define get_clock(adap) adap->getclock(adap->data) | 
|  | #define iic_outw(adap, reg, val) adap->setiic(adap->data, reg, val) | 
|  | #define iic_inw(adap, reg) adap->getiic(adap->data, reg) | 
|  |  | 
|  |  | 
|  | /* --- other auxiliary functions --------------------------------------	*/ | 
|  |  | 
|  | static void iic_start(struct i2c_algo_iic_data *adap) | 
|  | { | 
|  | iic_outw(adap,ITE_I2CHCR,ITE_CMD); | 
|  | } | 
|  |  | 
|  | static void iic_stop(struct i2c_algo_iic_data *adap) | 
|  | { | 
|  | iic_outw(adap,ITE_I2CHCR,0); | 
|  | iic_outw(adap,ITE_I2CHSR,ITE_I2CHSR_TDI); | 
|  | } | 
|  |  | 
|  | static void iic_reset(struct i2c_algo_iic_data *adap) | 
|  | { | 
|  | iic_outw(adap, PM_IBSR, iic_inw(adap, PM_IBSR) | 0x80); | 
|  | } | 
|  |  | 
|  |  | 
|  | static int wait_for_bb(struct i2c_algo_iic_data *adap) | 
|  | { | 
|  | int timeout = DEF_TIMEOUT; | 
|  | short status; | 
|  |  | 
|  | status = iic_inw(adap, ITE_I2CHSR); | 
|  | #ifndef STUB_I2C | 
|  | while (timeout-- && (status & ITE_I2CHSR_HB)) { | 
|  | udelay(1000); /* How much is this? */ | 
|  | status = iic_inw(adap, ITE_I2CHSR); | 
|  | } | 
|  | #endif | 
|  | if (timeout<=0) { | 
|  | printk(KERN_ERR "Timeout, host is busy\n"); | 
|  | iic_reset(adap); | 
|  | } | 
|  | return(timeout<=0); | 
|  | } | 
|  |  | 
|  | /* After we issue a transaction on the IIC bus, this function | 
|  | * is called.  It puts this process to sleep until we get an interrupt from | 
|  | * from the controller telling us that the transaction we requested in complete. | 
|  | */ | 
|  | static int wait_for_pin(struct i2c_algo_iic_data *adap, short *status) { | 
|  |  | 
|  | int timeout = DEF_TIMEOUT; | 
|  |  | 
|  | timeout = wait_for_bb(adap); | 
|  | if (timeout) { | 
|  | DEB2(printk("Timeout waiting for host not busy\n");) | 
|  | return -EIO; | 
|  | } | 
|  | timeout = DEF_TIMEOUT; | 
|  |  | 
|  | *status = iic_inw(adap, ITE_I2CHSR); | 
|  | #ifndef STUB_I2C | 
|  | while (timeout-- && !(*status & ITE_I2CHSR_TDI)) { | 
|  | adap->waitforpin(); | 
|  | *status = iic_inw(adap, ITE_I2CHSR); | 
|  | } | 
|  | #endif | 
|  | if (timeout <= 0) | 
|  | return(-1); | 
|  | else | 
|  | return(0); | 
|  | } | 
|  |  | 
|  | static int wait_for_fe(struct i2c_algo_iic_data *adap, short *status) | 
|  | { | 
|  | int timeout = DEF_TIMEOUT; | 
|  |  | 
|  | *status = iic_inw(adap, ITE_I2CFSR); | 
|  | #ifndef STUB_I2C | 
|  | while (timeout-- && (*status & ITE_I2CFSR_FE)) { | 
|  | udelay(1000); | 
|  | iic_inw(adap, ITE_I2CFSR); | 
|  | } | 
|  | #endif | 
|  | if (timeout <= 0) | 
|  | return(-1); | 
|  | else | 
|  | return(0); | 
|  | } | 
|  |  | 
|  | static int iic_init (struct i2c_algo_iic_data *adap) | 
|  | { | 
|  | short i; | 
|  |  | 
|  | /* Clear bit 7 to set I2C to normal operation mode */ | 
|  | i=iic_inw(adap, PM_DSR)& 0xff7f; | 
|  | iic_outw(adap, PM_DSR, i); | 
|  |  | 
|  | /* set IT_GPCCR port C bit 2&3 as function 2 */ | 
|  | i = iic_inw(adap, GPIO_CCR) & 0xfc0f; | 
|  | iic_outw(adap,GPIO_CCR,i); | 
|  |  | 
|  | /* Clear slave address/sub-address */ | 
|  | iic_outw(adap,ITE_I2CSAR, 0); | 
|  | iic_outw(adap,ITE_I2CSSAR, 0); | 
|  |  | 
|  | /* Set clock counter register */ | 
|  | iic_outw(adap,ITE_I2CCKCNT, get_clock(adap)); | 
|  |  | 
|  | /* Set START/reSTART/STOP time registers */ | 
|  | iic_outw(adap,ITE_I2CSHDR, 0x0a); | 
|  | iic_outw(adap,ITE_I2CRSUR, 0x0a); | 
|  | iic_outw(adap,ITE_I2CPSUR, 0x0a); | 
|  |  | 
|  | /* Enable interrupts on completing the current transaction */ | 
|  | iic_outw(adap,ITE_I2CHCR, ITE_I2CHCR_IE | ITE_I2CHCR_HCE); | 
|  |  | 
|  | /* Clear transfer count */ | 
|  | iic_outw(adap,ITE_I2CFBCR, 0x0); | 
|  |  | 
|  | DEB2(printk("iic_init: Initialized IIC on ITE 0x%x\n", | 
|  | iic_inw(adap, ITE_I2CHSR))); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | /* | 
|  | * Sanity check for the adapter hardware - check the reaction of | 
|  | * the bus lines only if it seems to be idle. | 
|  | */ | 
|  | static int test_bus(struct i2c_algo_iic_data *adap, char *name) { | 
|  | #if 0 | 
|  | int scl,sda; | 
|  | sda=getsda(adap); | 
|  | if (adap->getscl==NULL) { | 
|  | printk("test_bus: Warning: Adapter can't read from clock line - skipping test.\n"); | 
|  | return 0; | 
|  | } | 
|  | scl=getscl(adap); | 
|  | printk("test_bus: Adapter: %s scl: %d  sda: %d -- testing...\n", | 
|  | name,getscl(adap),getsda(adap)); | 
|  | if (!scl || !sda ) { | 
|  | printk("test_bus: %s seems to be busy.\n",adap->name); | 
|  | goto bailout; | 
|  | } | 
|  | sdalo(adap); | 
|  | printk("test_bus:1 scl: %d  sda: %d\n", getscl(adap), | 
|  | getsda(adap)); | 
|  | if ( 0 != getsda(adap) ) { | 
|  | printk("test_bus: %s SDA stuck high!\n",name); | 
|  | sdahi(adap); | 
|  | goto bailout; | 
|  | } | 
|  | if ( 0 == getscl(adap) ) { | 
|  | printk("test_bus: %s SCL unexpected low while pulling SDA low!\n", | 
|  | name); | 
|  | goto bailout; | 
|  | } | 
|  | sdahi(adap); | 
|  | printk("test_bus:2 scl: %d  sda: %d\n", getscl(adap), | 
|  | getsda(adap)); | 
|  | if ( 0 == getsda(adap) ) { | 
|  | printk("test_bus: %s SDA stuck low!\n",name); | 
|  | sdahi(adap); | 
|  | goto bailout; | 
|  | } | 
|  | if ( 0 == getscl(adap) ) { | 
|  | printk("test_bus: %s SCL unexpected low while SDA high!\n", | 
|  | adap->name); | 
|  | goto bailout; | 
|  | } | 
|  | scllo(adap); | 
|  | printk("test_bus:3 scl: %d  sda: %d\n", getscl(adap), | 
|  | getsda(adap)); | 
|  | if ( 0 != getscl(adap) ) { | 
|  |  | 
|  | sclhi(adap); | 
|  | goto bailout; | 
|  | } | 
|  | if ( 0 == getsda(adap) ) { | 
|  | printk("test_bus: %s SDA unexpected low while pulling SCL low!\n", | 
|  | name); | 
|  | goto bailout; | 
|  | } | 
|  | sclhi(adap); | 
|  | printk("test_bus:4 scl: %d  sda: %d\n", getscl(adap), | 
|  | getsda(adap)); | 
|  | if ( 0 == getscl(adap) ) { | 
|  | printk("test_bus: %s SCL stuck low!\n",name); | 
|  | sclhi(adap); | 
|  | goto bailout; | 
|  | } | 
|  | if ( 0 == getsda(adap) ) { | 
|  | printk("test_bus: %s SDA unexpected low while SCL high!\n", | 
|  | name); | 
|  | goto bailout; | 
|  | } | 
|  | printk("test_bus: %s passed test.\n",name); | 
|  | return 0; | 
|  | bailout: | 
|  | sdahi(adap); | 
|  | sclhi(adap); | 
|  | return -ENODEV; | 
|  | #endif | 
|  | return (0); | 
|  | } | 
|  |  | 
|  | /* ----- Utility functions | 
|  | */ | 
|  |  | 
|  |  | 
|  | /* Verify the device we want to talk to on the IIC bus really exists. */ | 
|  | static inline int try_address(struct i2c_algo_iic_data *adap, | 
|  | unsigned int addr, int retries) | 
|  | { | 
|  | int i, ret = -1; | 
|  | short status; | 
|  |  | 
|  | for (i=0;i<retries;i++) { | 
|  | iic_outw(adap, ITE_I2CSAR, addr); | 
|  | iic_start(adap); | 
|  | if (wait_for_pin(adap, &status) == 0) { | 
|  | if ((status & ITE_I2CHSR_DNE) == 0) { | 
|  | iic_stop(adap); | 
|  | iic_outw(adap, ITE_I2CFCR, ITE_I2CFCR_FLUSH); | 
|  | ret=1; | 
|  | break;	/* success! */ | 
|  | } | 
|  | } | 
|  | iic_stop(adap); | 
|  | udelay(adap->udelay); | 
|  | } | 
|  | DEB2(if (i) printk("try_address: needed %d retries for 0x%x\n",i, | 
|  | addr)); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  |  | 
|  | static int iic_sendbytes(struct i2c_adapter *i2c_adap,const char *buf, | 
|  | int count) | 
|  | { | 
|  | struct i2c_algo_iic_data *adap = i2c_adap->algo_data; | 
|  | int wrcount=0, timeout; | 
|  | short status; | 
|  | int loops, remainder, i, j; | 
|  | union { | 
|  | char byte[2]; | 
|  | unsigned short word; | 
|  | } tmp; | 
|  |  | 
|  | iic_outw(adap, ITE_I2CSSAR, (unsigned short)buf[wrcount++]); | 
|  | count--; | 
|  | if (count == 0) | 
|  | return -EIO; | 
|  |  | 
|  | loops =  count / 32;		/* 32-byte FIFO */ | 
|  | remainder = count % 32; | 
|  |  | 
|  | if(loops) { | 
|  | for(i=0; i<loops; i++) { | 
|  |  | 
|  | iic_outw(adap, ITE_I2CFBCR, 32); | 
|  | for(j=0; j<32/2; j++) { | 
|  | tmp.byte[1] = buf[wrcount++]; | 
|  | tmp.byte[0] = buf[wrcount++]; | 
|  | iic_outw(adap, ITE_I2CFDR, tmp.word); | 
|  | } | 
|  |  | 
|  | /* status FIFO overrun */ | 
|  | iic_inw(adap, ITE_I2CFSR); | 
|  | iic_inw(adap, ITE_I2CFBCR); | 
|  |  | 
|  | iic_outw(adap, ITE_I2CHCR, ITE_WRITE);	/* Issue WRITE command */ | 
|  |  | 
|  | /* Wait for transmission to complete */ | 
|  | timeout = wait_for_pin(adap, &status); | 
|  | if(timeout) { | 
|  | iic_stop(adap); | 
|  | printk("iic_sendbytes: %s write timeout.\n", i2c_adap->name); | 
|  | return -EREMOTEIO; /* got a better one ?? */ | 
|  | } | 
|  | if (status & ITE_I2CHSR_DB) { | 
|  | iic_stop(adap); | 
|  | printk("iic_sendbytes: %s write error - no ack.\n", i2c_adap->name); | 
|  | return -EREMOTEIO; /* got a better one ?? */ | 
|  | } | 
|  | } | 
|  | } | 
|  | if(remainder) { | 
|  | iic_outw(adap, ITE_I2CFBCR, remainder); | 
|  | for(i=0; i<remainder/2; i++) { | 
|  | tmp.byte[1] = buf[wrcount++]; | 
|  | tmp.byte[0] = buf[wrcount++]; | 
|  | iic_outw(adap, ITE_I2CFDR, tmp.word); | 
|  | } | 
|  |  | 
|  | /* status FIFO overrun */ | 
|  | iic_inw(adap, ITE_I2CFSR); | 
|  | iic_inw(adap, ITE_I2CFBCR); | 
|  |  | 
|  | iic_outw(adap, ITE_I2CHCR, ITE_WRITE);  /* Issue WRITE command */ | 
|  |  | 
|  | timeout = wait_for_pin(adap, &status); | 
|  | if(timeout) { | 
|  | iic_stop(adap); | 
|  | printk("iic_sendbytes: %s write timeout.\n", i2c_adap->name); | 
|  | return -EREMOTEIO; /* got a better one ?? */ | 
|  | } | 
|  | #ifndef STUB_I2C | 
|  | if (status & ITE_I2CHSR_DB) { | 
|  | iic_stop(adap); | 
|  | printk("iic_sendbytes: %s write error - no ack.\n", i2c_adap->name); | 
|  | return -EREMOTEIO; /* got a better one ?? */ | 
|  | } | 
|  | #endif | 
|  | } | 
|  | iic_stop(adap); | 
|  | return wrcount; | 
|  | } | 
|  |  | 
|  |  | 
|  | static int iic_readbytes(struct i2c_adapter *i2c_adap, char *buf, int count, | 
|  | int sread) | 
|  | { | 
|  | int rdcount=0, i, timeout; | 
|  | short status; | 
|  | struct i2c_algo_iic_data *adap = i2c_adap->algo_data; | 
|  | int loops, remainder, j; | 
|  | union { | 
|  | char byte[2]; | 
|  | unsigned short word; | 
|  | } tmp; | 
|  |  | 
|  | loops = count / 32;				/* 32-byte FIFO */ | 
|  | remainder = count % 32; | 
|  |  | 
|  | if(loops) { | 
|  | for(i=0; i<loops; i++) { | 
|  | iic_outw(adap, ITE_I2CFBCR, 32); | 
|  | if (sread) | 
|  | iic_outw(adap, ITE_I2CHCR, ITE_SREAD); | 
|  | else | 
|  | iic_outw(adap, ITE_I2CHCR, ITE_READ);		/* Issue READ command */ | 
|  |  | 
|  | timeout = wait_for_pin(adap, &status); | 
|  | if(timeout) { | 
|  | iic_stop(adap); | 
|  | printk("iic_readbytes:  %s read timeout.\n", i2c_adap->name); | 
|  | return (-1); | 
|  | } | 
|  | #ifndef STUB_I2C | 
|  | if (status & ITE_I2CHSR_DB) { | 
|  | iic_stop(adap); | 
|  | printk("iic_readbytes: %s read error - no ack.\n", i2c_adap->name); | 
|  | return (-1); | 
|  | } | 
|  | #endif | 
|  |  | 
|  | timeout = wait_for_fe(adap, &status); | 
|  | if(timeout) { | 
|  | iic_stop(adap); | 
|  | printk("iic_readbytes:  %s FIFO is empty\n", i2c_adap->name); | 
|  | return (-1); | 
|  | } | 
|  |  | 
|  | for(j=0; j<32/2; j++) { | 
|  | tmp.word = iic_inw(adap, ITE_I2CFDR); | 
|  | buf[rdcount++] = tmp.byte[1]; | 
|  | buf[rdcount++] = tmp.byte[0]; | 
|  | } | 
|  |  | 
|  | /* status FIFO underrun */ | 
|  | iic_inw(adap, ITE_I2CFSR); | 
|  |  | 
|  | } | 
|  | } | 
|  |  | 
|  |  | 
|  | if(remainder) { | 
|  | remainder=(remainder+1)/2 * 2; | 
|  | iic_outw(adap, ITE_I2CFBCR, remainder); | 
|  | if (sread) | 
|  | iic_outw(adap, ITE_I2CHCR, ITE_SREAD); | 
|  | else | 
|  | iic_outw(adap, ITE_I2CHCR, ITE_READ);		/* Issue READ command */ | 
|  |  | 
|  | timeout = wait_for_pin(adap, &status); | 
|  | if(timeout) { | 
|  | iic_stop(adap); | 
|  | printk("iic_readbytes:  %s read timeout.\n", i2c_adap->name); | 
|  | return (-1); | 
|  | } | 
|  | #ifndef STUB_I2C | 
|  | if (status & ITE_I2CHSR_DB) { | 
|  | iic_stop(adap); | 
|  | printk("iic_readbytes: %s read error - no ack.\n", i2c_adap->name); | 
|  | return (-1); | 
|  | } | 
|  | #endif | 
|  | timeout = wait_for_fe(adap, &status); | 
|  | if(timeout) { | 
|  | iic_stop(adap); | 
|  | printk("iic_readbytes:  %s FIFO is empty\n", i2c_adap->name); | 
|  | return (-1); | 
|  | } | 
|  |  | 
|  | for(i=0; i<(remainder+1)/2; i++) { | 
|  | tmp.word = iic_inw(adap, ITE_I2CFDR); | 
|  | buf[rdcount++] = tmp.byte[1]; | 
|  | buf[rdcount++] = tmp.byte[0]; | 
|  | } | 
|  |  | 
|  | /* status FIFO underrun */ | 
|  | iic_inw(adap, ITE_I2CFSR); | 
|  |  | 
|  | } | 
|  |  | 
|  | iic_stop(adap); | 
|  | return rdcount; | 
|  | } | 
|  |  | 
|  |  | 
|  | /* This function implements combined transactions.  Combined | 
|  | * transactions consist of combinations of reading and writing blocks of data. | 
|  | * Each transfer (i.e. a read or a write) is separated by a repeated start | 
|  | * condition. | 
|  | */ | 
|  | #if 0 | 
|  | static int iic_combined_transaction(struct i2c_adapter *i2c_adap, struct i2c_msg *msgs, int num) | 
|  | { | 
|  | int i; | 
|  | struct i2c_msg *pmsg; | 
|  | int ret; | 
|  |  | 
|  | DEB2(printk("Beginning combined transaction\n")); | 
|  |  | 
|  | for(i=0; i<(num-1); i++) { | 
|  | pmsg = &msgs[i]; | 
|  | if(pmsg->flags & I2C_M_RD) { | 
|  | DEB2(printk("  This one is a read\n")); | 
|  | ret = iic_readbytes(i2c_adap, pmsg->buf, pmsg->len, IIC_COMBINED_XFER); | 
|  | } | 
|  | else if(!(pmsg->flags & I2C_M_RD)) { | 
|  | DEB2(printk("This one is a write\n")); | 
|  | ret = iic_sendbytes(i2c_adap, pmsg->buf, pmsg->len, IIC_COMBINED_XFER); | 
|  | } | 
|  | } | 
|  | /* Last read or write segment needs to be terminated with a stop */ | 
|  | pmsg = &msgs[i]; | 
|  |  | 
|  | if(pmsg->flags & I2C_M_RD) { | 
|  | DEB2(printk("Doing the last read\n")); | 
|  | ret = iic_readbytes(i2c_adap, pmsg->buf, pmsg->len, IIC_SINGLE_XFER); | 
|  | } | 
|  | else if(!(pmsg->flags & I2C_M_RD)) { | 
|  | DEB2(printk("Doing the last write\n")); | 
|  | ret = iic_sendbytes(i2c_adap, pmsg->buf, pmsg->len, IIC_SINGLE_XFER); | 
|  | } | 
|  |  | 
|  | return ret; | 
|  | } | 
|  | #endif | 
|  |  | 
|  |  | 
|  | /* Whenever we initiate a transaction, the first byte clocked | 
|  | * onto the bus after the start condition is the address (7 bit) of the | 
|  | * device we want to talk to.  This function manipulates the address specified | 
|  | * so that it makes sense to the hardware when written to the IIC peripheral. | 
|  | * | 
|  | * Note: 10 bit addresses are not supported in this driver, although they are | 
|  | * supported by the hardware.  This functionality needs to be implemented. | 
|  | */ | 
|  | static inline int iic_doAddress(struct i2c_algo_iic_data *adap, | 
|  | struct i2c_msg *msg, int retries) | 
|  | { | 
|  | unsigned short flags = msg->flags; | 
|  | unsigned int addr; | 
|  | int ret; | 
|  |  | 
|  | /* Ten bit addresses not supported right now */ | 
|  | if ( (flags & I2C_M_TEN)  ) { | 
|  | #if 0 | 
|  | addr = 0xf0 | (( msg->addr >> 7) & 0x03); | 
|  | DEB2(printk("addr0: %d\n",addr)); | 
|  | ret = try_address(adap, addr, retries); | 
|  | if (ret!=1) { | 
|  | printk("iic_doAddress: died at extended address code.\n"); | 
|  | return -EREMOTEIO; | 
|  | } | 
|  | iic_outw(adap,msg->addr & 0x7f); | 
|  | if (ret != 1) { | 
|  | printk("iic_doAddress: died at 2nd address code.\n"); | 
|  | return -EREMOTEIO; | 
|  | } | 
|  | if ( flags & I2C_M_RD ) { | 
|  | i2c_repstart(adap); | 
|  | addr |= 0x01; | 
|  | ret = try_address(adap, addr, retries); | 
|  | if (ret!=1) { | 
|  | printk("iic_doAddress: died at extended address code.\n"); | 
|  | return -EREMOTEIO; | 
|  | } | 
|  | } | 
|  | #endif | 
|  | } else { | 
|  |  | 
|  | addr = ( msg->addr << 1 ); | 
|  |  | 
|  | #if 0 | 
|  | if (flags & I2C_M_RD ) | 
|  | addr |= 1; | 
|  | if (flags & I2C_M_REV_DIR_ADDR ) | 
|  | addr ^= 1; | 
|  | #endif | 
|  |  | 
|  | if (iic_inw(adap, ITE_I2CSAR) != addr) { | 
|  | iic_outw(adap, ITE_I2CSAR, addr); | 
|  | ret = try_address(adap, addr, retries); | 
|  | if (ret!=1) { | 
|  | printk("iic_doAddress: died at address code.\n"); | 
|  | return -EREMOTEIO; | 
|  | } | 
|  | } | 
|  |  | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | /* Description: Prepares the controller for a transaction (clearing status | 
|  | * registers, data buffers, etc), and then calls either iic_readbytes or | 
|  | * iic_sendbytes to do the actual transaction. | 
|  | * | 
|  | * still to be done: Before we issue a transaction, we should | 
|  | * verify that the bus is not busy or in some unknown state. | 
|  | */ | 
|  | static int iic_xfer(struct i2c_adapter *i2c_adap, | 
|  | struct i2c_msg *msgs, | 
|  | int num) | 
|  | { | 
|  | struct i2c_algo_iic_data *adap = i2c_adap->algo_data; | 
|  | struct i2c_msg *pmsg; | 
|  | int i = 0; | 
|  | int ret, timeout; | 
|  |  | 
|  | pmsg = &msgs[i]; | 
|  |  | 
|  | if(!pmsg->len) { | 
|  | DEB2(printk("iic_xfer: read/write length is 0\n");) | 
|  | return -EIO; | 
|  | } | 
|  | if(!(pmsg->flags & I2C_M_RD) && (!(pmsg->len)%2) ) { | 
|  | DEB2(printk("iic_xfer: write buffer length is not odd\n");) | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | /* Wait for any pending transfers to complete */ | 
|  | timeout = wait_for_bb(adap); | 
|  | if (timeout) { | 
|  | DEB2(printk("iic_xfer: Timeout waiting for host not busy\n");) | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | /* Flush FIFO */ | 
|  | iic_outw(adap, ITE_I2CFCR, ITE_I2CFCR_FLUSH); | 
|  |  | 
|  | /* Load address */ | 
|  | ret = iic_doAddress(adap, pmsg, i2c_adap->retries); | 
|  | if (ret) | 
|  | return -EIO; | 
|  |  | 
|  | #if 0 | 
|  | /* Combined transaction (read and write) */ | 
|  | if(num > 1) { | 
|  | DEB2(printk("iic_xfer: Call combined transaction\n")); | 
|  | ret = iic_combined_transaction(i2c_adap, msgs, num); | 
|  | } | 
|  | #endif | 
|  |  | 
|  | DEB3(printk("iic_xfer: Msg %d, addr=0x%x, flags=0x%x, len=%d\n", | 
|  | i, msgs[i].addr, msgs[i].flags, msgs[i].len);) | 
|  |  | 
|  | if(pmsg->flags & I2C_M_RD) 		/* Read */ | 
|  | ret = iic_readbytes(i2c_adap, pmsg->buf, pmsg->len, 0); | 
|  | else {													/* Write */ | 
|  | udelay(1000); | 
|  | ret = iic_sendbytes(i2c_adap, pmsg->buf, pmsg->len); | 
|  | } | 
|  |  | 
|  | if (ret != pmsg->len) | 
|  | DEB3(printk("iic_xfer: error or fail on read/write %d bytes.\n",ret)); | 
|  | else | 
|  | DEB3(printk("iic_xfer: read/write %d bytes.\n",ret)); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  |  | 
|  | /* Implements device specific ioctls.  Higher level ioctls can | 
|  | * be found in i2c-core.c and are typical of any i2c controller (specifying | 
|  | * slave address, timeouts, etc).  These ioctls take advantage of any hardware | 
|  | * features built into the controller for which this algorithm-adapter set | 
|  | * was written.  These ioctls allow you to take control of the data and clock | 
|  | * lines and set the either high or low, | 
|  | * similar to a GPIO pin. | 
|  | */ | 
|  | static int algo_control(struct i2c_adapter *adapter, | 
|  | unsigned int cmd, unsigned long arg) | 
|  | { | 
|  |  | 
|  | struct i2c_algo_iic_data *adap = adapter->algo_data; | 
|  | struct i2c_iic_msg s_msg; | 
|  | char *buf; | 
|  | int ret; | 
|  |  | 
|  | if (cmd == I2C_SREAD) { | 
|  | if(copy_from_user(&s_msg, (struct i2c_iic_msg *)arg, | 
|  | sizeof(struct i2c_iic_msg))) | 
|  | return -EFAULT; | 
|  | buf = kmalloc(s_msg.len, GFP_KERNEL); | 
|  | if (buf== NULL) | 
|  | return -ENOMEM; | 
|  |  | 
|  | /* Flush FIFO */ | 
|  | iic_outw(adap, ITE_I2CFCR, ITE_I2CFCR_FLUSH); | 
|  |  | 
|  | /* Load address */ | 
|  | iic_outw(adap, ITE_I2CSAR,s_msg.addr<<1); | 
|  | iic_outw(adap, ITE_I2CSSAR,s_msg.waddr & 0xff); | 
|  |  | 
|  | ret = iic_readbytes(adapter, buf, s_msg.len, 1); | 
|  | if (ret>=0) { | 
|  | if(copy_to_user( s_msg.buf, buf, s_msg.len) ) | 
|  | ret = -EFAULT; | 
|  | } | 
|  | kfree(buf); | 
|  | } | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | static u32 iic_func(struct i2c_adapter *adap) | 
|  | { | 
|  | return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_10BIT_ADDR | | 
|  | I2C_FUNC_PROTOCOL_MANGLING; | 
|  | } | 
|  |  | 
|  | /* -----exported algorithm data: -------------------------------------	*/ | 
|  |  | 
|  | static struct i2c_algorithm iic_algo = { | 
|  | .master_xfer	= iic_xfer, | 
|  | .algo_control	= algo_control, /* ioctl */ | 
|  | .functionality	= iic_func, | 
|  | }; | 
|  |  | 
|  |  | 
|  | /* | 
|  | * registering functions to load algorithms at runtime | 
|  | */ | 
|  | int i2c_iic_add_bus(struct i2c_adapter *adap) | 
|  | { | 
|  | struct i2c_algo_iic_data *iic_adap = adap->algo_data; | 
|  |  | 
|  | if (iic_test) { | 
|  | int ret = test_bus(iic_adap, adap->name); | 
|  | if (ret<0) | 
|  | return -ENODEV; | 
|  | } | 
|  |  | 
|  | DEB2(printk("i2c-algo-ite: hw routines for %s registered.\n", | 
|  | adap->name)); | 
|  |  | 
|  | /* register new adapter to i2c module... */ | 
|  | adap->algo = &iic_algo; | 
|  |  | 
|  | adap->timeout = 100;	/* default values, should	*/ | 
|  | adap->retries = 3;		/* be replaced by defines	*/ | 
|  | adap->flags = 0; | 
|  |  | 
|  | i2c_add_adapter(adap); | 
|  | iic_init(iic_adap); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | int i2c_iic_del_bus(struct i2c_adapter *adap) | 
|  | { | 
|  | int res; | 
|  | if ((res = i2c_del_adapter(adap)) < 0) | 
|  | return res; | 
|  | DEB2(printk("i2c-algo-ite: adapter unregistered: %s\n",adap->name)); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | int __init i2c_algo_iic_init (void) | 
|  | { | 
|  | printk(KERN_INFO "ITE iic (i2c) algorithm module\n"); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | void i2c_algo_iic_exit(void) | 
|  | { | 
|  | return; | 
|  | } | 
|  |  | 
|  |  | 
|  | EXPORT_SYMBOL(i2c_iic_add_bus); | 
|  | EXPORT_SYMBOL(i2c_iic_del_bus); | 
|  |  | 
|  | /* The MODULE_* macros resolve to nothing if MODULES is not defined | 
|  | * when this file is compiled. | 
|  | */ | 
|  | MODULE_AUTHOR("MontaVista Software <www.mvista.com>"); | 
|  | MODULE_DESCRIPTION("ITE iic algorithm"); | 
|  | MODULE_LICENSE("GPL"); | 
|  |  | 
|  | module_param(iic_test, bool, 0); | 
|  | module_param(i2c_debug, int, S_IRUGO | S_IWUSR); | 
|  |  | 
|  | MODULE_PARM_DESC(iic_test, "Test if the I2C bus is available"); | 
|  | MODULE_PARM_DESC(i2c_debug, | 
|  | "debug level - 0 off; 1 normal; 2,3 more verbose; 9 iic-protocol"); | 
|  |  | 
|  |  | 
|  | /* This function resolves to init_module (the function invoked when a module | 
|  | * is loaded via insmod) when this file is compiled with MODULES defined. | 
|  | * Otherwise (i.e. if you want this driver statically linked to the kernel), | 
|  | * a pointer to this function is stored in a table and called | 
|  | * during the initialization of the kernel (in do_basic_setup in /init/main.c) | 
|  | * | 
|  | * All this functionality is complements of the macros defined in linux/init.h | 
|  | */ | 
|  | module_init(i2c_algo_iic_init); | 
|  |  | 
|  |  | 
|  | /* If MODULES is defined when this file is compiled, then this function will | 
|  | * resolved to cleanup_module. | 
|  | */ | 
|  | module_exit(i2c_algo_iic_exit); |