diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/i2c/algos |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/i2c/algos')
-rw-r--r-- | drivers/i2c/algos/Kconfig | 70 | ||||
-rw-r--r-- | drivers/i2c/algos/Makefile | 14 | ||||
-rw-r--r-- | drivers/i2c/algos/i2c-algo-bit.c | 573 | ||||
-rw-r--r-- | drivers/i2c/algos/i2c-algo-ite.c | 812 | ||||
-rw-r--r-- | drivers/i2c/algos/i2c-algo-ite.h | 117 | ||||
-rw-r--r-- | drivers/i2c/algos/i2c-algo-pca.c | 399 | ||||
-rw-r--r-- | drivers/i2c/algos/i2c-algo-pca.h | 26 | ||||
-rw-r--r-- | drivers/i2c/algos/i2c-algo-pcf.c | 507 | ||||
-rw-r--r-- | drivers/i2c/algos/i2c-algo-pcf.h | 76 | ||||
-rw-r--r-- | drivers/i2c/algos/i2c-algo-sgi.c | 189 | ||||
-rw-r--r-- | drivers/i2c/algos/i2c-algo-sibyte.c | 222 |
11 files changed, 3005 insertions, 0 deletions
diff --git a/drivers/i2c/algos/Kconfig b/drivers/i2c/algos/Kconfig new file mode 100644 index 000000000000..30408015d231 --- /dev/null +++ b/drivers/i2c/algos/Kconfig | |||
@@ -0,0 +1,70 @@ | |||
1 | # | ||
2 | # Character device configuration | ||
3 | # | ||
4 | |||
5 | menu "I2C Algorithms" | ||
6 | depends on I2C | ||
7 | |||
8 | config I2C_ALGOBIT | ||
9 | tristate "I2C bit-banging interfaces" | ||
10 | depends on I2C | ||
11 | help | ||
12 | This allows you to use a range of I2C adapters called bit-banging | ||
13 | adapters. Say Y if you own an I2C adapter belonging to this class | ||
14 | and then say Y to the specific driver for you adapter below. | ||
15 | |||
16 | This support is also available as a module. If so, the module | ||
17 | will be called i2c-algo-bit. | ||
18 | |||
19 | config I2C_ALGOPCF | ||
20 | tristate "I2C PCF 8584 interfaces" | ||
21 | depends on I2C | ||
22 | help | ||
23 | This allows you to use a range of I2C adapters called PCF adapters. | ||
24 | Say Y if you own an I2C adapter belonging to this class and then say | ||
25 | Y to the specific driver for you adapter below. | ||
26 | |||
27 | This support is also available as a module. If so, the module | ||
28 | will be called i2c-algo-pcf. | ||
29 | |||
30 | config I2C_ALGOPCA | ||
31 | tristate "I2C PCA 9564 interfaces" | ||
32 | depends on I2C | ||
33 | help | ||
34 | This allows you to use a range of I2C adapters called PCA adapters. | ||
35 | Say Y if you own an I2C adapter belonging to this class and then say | ||
36 | Y to the specific driver for you adapter below. | ||
37 | |||
38 | This support is also available as a module. If so, the module | ||
39 | will be called i2c-algo-pca. | ||
40 | |||
41 | config I2C_ALGOITE | ||
42 | tristate "ITE I2C Algorithm" | ||
43 | depends on MIPS_ITE8172 && I2C | ||
44 | help | ||
45 | This supports the use of the ITE8172 I2C interface found on some MIPS | ||
46 | systems. Say Y if you have one of these. You should also say Y for | ||
47 | the ITE I2C peripheral driver support below. | ||
48 | |||
49 | This support is also available as a module. If so, the module | ||
50 | will be called i2c-algo-ite. | ||
51 | |||
52 | config I2C_ALGO8XX | ||
53 | tristate "MPC8xx CPM I2C interface" | ||
54 | depends on 8xx && I2C | ||
55 | |||
56 | config I2C_ALGO_SIBYTE | ||
57 | tristate "SiByte SMBus interface" | ||
58 | depends on SIBYTE_SB1xxx_SOC && I2C | ||
59 | help | ||
60 | Supports the SiByte SOC on-chip I2C interfaces (2 channels). | ||
61 | |||
62 | config I2C_ALGO_SGI | ||
63 | tristate "I2C SGI interfaces" | ||
64 | depends on I2C && (SGI_IP22 || SGI_IP32 || X86_VISWS) | ||
65 | help | ||
66 | Supports the SGI interfaces like the ones found on SGI Indy VINO | ||
67 | or SGI O2 MACE. | ||
68 | |||
69 | endmenu | ||
70 | |||
diff --git a/drivers/i2c/algos/Makefile b/drivers/i2c/algos/Makefile new file mode 100644 index 000000000000..867fe1f67401 --- /dev/null +++ b/drivers/i2c/algos/Makefile | |||
@@ -0,0 +1,14 @@ | |||
1 | # | ||
2 | # Makefile for the i2c algorithms | ||
3 | # | ||
4 | |||
5 | obj-$(CONFIG_I2C_ALGOBIT) += i2c-algo-bit.o | ||
6 | obj-$(CONFIG_I2C_ALGOPCF) += i2c-algo-pcf.o | ||
7 | obj-$(CONFIG_I2C_ALGOPCA) += i2c-algo-pca.o | ||
8 | obj-$(CONFIG_I2C_ALGOITE) += i2c-algo-ite.o | ||
9 | obj-$(CONFIG_I2C_ALGO_SIBYTE) += i2c-algo-sibyte.o | ||
10 | obj-$(CONFIG_I2C_ALGO_SGI) += i2c-algo-sgi.o | ||
11 | |||
12 | ifeq ($(CONFIG_I2C_DEBUG_ALGO),y) | ||
13 | EXTRA_CFLAGS += -DDEBUG | ||
14 | endif | ||
diff --git a/drivers/i2c/algos/i2c-algo-bit.c b/drivers/i2c/algos/i2c-algo-bit.c new file mode 100644 index 000000000000..fb5b732238ed --- /dev/null +++ b/drivers/i2c/algos/i2c-algo-bit.c | |||
@@ -0,0 +1,573 @@ | |||
1 | /* ------------------------------------------------------------------------- */ | ||
2 | /* i2c-algo-bit.c i2c driver algorithms for bit-shift adapters */ | ||
3 | /* ------------------------------------------------------------------------- */ | ||
4 | /* Copyright (C) 1995-2000 Simon G. Vogl | ||
5 | |||
6 | This program is free software; you can redistribute it and/or modify | ||
7 | it under the terms of the GNU General Public License as published by | ||
8 | the Free Software Foundation; either version 2 of the License, or | ||
9 | (at your option) any later version. | ||
10 | |||
11 | This program is distributed in the hope that it will be useful, | ||
12 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
14 | GNU General Public License for more details. | ||
15 | |||
16 | You should have received a copy of the GNU General Public License | ||
17 | along with this program; if not, write to the Free Software | ||
18 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ | ||
19 | /* ------------------------------------------------------------------------- */ | ||
20 | |||
21 | /* With some changes from Frodo Looijaard <frodol@dds.nl>, Kyösti Mälkki | ||
22 | <kmalkki@cc.hut.fi> and Jean Delvare <khali@linux-fr.org> */ | ||
23 | |||
24 | #include <linux/kernel.h> | ||
25 | #include <linux/module.h> | ||
26 | #include <linux/delay.h> | ||
27 | #include <linux/slab.h> | ||
28 | #include <linux/init.h> | ||
29 | #include <linux/errno.h> | ||
30 | #include <linux/sched.h> | ||
31 | #include <linux/i2c.h> | ||
32 | #include <linux/i2c-algo-bit.h> | ||
33 | |||
34 | |||
35 | /* ----- global defines ----------------------------------------------- */ | ||
36 | #define DEB(x) if (i2c_debug>=1) x; | ||
37 | #define DEB2(x) if (i2c_debug>=2) x; | ||
38 | #define DEBSTAT(x) if (i2c_debug>=3) x; /* print several statistical values*/ | ||
39 | #define DEBPROTO(x) if (i2c_debug>=9) { x; } | ||
40 | /* debug the protocol by showing transferred bits */ | ||
41 | |||
42 | |||
43 | /* ----- global variables --------------------------------------------- */ | ||
44 | |||
45 | /* module parameters: | ||
46 | */ | ||
47 | static int i2c_debug; | ||
48 | static int bit_test; /* see if the line-setting functions work */ | ||
49 | |||
50 | /* --- setting states on the bus with the right timing: --------------- */ | ||
51 | |||
52 | #define setsda(adap,val) adap->setsda(adap->data, val) | ||
53 | #define setscl(adap,val) adap->setscl(adap->data, val) | ||
54 | #define getsda(adap) adap->getsda(adap->data) | ||
55 | #define getscl(adap) adap->getscl(adap->data) | ||
56 | |||
57 | static inline void sdalo(struct i2c_algo_bit_data *adap) | ||
58 | { | ||
59 | setsda(adap,0); | ||
60 | udelay(adap->udelay); | ||
61 | } | ||
62 | |||
63 | static inline void sdahi(struct i2c_algo_bit_data *adap) | ||
64 | { | ||
65 | setsda(adap,1); | ||
66 | udelay(adap->udelay); | ||
67 | } | ||
68 | |||
69 | static inline void scllo(struct i2c_algo_bit_data *adap) | ||
70 | { | ||
71 | setscl(adap,0); | ||
72 | udelay(adap->udelay); | ||
73 | } | ||
74 | |||
75 | /* | ||
76 | * Raise scl line, and do checking for delays. This is necessary for slower | ||
77 | * devices. | ||
78 | */ | ||
79 | static inline int sclhi(struct i2c_algo_bit_data *adap) | ||
80 | { | ||
81 | unsigned long start; | ||
82 | |||
83 | setscl(adap,1); | ||
84 | |||
85 | /* Not all adapters have scl sense line... */ | ||
86 | if (adap->getscl == NULL ) { | ||
87 | udelay(adap->udelay); | ||
88 | return 0; | ||
89 | } | ||
90 | |||
91 | start=jiffies; | ||
92 | while (! getscl(adap) ) { | ||
93 | /* the hw knows how to read the clock line, | ||
94 | * so we wait until it actually gets high. | ||
95 | * This is safer as some chips may hold it low | ||
96 | * while they are processing data internally. | ||
97 | */ | ||
98 | if (time_after_eq(jiffies, start+adap->timeout)) { | ||
99 | return -ETIMEDOUT; | ||
100 | } | ||
101 | cond_resched(); | ||
102 | } | ||
103 | DEBSTAT(printk(KERN_DEBUG "needed %ld jiffies\n", jiffies-start)); | ||
104 | udelay(adap->udelay); | ||
105 | return 0; | ||
106 | } | ||
107 | |||
108 | |||
109 | /* --- other auxiliary functions -------------------------------------- */ | ||
110 | static void i2c_start(struct i2c_algo_bit_data *adap) | ||
111 | { | ||
112 | /* assert: scl, sda are high */ | ||
113 | DEBPROTO(printk("S ")); | ||
114 | sdalo(adap); | ||
115 | scllo(adap); | ||
116 | } | ||
117 | |||
118 | static void i2c_repstart(struct i2c_algo_bit_data *adap) | ||
119 | { | ||
120 | /* scl, sda may not be high */ | ||
121 | DEBPROTO(printk(" Sr ")); | ||
122 | setsda(adap,1); | ||
123 | sclhi(adap); | ||
124 | udelay(adap->udelay); | ||
125 | |||
126 | sdalo(adap); | ||
127 | scllo(adap); | ||
128 | } | ||
129 | |||
130 | |||
131 | static void i2c_stop(struct i2c_algo_bit_data *adap) | ||
132 | { | ||
133 | DEBPROTO(printk("P\n")); | ||
134 | /* assert: scl is low */ | ||
135 | sdalo(adap); | ||
136 | sclhi(adap); | ||
137 | sdahi(adap); | ||
138 | } | ||
139 | |||
140 | |||
141 | |||
142 | /* send a byte without start cond., look for arbitration, | ||
143 | check ackn. from slave */ | ||
144 | /* returns: | ||
145 | * 1 if the device acknowledged | ||
146 | * 0 if the device did not ack | ||
147 | * -ETIMEDOUT if an error occurred (while raising the scl line) | ||
148 | */ | ||
149 | static int i2c_outb(struct i2c_adapter *i2c_adap, char c) | ||
150 | { | ||
151 | int i; | ||
152 | int sb; | ||
153 | int ack; | ||
154 | struct i2c_algo_bit_data *adap = i2c_adap->algo_data; | ||
155 | |||
156 | /* assert: scl is low */ | ||
157 | for ( i=7 ; i>=0 ; i-- ) { | ||
158 | sb = c & ( 1 << i ); | ||
159 | setsda(adap,sb); | ||
160 | udelay(adap->udelay); | ||
161 | DEBPROTO(printk(KERN_DEBUG "%d",sb!=0)); | ||
162 | if (sclhi(adap)<0) { /* timed out */ | ||
163 | sdahi(adap); /* we don't want to block the net */ | ||
164 | DEB2(printk(KERN_DEBUG " i2c_outb: 0x%02x, timeout at bit #%d\n", c&0xff, i)); | ||
165 | return -ETIMEDOUT; | ||
166 | }; | ||
167 | /* do arbitration here: | ||
168 | * if ( sb && ! getsda(adap) ) -> ouch! Get out of here. | ||
169 | */ | ||
170 | setscl(adap, 0 ); | ||
171 | udelay(adap->udelay); | ||
172 | } | ||
173 | sdahi(adap); | ||
174 | if (sclhi(adap)<0){ /* timeout */ | ||
175 | DEB2(printk(KERN_DEBUG " i2c_outb: 0x%02x, timeout at ack\n", c&0xff)); | ||
176 | return -ETIMEDOUT; | ||
177 | }; | ||
178 | /* read ack: SDA should be pulled down by slave */ | ||
179 | ack=getsda(adap); /* ack: sda is pulled low ->success. */ | ||
180 | DEB2(printk(KERN_DEBUG " i2c_outb: 0x%02x , getsda() = %d\n", c & 0xff, ack)); | ||
181 | |||
182 | DEBPROTO( printk(KERN_DEBUG "[%2.2x]",c&0xff) ); | ||
183 | DEBPROTO(if (0==ack){ printk(KERN_DEBUG " A ");} else printk(KERN_DEBUG " NA ") ); | ||
184 | scllo(adap); | ||
185 | return 0==ack; /* return 1 if device acked */ | ||
186 | /* assert: scl is low (sda undef) */ | ||
187 | } | ||
188 | |||
189 | |||
190 | static int i2c_inb(struct i2c_adapter *i2c_adap) | ||
191 | { | ||
192 | /* read byte via i2c port, without start/stop sequence */ | ||
193 | /* acknowledge is sent in i2c_read. */ | ||
194 | int i; | ||
195 | unsigned char indata=0; | ||
196 | struct i2c_algo_bit_data *adap = i2c_adap->algo_data; | ||
197 | |||
198 | /* assert: scl is low */ | ||
199 | sdahi(adap); | ||
200 | for (i=0;i<8;i++) { | ||
201 | if (sclhi(adap)<0) { /* timeout */ | ||
202 | DEB2(printk(KERN_DEBUG " i2c_inb: timeout at bit #%d\n", 7-i)); | ||
203 | return -ETIMEDOUT; | ||
204 | }; | ||
205 | indata *= 2; | ||
206 | if ( getsda(adap) ) | ||
207 | indata |= 0x01; | ||
208 | scllo(adap); | ||
209 | } | ||
210 | /* assert: scl is low */ | ||
211 | DEB2(printk(KERN_DEBUG "i2c_inb: 0x%02x\n", indata & 0xff)); | ||
212 | |||
213 | DEBPROTO(printk(KERN_DEBUG " 0x%02x", indata & 0xff)); | ||
214 | return (int) (indata & 0xff); | ||
215 | } | ||
216 | |||
217 | /* | ||
218 | * Sanity check for the adapter hardware - check the reaction of | ||
219 | * the bus lines only if it seems to be idle. | ||
220 | */ | ||
221 | static int test_bus(struct i2c_algo_bit_data *adap, char* name) { | ||
222 | int scl,sda; | ||
223 | |||
224 | if (adap->getscl==NULL) | ||
225 | printk(KERN_INFO "i2c-algo-bit.o: Testing SDA only, " | ||
226 | "SCL is not readable.\n"); | ||
227 | |||
228 | sda=getsda(adap); | ||
229 | scl=(adap->getscl==NULL?1:getscl(adap)); | ||
230 | printk(KERN_DEBUG "i2c-algo-bit.o: (0) scl=%d, sda=%d\n",scl,sda); | ||
231 | if (!scl || !sda ) { | ||
232 | printk(KERN_WARNING "i2c-algo-bit.o: %s seems to be busy.\n", name); | ||
233 | goto bailout; | ||
234 | } | ||
235 | |||
236 | sdalo(adap); | ||
237 | sda=getsda(adap); | ||
238 | scl=(adap->getscl==NULL?1:getscl(adap)); | ||
239 | printk(KERN_DEBUG "i2c-algo-bit.o: (1) scl=%d, sda=%d\n",scl,sda); | ||
240 | if ( 0 != sda ) { | ||
241 | printk(KERN_WARNING "i2c-algo-bit.o: SDA stuck high!\n"); | ||
242 | goto bailout; | ||
243 | } | ||
244 | if ( 0 == scl ) { | ||
245 | printk(KERN_WARNING "i2c-algo-bit.o: SCL unexpected low " | ||
246 | "while pulling SDA low!\n"); | ||
247 | goto bailout; | ||
248 | } | ||
249 | |||
250 | sdahi(adap); | ||
251 | sda=getsda(adap); | ||
252 | scl=(adap->getscl==NULL?1:getscl(adap)); | ||
253 | printk(KERN_DEBUG "i2c-algo-bit.o: (2) scl=%d, sda=%d\n",scl,sda); | ||
254 | if ( 0 == sda ) { | ||
255 | printk(KERN_WARNING "i2c-algo-bit.o: SDA stuck low!\n"); | ||
256 | goto bailout; | ||
257 | } | ||
258 | if ( 0 == scl ) { | ||
259 | printk(KERN_WARNING "i2c-algo-bit.o: SCL unexpected low " | ||
260 | "while pulling SDA high!\n"); | ||
261 | goto bailout; | ||
262 | } | ||
263 | |||
264 | scllo(adap); | ||
265 | sda=getsda(adap); | ||
266 | scl=(adap->getscl==NULL?0:getscl(adap)); | ||
267 | printk(KERN_DEBUG "i2c-algo-bit.o: (3) scl=%d, sda=%d\n",scl,sda); | ||
268 | if ( 0 != scl ) { | ||
269 | printk(KERN_WARNING "i2c-algo-bit.o: SCL stuck high!\n"); | ||
270 | goto bailout; | ||
271 | } | ||
272 | if ( 0 == sda ) { | ||
273 | printk(KERN_WARNING "i2c-algo-bit.o: SDA unexpected low " | ||
274 | "while pulling SCL low!\n"); | ||
275 | goto bailout; | ||
276 | } | ||
277 | |||
278 | sclhi(adap); | ||
279 | sda=getsda(adap); | ||
280 | scl=(adap->getscl==NULL?1:getscl(adap)); | ||
281 | printk(KERN_DEBUG "i2c-algo-bit.o: (4) scl=%d, sda=%d\n",scl,sda); | ||
282 | if ( 0 == scl ) { | ||
283 | printk(KERN_WARNING "i2c-algo-bit.o: SCL stuck low!\n"); | ||
284 | goto bailout; | ||
285 | } | ||
286 | if ( 0 == sda ) { | ||
287 | printk(KERN_WARNING "i2c-algo-bit.o: SDA unexpected low " | ||
288 | "while pulling SCL high!\n"); | ||
289 | goto bailout; | ||
290 | } | ||
291 | printk(KERN_INFO "i2c-algo-bit.o: %s passed test.\n",name); | ||
292 | return 0; | ||
293 | bailout: | ||
294 | sdahi(adap); | ||
295 | sclhi(adap); | ||
296 | return -ENODEV; | ||
297 | } | ||
298 | |||
299 | /* ----- Utility functions | ||
300 | */ | ||
301 | |||
302 | /* try_address tries to contact a chip for a number of | ||
303 | * times before it gives up. | ||
304 | * return values: | ||
305 | * 1 chip answered | ||
306 | * 0 chip did not answer | ||
307 | * -x transmission error | ||
308 | */ | ||
309 | static inline int try_address(struct i2c_adapter *i2c_adap, | ||
310 | unsigned char addr, int retries) | ||
311 | { | ||
312 | struct i2c_algo_bit_data *adap = i2c_adap->algo_data; | ||
313 | int i,ret = -1; | ||
314 | for (i=0;i<=retries;i++) { | ||
315 | ret = i2c_outb(i2c_adap,addr); | ||
316 | if (ret==1) | ||
317 | break; /* success! */ | ||
318 | i2c_stop(adap); | ||
319 | udelay(5/*adap->udelay*/); | ||
320 | if (i==retries) /* no success */ | ||
321 | break; | ||
322 | i2c_start(adap); | ||
323 | udelay(adap->udelay); | ||
324 | } | ||
325 | DEB2(if (i) | ||
326 | printk(KERN_DEBUG "i2c-algo-bit.o: Used %d tries to %s client at 0x%02x : %s\n", | ||
327 | i+1, addr & 1 ? "read" : "write", addr>>1, | ||
328 | ret==1 ? "success" : ret==0 ? "no ack" : "failed, timeout?" ) | ||
329 | ); | ||
330 | return ret; | ||
331 | } | ||
332 | |||
333 | static int sendbytes(struct i2c_adapter *i2c_adap, struct i2c_msg *msg) | ||
334 | { | ||
335 | struct i2c_algo_bit_data *adap = i2c_adap->algo_data; | ||
336 | char c; | ||
337 | const char *temp = msg->buf; | ||
338 | int count = msg->len; | ||
339 | unsigned short nak_ok = msg->flags & I2C_M_IGNORE_NAK; | ||
340 | int retval; | ||
341 | int wrcount=0; | ||
342 | |||
343 | while (count > 0) { | ||
344 | c = *temp; | ||
345 | DEB2(dev_dbg(&i2c_adap->dev, "sendbytes: writing %2.2X\n", c&0xff)); | ||
346 | retval = i2c_outb(i2c_adap,c); | ||
347 | if ((retval>0) || (nak_ok && (retval==0))) { /* ok or ignored NAK */ | ||
348 | count--; | ||
349 | temp++; | ||
350 | wrcount++; | ||
351 | } else { /* arbitration or no acknowledge */ | ||
352 | dev_err(&i2c_adap->dev, "sendbytes: error - bailout.\n"); | ||
353 | i2c_stop(adap); | ||
354 | return (retval<0)? retval : -EFAULT; | ||
355 | /* got a better one ?? */ | ||
356 | } | ||
357 | #if 0 | ||
358 | /* from asm/delay.h */ | ||
359 | __delay(adap->mdelay * (loops_per_sec / 1000) ); | ||
360 | #endif | ||
361 | } | ||
362 | return wrcount; | ||
363 | } | ||
364 | |||
365 | static inline int readbytes(struct i2c_adapter *i2c_adap, struct i2c_msg *msg) | ||
366 | { | ||
367 | int inval; | ||
368 | int rdcount=0; /* counts bytes read */ | ||
369 | struct i2c_algo_bit_data *adap = i2c_adap->algo_data; | ||
370 | char *temp = msg->buf; | ||
371 | int count = msg->len; | ||
372 | |||
373 | while (count > 0) { | ||
374 | inval = i2c_inb(i2c_adap); | ||
375 | /*printk("%#02x ",inval); if ( ! (count % 16) ) printk("\n"); */ | ||
376 | if (inval>=0) { | ||
377 | *temp = inval; | ||
378 | rdcount++; | ||
379 | } else { /* read timed out */ | ||
380 | printk(KERN_ERR "i2c-algo-bit.o: readbytes: i2c_inb timed out.\n"); | ||
381 | break; | ||
382 | } | ||
383 | |||
384 | temp++; | ||
385 | count--; | ||
386 | |||
387 | if (msg->flags & I2C_M_NO_RD_ACK) | ||
388 | continue; | ||
389 | |||
390 | if ( count > 0 ) { /* send ack */ | ||
391 | sdalo(adap); | ||
392 | DEBPROTO(printk(" Am ")); | ||
393 | } else { | ||
394 | sdahi(adap); /* neg. ack on last byte */ | ||
395 | DEBPROTO(printk(" NAm ")); | ||
396 | } | ||
397 | if (sclhi(adap)<0) { /* timeout */ | ||
398 | sdahi(adap); | ||
399 | printk(KERN_ERR "i2c-algo-bit.o: readbytes: Timeout at ack\n"); | ||
400 | return -ETIMEDOUT; | ||
401 | }; | ||
402 | scllo(adap); | ||
403 | sdahi(adap); | ||
404 | } | ||
405 | return rdcount; | ||
406 | } | ||
407 | |||
408 | /* doAddress initiates the transfer by generating the start condition (in | ||
409 | * try_address) and transmits the address in the necessary format to handle | ||
410 | * reads, writes as well as 10bit-addresses. | ||
411 | * returns: | ||
412 | * 0 everything went okay, the chip ack'ed, or IGNORE_NAK flag was set | ||
413 | * -x an error occurred (like: -EREMOTEIO if the device did not answer, or | ||
414 | * -ETIMEDOUT, for example if the lines are stuck...) | ||
415 | */ | ||
416 | static inline int bit_doAddress(struct i2c_adapter *i2c_adap, struct i2c_msg *msg) | ||
417 | { | ||
418 | unsigned short flags = msg->flags; | ||
419 | unsigned short nak_ok = msg->flags & I2C_M_IGNORE_NAK; | ||
420 | struct i2c_algo_bit_data *adap = i2c_adap->algo_data; | ||
421 | |||
422 | unsigned char addr; | ||
423 | int ret, retries; | ||
424 | |||
425 | retries = nak_ok ? 0 : i2c_adap->retries; | ||
426 | |||
427 | if ( (flags & I2C_M_TEN) ) { | ||
428 | /* a ten bit address */ | ||
429 | addr = 0xf0 | (( msg->addr >> 7) & 0x03); | ||
430 | DEB2(printk(KERN_DEBUG "addr0: %d\n",addr)); | ||
431 | /* try extended address code...*/ | ||
432 | ret = try_address(i2c_adap, addr, retries); | ||
433 | if ((ret != 1) && !nak_ok) { | ||
434 | printk(KERN_ERR "died at extended address code.\n"); | ||
435 | return -EREMOTEIO; | ||
436 | } | ||
437 | /* the remaining 8 bit address */ | ||
438 | ret = i2c_outb(i2c_adap,msg->addr & 0x7f); | ||
439 | if ((ret != 1) && !nak_ok) { | ||
440 | /* the chip did not ack / xmission error occurred */ | ||
441 | printk(KERN_ERR "died at 2nd address code.\n"); | ||
442 | return -EREMOTEIO; | ||
443 | } | ||
444 | if ( flags & I2C_M_RD ) { | ||
445 | i2c_repstart(adap); | ||
446 | /* okay, now switch into reading mode */ | ||
447 | addr |= 0x01; | ||
448 | ret = try_address(i2c_adap, addr, retries); | ||
449 | if ((ret!=1) && !nak_ok) { | ||
450 | printk(KERN_ERR "died at extended address code.\n"); | ||
451 | return -EREMOTEIO; | ||
452 | } | ||
453 | } | ||
454 | } else { /* normal 7bit address */ | ||
455 | addr = ( msg->addr << 1 ); | ||
456 | if (flags & I2C_M_RD ) | ||
457 | addr |= 1; | ||
458 | if (flags & I2C_M_REV_DIR_ADDR ) | ||
459 | addr ^= 1; | ||
460 | ret = try_address(i2c_adap, addr, retries); | ||
461 | if ((ret!=1) && !nak_ok) | ||
462 | return -EREMOTEIO; | ||
463 | } | ||
464 | |||
465 | return 0; | ||
466 | } | ||
467 | |||
468 | static int bit_xfer(struct i2c_adapter *i2c_adap, | ||
469 | struct i2c_msg msgs[], int num) | ||
470 | { | ||
471 | struct i2c_msg *pmsg; | ||
472 | struct i2c_algo_bit_data *adap = i2c_adap->algo_data; | ||
473 | |||
474 | int i,ret; | ||
475 | unsigned short nak_ok; | ||
476 | |||
477 | i2c_start(adap); | ||
478 | for (i=0;i<num;i++) { | ||
479 | pmsg = &msgs[i]; | ||
480 | nak_ok = pmsg->flags & I2C_M_IGNORE_NAK; | ||
481 | if (!(pmsg->flags & I2C_M_NOSTART)) { | ||
482 | if (i) { | ||
483 | i2c_repstart(adap); | ||
484 | } | ||
485 | ret = bit_doAddress(i2c_adap, pmsg); | ||
486 | if ((ret != 0) && !nak_ok) { | ||
487 | DEB2(printk(KERN_DEBUG "i2c-algo-bit.o: NAK from device addr %2.2x msg #%d\n" | ||
488 | ,msgs[i].addr,i)); | ||
489 | return (ret<0) ? ret : -EREMOTEIO; | ||
490 | } | ||
491 | } | ||
492 | if (pmsg->flags & I2C_M_RD ) { | ||
493 | /* read bytes into buffer*/ | ||
494 | ret = readbytes(i2c_adap, pmsg); | ||
495 | DEB2(printk(KERN_DEBUG "i2c-algo-bit.o: read %d bytes.\n",ret)); | ||
496 | if (ret < pmsg->len ) { | ||
497 | return (ret<0)? ret : -EREMOTEIO; | ||
498 | } | ||
499 | } else { | ||
500 | /* write bytes from buffer */ | ||
501 | ret = sendbytes(i2c_adap, pmsg); | ||
502 | DEB2(printk(KERN_DEBUG "i2c-algo-bit.o: wrote %d bytes.\n",ret)); | ||
503 | if (ret < pmsg->len ) { | ||
504 | return (ret<0) ? ret : -EREMOTEIO; | ||
505 | } | ||
506 | } | ||
507 | } | ||
508 | i2c_stop(adap); | ||
509 | return num; | ||
510 | } | ||
511 | |||
512 | static u32 bit_func(struct i2c_adapter *adap) | ||
513 | { | ||
514 | return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL | | ||
515 | I2C_FUNC_10BIT_ADDR | I2C_FUNC_PROTOCOL_MANGLING; | ||
516 | } | ||
517 | |||
518 | |||
519 | /* -----exported algorithm data: ------------------------------------- */ | ||
520 | |||
521 | static struct i2c_algorithm i2c_bit_algo = { | ||
522 | .name = "Bit-shift algorithm", | ||
523 | .id = I2C_ALGO_BIT, | ||
524 | .master_xfer = bit_xfer, | ||
525 | .functionality = bit_func, | ||
526 | }; | ||
527 | |||
528 | /* | ||
529 | * registering functions to load algorithms at runtime | ||
530 | */ | ||
531 | int i2c_bit_add_bus(struct i2c_adapter *adap) | ||
532 | { | ||
533 | struct i2c_algo_bit_data *bit_adap = adap->algo_data; | ||
534 | |||
535 | if (bit_test) { | ||
536 | int ret = test_bus(bit_adap, adap->name); | ||
537 | if (ret<0) | ||
538 | return -ENODEV; | ||
539 | } | ||
540 | |||
541 | DEB2(dev_dbg(&adap->dev, "hw routines registered.\n")); | ||
542 | |||
543 | /* register new adapter to i2c module... */ | ||
544 | |||
545 | adap->id |= i2c_bit_algo.id; | ||
546 | adap->algo = &i2c_bit_algo; | ||
547 | |||
548 | adap->timeout = 100; /* default values, should */ | ||
549 | adap->retries = 3; /* be replaced by defines */ | ||
550 | |||
551 | i2c_add_adapter(adap); | ||
552 | return 0; | ||
553 | } | ||
554 | |||
555 | |||
556 | int i2c_bit_del_bus(struct i2c_adapter *adap) | ||
557 | { | ||
558 | return i2c_del_adapter(adap); | ||
559 | } | ||
560 | |||
561 | EXPORT_SYMBOL(i2c_bit_add_bus); | ||
562 | EXPORT_SYMBOL(i2c_bit_del_bus); | ||
563 | |||
564 | MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>"); | ||
565 | MODULE_DESCRIPTION("I2C-Bus bit-banging algorithm"); | ||
566 | MODULE_LICENSE("GPL"); | ||
567 | |||
568 | module_param(bit_test, bool, 0); | ||
569 | module_param(i2c_debug, int, S_IRUGO | S_IWUSR); | ||
570 | |||
571 | MODULE_PARM_DESC(bit_test, "Test the lines of the bus to see if it is stuck"); | ||
572 | MODULE_PARM_DESC(i2c_debug, | ||
573 | "debug level - 0 off; 1 normal; 2,3 more verbose; 9 bit-protocol"); | ||
diff --git a/drivers/i2c/algos/i2c-algo-ite.c b/drivers/i2c/algos/i2c-algo-ite.c new file mode 100644 index 000000000000..68e9e6832ca0 --- /dev/null +++ b/drivers/i2c/algos/i2c-algo-ite.c | |||
@@ -0,0 +1,812 @@ | |||
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 | .name = "ITE IIC algorithm", | ||
717 | .id = I2C_ALGO_IIC, | ||
718 | .master_xfer = iic_xfer, | ||
719 | .algo_control = algo_control, /* ioctl */ | ||
720 | .functionality = iic_func, | ||
721 | }; | ||
722 | |||
723 | |||
724 | /* | ||
725 | * registering functions to load algorithms at runtime | ||
726 | */ | ||
727 | int i2c_iic_add_bus(struct i2c_adapter *adap) | ||
728 | { | ||
729 | struct i2c_algo_iic_data *iic_adap = adap->algo_data; | ||
730 | |||
731 | if (iic_test) { | ||
732 | int ret = test_bus(iic_adap, adap->name); | ||
733 | if (ret<0) | ||
734 | return -ENODEV; | ||
735 | } | ||
736 | |||
737 | DEB2(printk("i2c-algo-ite: hw routines for %s registered.\n", | ||
738 | adap->name)); | ||
739 | |||
740 | /* register new adapter to i2c module... */ | ||
741 | |||
742 | adap->id |= iic_algo.id; | ||
743 | adap->algo = &iic_algo; | ||
744 | |||
745 | adap->timeout = 100; /* default values, should */ | ||
746 | adap->retries = 3; /* be replaced by defines */ | ||
747 | adap->flags = 0; | ||
748 | |||
749 | i2c_add_adapter(adap); | ||
750 | iic_init(iic_adap); | ||
751 | |||
752 | return 0; | ||
753 | } | ||
754 | |||
755 | |||
756 | int i2c_iic_del_bus(struct i2c_adapter *adap) | ||
757 | { | ||
758 | int res; | ||
759 | if ((res = i2c_del_adapter(adap)) < 0) | ||
760 | return res; | ||
761 | DEB2(printk("i2c-algo-ite: adapter unregistered: %s\n",adap->name)); | ||
762 | |||
763 | return 0; | ||
764 | } | ||
765 | |||
766 | |||
767 | int __init i2c_algo_iic_init (void) | ||
768 | { | ||
769 | printk(KERN_INFO "ITE iic (i2c) algorithm module\n"); | ||
770 | return 0; | ||
771 | } | ||
772 | |||
773 | |||
774 | void i2c_algo_iic_exit(void) | ||
775 | { | ||
776 | return; | ||
777 | } | ||
778 | |||
779 | |||
780 | EXPORT_SYMBOL(i2c_iic_add_bus); | ||
781 | EXPORT_SYMBOL(i2c_iic_del_bus); | ||
782 | |||
783 | /* The MODULE_* macros resolve to nothing if MODULES is not defined | ||
784 | * when this file is compiled. | ||
785 | */ | ||
786 | MODULE_AUTHOR("MontaVista Software <www.mvista.com>"); | ||
787 | MODULE_DESCRIPTION("ITE iic algorithm"); | ||
788 | MODULE_LICENSE("GPL"); | ||
789 | |||
790 | module_param(iic_test, bool, 0); | ||
791 | module_param(i2c_debug, int, S_IRUGO | S_IWUSR); | ||
792 | |||
793 | MODULE_PARM_DESC(iic_test, "Test if the I2C bus is available"); | ||
794 | MODULE_PARM_DESC(i2c_debug, | ||
795 | "debug level - 0 off; 1 normal; 2,3 more verbose; 9 iic-protocol"); | ||
796 | |||
797 | |||
798 | /* This function resolves to init_module (the function invoked when a module | ||
799 | * is loaded via insmod) when this file is compiled with MODULES defined. | ||
800 | * Otherwise (i.e. if you want this driver statically linked to the kernel), | ||
801 | * a pointer to this function is stored in a table and called | ||
802 | * during the initialization of the kernel (in do_basic_setup in /init/main.c) | ||
803 | * | ||
804 | * All this functionality is complements of the macros defined in linux/init.h | ||
805 | */ | ||
806 | module_init(i2c_algo_iic_init); | ||
807 | |||
808 | |||
809 | /* If MODULES is defined when this file is compiled, then this function will | ||
810 | * resolved to cleanup_module. | ||
811 | */ | ||
812 | module_exit(i2c_algo_iic_exit); | ||
diff --git a/drivers/i2c/algos/i2c-algo-ite.h b/drivers/i2c/algos/i2c-algo-ite.h new file mode 100644 index 000000000000..a8ca3c9b546a --- /dev/null +++ b/drivers/i2c/algos/i2c-algo-ite.h | |||
@@ -0,0 +1,117 @@ | |||
1 | /* | ||
2 | -------------------------------------------------------------------- | ||
3 | i2c-ite.h: Global defines for the I2C controller on board the | ||
4 | ITE MIPS processor. | ||
5 | -------------------------------------------------------------------- | ||
6 | Hai-Pao Fan, MontaVista Software, Inc. | ||
7 | hpfan@mvista.com or source@mvista.com | ||
8 | |||
9 | Copyright 2001 MontaVista Software Inc. | ||
10 | |||
11 | * This program is free software; you can redistribute it and/or modify it | ||
12 | * under the terms of the GNU General Public License as published by the | ||
13 | * Free Software Foundation; either version 2 of the License, or (at your | ||
14 | * option) any later version. | ||
15 | * | ||
16 | * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED | ||
17 | * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF | ||
18 | * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN | ||
19 | * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, | ||
20 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT | ||
21 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF | ||
22 | * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON | ||
23 | * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | ||
24 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF | ||
25 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | ||
26 | * | ||
27 | * You should have received a copy of the GNU General Public License along | ||
28 | * with this program; if not, write to the Free Software Foundation, Inc., | ||
29 | * 675 Mass Ave, Cambridge, MA 02139, USA. | ||
30 | |||
31 | */ | ||
32 | |||
33 | #ifndef I2C_ITE_H | ||
34 | #define I2C_ITE_H 1 | ||
35 | |||
36 | #include <asm/it8172/it8172.h> | ||
37 | |||
38 | /* I2C Registers */ | ||
39 | #define ITE_I2CHCR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x30 | ||
40 | #define ITE_I2CHSR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x34 | ||
41 | #define ITE_I2CSAR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x38 | ||
42 | #define ITE_I2CSSAR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x3c | ||
43 | #define ITE_I2CCKCNT IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x48 | ||
44 | #define ITE_I2CSHDR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x4c | ||
45 | #define ITE_I2CRSUR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x50 | ||
46 | #define ITE_I2CPSUR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x54 | ||
47 | |||
48 | #define ITE_I2CFDR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x70 | ||
49 | #define ITE_I2CFBCR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x74 | ||
50 | #define ITE_I2CFCR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x78 | ||
51 | #define ITE_I2CFSR IT8172_PCI_IO_BASE + IT_I2C_BASE + 0x7c | ||
52 | |||
53 | |||
54 | /* Host Control Register ITE_I2CHCR */ | ||
55 | #define ITE_I2CHCR_HCE 0x01 /* Enable I2C Host Controller */ | ||
56 | #define ITE_I2CHCR_IE 0x02 /* Enable the interrupt after completing | ||
57 | the current transaction */ | ||
58 | #define ITE_I2CHCR_CP_W 0x00 /* bit2-4 000 - Write */ | ||
59 | #define ITE_I2CHCR_CP_R 0x08 /* 010 - Current address read */ | ||
60 | #define ITE_I2CHCR_CP_S 0x10 /* 100 - Sequential read */ | ||
61 | #define ITE_I2CHCR_ST 0x20 /* Initiates the I2C host controller to execute | ||
62 | the command and send the data programmed in | ||
63 | all required registers to I2C bus */ | ||
64 | #define ITE_CMD ITE_I2CHCR_HCE | ITE_I2CHCR_IE | ITE_I2CHCR_ST | ||
65 | #define ITE_WRITE ITE_CMD | ITE_I2CHCR_CP_W | ||
66 | #define ITE_READ ITE_CMD | ITE_I2CHCR_CP_R | ||
67 | #define ITE_SREAD ITE_CMD | ITE_I2CHCR_CP_S | ||
68 | |||
69 | /* Host Status Register ITE_I2CHSR */ | ||
70 | #define ITE_I2CHSR_DB 0x01 /* Device is busy, receives NACK response except | ||
71 | in the first and last bytes */ | ||
72 | #define ITE_I2CHSR_DNE 0x02 /* Target address on I2C bus does not exist */ | ||
73 | #define ITE_I2CHSR_TDI 0x04 /* R/W Transaction on I2C bus was completed */ | ||
74 | #define ITE_I2CHSR_HB 0x08 /* Host controller is processing transactions */ | ||
75 | #define ITE_I2CHSR_FER 0x10 /* Error occurs in the FIFO */ | ||
76 | |||
77 | /* Slave Address Register ITE_I2CSAR */ | ||
78 | #define ITE_I2CSAR_SA_MASK 0xfe /* Target I2C device address */ | ||
79 | #define ITE_I2CSAR_ASO 0x0100 /* Output 1/0 to I2CAS port when the | ||
80 | next slave address is addressed */ | ||
81 | |||
82 | /* Slave Sub-address Register ITE_I2CSSAR */ | ||
83 | #define ITE_I2CSSAR_SUBA_MASK 0xff /* Target I2C device sub-address */ | ||
84 | |||
85 | /* Clock Counter Register ITE_I2CCKCNT */ | ||
86 | #define ITE_I2CCKCNT_STOP 0x00 /* stop I2C clock */ | ||
87 | #define ITE_I2CCKCNT_HPCC_MASK 0x7f /* SCL high period counter */ | ||
88 | #define ITE_I2CCKCNT_LPCC_MASK 0x7f00 /* SCL low period counter */ | ||
89 | |||
90 | /* START Hold Time Register ITE_I2CSHDR */ | ||
91 | /* value is counted based on 16 MHz internal clock */ | ||
92 | #define ITE_I2CSHDR_FM 0x0a /* START condition at fast mode */ | ||
93 | #define ITE_I2CSHDR_SM 0x47 /* START contition at standard mode */ | ||
94 | |||
95 | /* (Repeated) START Setup Time Register ITE_I2CRSUR */ | ||
96 | /* value is counted based on 16 MHz internal clock */ | ||
97 | #define ITE_I2CRSUR_FM 0x0a /* repeated START condition at fast mode */ | ||
98 | #define ITE_I2CRSUR_SM 0x50 /* repeated START condition at standard mode */ | ||
99 | |||
100 | /* STOP setup Time Register ITE_I2CPSUR */ | ||
101 | |||
102 | /* FIFO Data Register ITE_I2CFDR */ | ||
103 | #define ITE_I2CFDR_MASK 0xff | ||
104 | |||
105 | /* FIFO Byte Count Register ITE_I2CFBCR */ | ||
106 | #define ITE_I2CFBCR_MASK 0x3f | ||
107 | |||
108 | /* FIFO Control Register ITE_I2CFCR */ | ||
109 | #define ITE_I2CFCR_FLUSH 0x01 /* Flush FIFO and reset the FIFO point | ||
110 | and I2CFSR */ | ||
111 | /* FIFO Status Register ITE_I2CFSR */ | ||
112 | #define ITE_I2CFSR_FO 0x01 /* FIFO is overrun when write */ | ||
113 | #define ITE_I2CFSR_FU 0x02 /* FIFO is underrun when read */ | ||
114 | #define ITE_I2CFSR_FF 0x04 /* FIFO is full when write */ | ||
115 | #define ITE_I2CFSR_FE 0x08 /* FIFO is empty when read */ | ||
116 | |||
117 | #endif /* I2C_ITE_H */ | ||
diff --git a/drivers/i2c/algos/i2c-algo-pca.c b/drivers/i2c/algos/i2c-algo-pca.c new file mode 100644 index 000000000000..c3d912cbbbc3 --- /dev/null +++ b/drivers/i2c/algos/i2c-algo-pca.c | |||
@@ -0,0 +1,399 @@ | |||
1 | /* | ||
2 | * i2c-algo-pca.c i2c driver algorithms for PCA9564 adapters | ||
3 | * Copyright (C) 2004 Arcom Control Systems | ||
4 | * | ||
5 | * This program is free software; you can redistribute it and/or modify | ||
6 | * it under the terms of the GNU General Public License as published by | ||
7 | * the Free Software Foundation; either version 2 of the License, or | ||
8 | * (at your option) any later version. | ||
9 | * | ||
10 | * This program is distributed in the hope that it will be useful, | ||
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
13 | * GNU General Public License for more details. | ||
14 | * | ||
15 | * You should have received a copy of the GNU General Public License | ||
16 | * along with this program; if not, write to the Free Software | ||
17 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
18 | */ | ||
19 | |||
20 | #include <linux/kernel.h> | ||
21 | #include <linux/module.h> | ||
22 | #include <linux/moduleparam.h> | ||
23 | #include <linux/delay.h> | ||
24 | #include <linux/slab.h> | ||
25 | #include <linux/init.h> | ||
26 | #include <linux/errno.h> | ||
27 | #include <linux/i2c.h> | ||
28 | #include <linux/i2c-algo-pca.h> | ||
29 | #include "i2c-algo-pca.h" | ||
30 | |||
31 | #define DRIVER "i2c-algo-pca" | ||
32 | |||
33 | #define DEB1(fmt, args...) do { if (i2c_debug>=1) printk(fmt, ## args); } while(0) | ||
34 | #define DEB2(fmt, args...) do { if (i2c_debug>=2) printk(fmt, ## args); } while(0) | ||
35 | #define DEB3(fmt, args...) do { if (i2c_debug>=3) printk(fmt, ## args); } while(0) | ||
36 | |||
37 | static int i2c_debug=0; | ||
38 | |||
39 | #define pca_outw(adap, reg, val) adap->write_byte(adap, reg, val) | ||
40 | #define pca_inw(adap, reg) adap->read_byte(adap, reg) | ||
41 | |||
42 | #define pca_status(adap) pca_inw(adap, I2C_PCA_STA) | ||
43 | #define pca_clock(adap) adap->get_clock(adap) | ||
44 | #define pca_own(adap) adap->get_own(adap) | ||
45 | #define pca_set_con(adap, val) pca_outw(adap, I2C_PCA_CON, val) | ||
46 | #define pca_get_con(adap) pca_inw(adap, I2C_PCA_CON) | ||
47 | #define pca_wait(adap) adap->wait_for_interrupt(adap) | ||
48 | |||
49 | /* | ||
50 | * Generate a start condition on the i2c bus. | ||
51 | * | ||
52 | * returns after the start condition has occured | ||
53 | */ | ||
54 | static void pca_start(struct i2c_algo_pca_data *adap) | ||
55 | { | ||
56 | int sta = pca_get_con(adap); | ||
57 | DEB2("=== START\n"); | ||
58 | sta |= I2C_PCA_CON_STA; | ||
59 | sta &= ~(I2C_PCA_CON_STO|I2C_PCA_CON_SI); | ||
60 | pca_set_con(adap, sta); | ||
61 | pca_wait(adap); | ||
62 | } | ||
63 | |||
64 | /* | ||
65 | * Generate a repeated start condition on the i2c bus | ||
66 | * | ||
67 | * return after the repeated start condition has occured | ||
68 | */ | ||
69 | static void pca_repeated_start(struct i2c_algo_pca_data *adap) | ||
70 | { | ||
71 | int sta = pca_get_con(adap); | ||
72 | DEB2("=== REPEATED START\n"); | ||
73 | sta |= I2C_PCA_CON_STA; | ||
74 | sta &= ~(I2C_PCA_CON_STO|I2C_PCA_CON_SI); | ||
75 | pca_set_con(adap, sta); | ||
76 | pca_wait(adap); | ||
77 | } | ||
78 | |||
79 | /* | ||
80 | * Generate a stop condition on the i2c bus | ||
81 | * | ||
82 | * returns after the stop condition has been generated | ||
83 | * | ||
84 | * STOPs do not generate an interrupt or set the SI flag, since the | ||
85 | * part returns the the idle state (0xf8). Hence we don't need to | ||
86 | * pca_wait here. | ||
87 | */ | ||
88 | static void pca_stop(struct i2c_algo_pca_data *adap) | ||
89 | { | ||
90 | int sta = pca_get_con(adap); | ||
91 | DEB2("=== STOP\n"); | ||
92 | sta |= I2C_PCA_CON_STO; | ||
93 | sta &= ~(I2C_PCA_CON_STA|I2C_PCA_CON_SI); | ||
94 | pca_set_con(adap, sta); | ||
95 | } | ||
96 | |||
97 | /* | ||
98 | * Send the slave address and R/W bit | ||
99 | * | ||
100 | * returns after the address has been sent | ||
101 | */ | ||
102 | static void pca_address(struct i2c_algo_pca_data *adap, | ||
103 | struct i2c_msg *msg) | ||
104 | { | ||
105 | int sta = pca_get_con(adap); | ||
106 | int addr; | ||
107 | |||
108 | addr = ( (0x7f & msg->addr) << 1 ); | ||
109 | if (msg->flags & I2C_M_RD ) | ||
110 | addr |= 1; | ||
111 | DEB2("=== SLAVE ADDRESS %#04x+%c=%#04x\n", | ||
112 | msg->addr, msg->flags & I2C_M_RD ? 'R' : 'W', addr); | ||
113 | |||
114 | pca_outw(adap, I2C_PCA_DAT, addr); | ||
115 | |||
116 | sta &= ~(I2C_PCA_CON_STO|I2C_PCA_CON_STA|I2C_PCA_CON_SI); | ||
117 | pca_set_con(adap, sta); | ||
118 | |||
119 | pca_wait(adap); | ||
120 | } | ||
121 | |||
122 | /* | ||
123 | * Transmit a byte. | ||
124 | * | ||
125 | * Returns after the byte has been transmitted | ||
126 | */ | ||
127 | static void pca_tx_byte(struct i2c_algo_pca_data *adap, | ||
128 | __u8 b) | ||
129 | { | ||
130 | int sta = pca_get_con(adap); | ||
131 | DEB2("=== WRITE %#04x\n", b); | ||
132 | pca_outw(adap, I2C_PCA_DAT, b); | ||
133 | |||
134 | sta &= ~(I2C_PCA_CON_STO|I2C_PCA_CON_STA|I2C_PCA_CON_SI); | ||
135 | pca_set_con(adap, sta); | ||
136 | |||
137 | pca_wait(adap); | ||
138 | } | ||
139 | |||
140 | /* | ||
141 | * Receive a byte | ||
142 | * | ||
143 | * returns immediately. | ||
144 | */ | ||
145 | static void pca_rx_byte(struct i2c_algo_pca_data *adap, | ||
146 | __u8 *b, int ack) | ||
147 | { | ||
148 | *b = pca_inw(adap, I2C_PCA_DAT); | ||
149 | DEB2("=== READ %#04x %s\n", *b, ack ? "ACK" : "NACK"); | ||
150 | } | ||
151 | |||
152 | /* | ||
153 | * Setup ACK or NACK for next received byte and wait for it to arrive. | ||
154 | * | ||
155 | * Returns after next byte has arrived. | ||
156 | */ | ||
157 | static void pca_rx_ack(struct i2c_algo_pca_data *adap, | ||
158 | int ack) | ||
159 | { | ||
160 | int sta = pca_get_con(adap); | ||
161 | |||
162 | sta &= ~(I2C_PCA_CON_STO|I2C_PCA_CON_STA|I2C_PCA_CON_SI|I2C_PCA_CON_AA); | ||
163 | |||
164 | if ( ack ) | ||
165 | sta |= I2C_PCA_CON_AA; | ||
166 | |||
167 | pca_set_con(adap, sta); | ||
168 | pca_wait(adap); | ||
169 | } | ||
170 | |||
171 | /* | ||
172 | * Reset the i2c bus / SIO | ||
173 | */ | ||
174 | static void pca_reset(struct i2c_algo_pca_data *adap) | ||
175 | { | ||
176 | /* apparently only an external reset will do it. not a lot can be done */ | ||
177 | printk(KERN_ERR DRIVER ": Haven't figured out how to do a reset yet\n"); | ||
178 | } | ||
179 | |||
180 | static int pca_xfer(struct i2c_adapter *i2c_adap, | ||
181 | struct i2c_msg *msgs, | ||
182 | int num) | ||
183 | { | ||
184 | struct i2c_algo_pca_data *adap = i2c_adap->algo_data; | ||
185 | struct i2c_msg *msg = NULL; | ||
186 | int curmsg; | ||
187 | int numbytes = 0; | ||
188 | int state; | ||
189 | int ret; | ||
190 | |||
191 | state = pca_status(adap); | ||
192 | if ( state != 0xF8 ) { | ||
193 | dev_dbg(&i2c_adap->dev, "bus is not idle. status is %#04x\n", state ); | ||
194 | /* FIXME: what to do. Force stop ? */ | ||
195 | return -EREMOTEIO; | ||
196 | } | ||
197 | |||
198 | DEB1("{{{ XFER %d messages\n", num); | ||
199 | |||
200 | if (i2c_debug>=2) { | ||
201 | for (curmsg = 0; curmsg < num; curmsg++) { | ||
202 | int addr, i; | ||
203 | msg = &msgs[curmsg]; | ||
204 | |||
205 | addr = (0x7f & msg->addr) ; | ||
206 | |||
207 | if (msg->flags & I2C_M_RD ) | ||
208 | printk(KERN_INFO " [%02d] RD %d bytes from %#02x [%#02x, ...]\n", | ||
209 | curmsg, msg->len, addr, (addr<<1) | 1); | ||
210 | else { | ||
211 | printk(KERN_INFO " [%02d] WR %d bytes to %#02x [%#02x%s", | ||
212 | curmsg, msg->len, addr, addr<<1, | ||
213 | msg->len == 0 ? "" : ", "); | ||
214 | for(i=0; i < msg->len; i++) | ||
215 | printk("%#04x%s", msg->buf[i], i == msg->len - 1 ? "" : ", "); | ||
216 | printk("]\n"); | ||
217 | } | ||
218 | } | ||
219 | } | ||
220 | |||
221 | curmsg = 0; | ||
222 | ret = -EREMOTEIO; | ||
223 | while (curmsg < num) { | ||
224 | state = pca_status(adap); | ||
225 | |||
226 | DEB3("STATE is 0x%02x\n", state); | ||
227 | msg = &msgs[curmsg]; | ||
228 | |||
229 | switch (state) { | ||
230 | case 0xf8: /* On reset or stop the bus is idle */ | ||
231 | pca_start(adap); | ||
232 | break; | ||
233 | |||
234 | case 0x08: /* A START condition has been transmitted */ | ||
235 | case 0x10: /* A repeated start condition has been transmitted */ | ||
236 | pca_address(adap, msg); | ||
237 | break; | ||
238 | |||
239 | case 0x18: /* SLA+W has been transmitted; ACK has been received */ | ||
240 | case 0x28: /* Data byte in I2CDAT has been transmitted; ACK has been received */ | ||
241 | if (numbytes < msg->len) { | ||
242 | pca_tx_byte(adap, msg->buf[numbytes]); | ||
243 | numbytes++; | ||
244 | break; | ||
245 | } | ||
246 | curmsg++; numbytes = 0; | ||
247 | if (curmsg == num) | ||
248 | pca_stop(adap); | ||
249 | else | ||
250 | pca_repeated_start(adap); | ||
251 | break; | ||
252 | |||
253 | case 0x20: /* SLA+W has been transmitted; NOT ACK has been received */ | ||
254 | DEB2("NOT ACK received after SLA+W\n"); | ||
255 | pca_stop(adap); | ||
256 | goto out; | ||
257 | |||
258 | case 0x40: /* SLA+R has been transmitted; ACK has been received */ | ||
259 | pca_rx_ack(adap, msg->len > 1); | ||
260 | break; | ||
261 | |||
262 | case 0x50: /* Data bytes has been received; ACK has been returned */ | ||
263 | if (numbytes < msg->len) { | ||
264 | pca_rx_byte(adap, &msg->buf[numbytes], 1); | ||
265 | numbytes++; | ||
266 | pca_rx_ack(adap, numbytes < msg->len - 1); | ||
267 | break; | ||
268 | } | ||
269 | curmsg++; numbytes = 0; | ||
270 | if (curmsg == num) | ||
271 | pca_stop(adap); | ||
272 | else | ||
273 | pca_repeated_start(adap); | ||
274 | break; | ||
275 | |||
276 | case 0x48: /* SLA+R has been transmitted; NOT ACK has been received */ | ||
277 | DEB2("NOT ACK received after SLA+R\n"); | ||
278 | pca_stop(adap); | ||
279 | goto out; | ||
280 | |||
281 | case 0x30: /* Data byte in I2CDAT has been transmitted; NOT ACK has been received */ | ||
282 | DEB2("NOT ACK received after data byte\n"); | ||
283 | goto out; | ||
284 | |||
285 | case 0x38: /* Arbitration lost during SLA+W, SLA+R or data bytes */ | ||
286 | DEB2("Arbitration lost\n"); | ||
287 | goto out; | ||
288 | |||
289 | case 0x58: /* Data byte has been received; NOT ACK has been returned */ | ||
290 | if ( numbytes == msg->len - 1 ) { | ||
291 | pca_rx_byte(adap, &msg->buf[numbytes], 0); | ||
292 | curmsg++; numbytes = 0; | ||
293 | if (curmsg == num) | ||
294 | pca_stop(adap); | ||
295 | else | ||
296 | pca_repeated_start(adap); | ||
297 | } else { | ||
298 | DEB2("NOT ACK sent after data byte received. " | ||
299 | "Not final byte. numbytes %d. len %d\n", | ||
300 | numbytes, msg->len); | ||
301 | pca_stop(adap); | ||
302 | goto out; | ||
303 | } | ||
304 | break; | ||
305 | case 0x70: /* Bus error - SDA stuck low */ | ||
306 | DEB2("BUS ERROR - SDA Stuck low\n"); | ||
307 | pca_reset(adap); | ||
308 | goto out; | ||
309 | case 0x90: /* Bus error - SCL stuck low */ | ||
310 | DEB2("BUS ERROR - SCL Stuck low\n"); | ||
311 | pca_reset(adap); | ||
312 | goto out; | ||
313 | case 0x00: /* Bus error during master or slave mode due to illegal START or STOP condition */ | ||
314 | DEB2("BUS ERROR - Illegal START or STOP\n"); | ||
315 | pca_reset(adap); | ||
316 | goto out; | ||
317 | default: | ||
318 | printk(KERN_ERR DRIVER ": unhandled SIO state 0x%02x\n", state); | ||
319 | break; | ||
320 | } | ||
321 | |||
322 | } | ||
323 | |||
324 | ret = curmsg; | ||
325 | out: | ||
326 | DEB1(KERN_CRIT "}}} transfered %d/%d messages. " | ||
327 | "status is %#04x. control is %#04x\n", | ||
328 | curmsg, num, pca_status(adap), | ||
329 | pca_get_con(adap)); | ||
330 | return ret; | ||
331 | } | ||
332 | |||
333 | static u32 pca_func(struct i2c_adapter *adap) | ||
334 | { | ||
335 | return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; | ||
336 | } | ||
337 | |||
338 | static int pca_init(struct i2c_algo_pca_data *adap) | ||
339 | { | ||
340 | static int freqs[] = {330,288,217,146,88,59,44,36}; | ||
341 | int own, clock; | ||
342 | |||
343 | own = pca_own(adap); | ||
344 | clock = pca_clock(adap); | ||
345 | DEB1(KERN_INFO DRIVER ": own address is %#04x\n", own); | ||
346 | DEB1(KERN_INFO DRIVER ": clock freqeuncy is %dkHz\n", freqs[clock]); | ||
347 | |||
348 | pca_outw(adap, I2C_PCA_ADR, own << 1); | ||
349 | |||
350 | pca_set_con(adap, I2C_PCA_CON_ENSIO | clock); | ||
351 | udelay(500); /* 500 µs for oscilator to stabilise */ | ||
352 | |||
353 | return 0; | ||
354 | } | ||
355 | |||
356 | static struct i2c_algorithm pca_algo = { | ||
357 | .name = "PCA9564 algorithm", | ||
358 | .id = I2C_ALGO_PCA, | ||
359 | .master_xfer = pca_xfer, | ||
360 | .functionality = pca_func, | ||
361 | }; | ||
362 | |||
363 | /* | ||
364 | * registering functions to load algorithms at runtime | ||
365 | */ | ||
366 | int i2c_pca_add_bus(struct i2c_adapter *adap) | ||
367 | { | ||
368 | struct i2c_algo_pca_data *pca_adap = adap->algo_data; | ||
369 | int rval; | ||
370 | |||
371 | /* register new adapter to i2c module... */ | ||
372 | |||
373 | adap->id |= pca_algo.id; | ||
374 | adap->algo = &pca_algo; | ||
375 | |||
376 | adap->timeout = 100; /* default values, should */ | ||
377 | adap->retries = 3; /* be replaced by defines */ | ||
378 | |||
379 | rval = pca_init(pca_adap); | ||
380 | |||
381 | if (!rval) | ||
382 | i2c_add_adapter(adap); | ||
383 | |||
384 | return rval; | ||
385 | } | ||
386 | |||
387 | int i2c_pca_del_bus(struct i2c_adapter *adap) | ||
388 | { | ||
389 | return i2c_del_adapter(adap); | ||
390 | } | ||
391 | |||
392 | EXPORT_SYMBOL(i2c_pca_add_bus); | ||
393 | EXPORT_SYMBOL(i2c_pca_del_bus); | ||
394 | |||
395 | MODULE_AUTHOR("Ian Campbell <icampbell@arcom.com>"); | ||
396 | MODULE_DESCRIPTION("I2C-Bus PCA9564 algorithm"); | ||
397 | MODULE_LICENSE("GPL"); | ||
398 | |||
399 | module_param(i2c_debug, int, 0); | ||
diff --git a/drivers/i2c/algos/i2c-algo-pca.h b/drivers/i2c/algos/i2c-algo-pca.h new file mode 100644 index 000000000000..2fee07e05211 --- /dev/null +++ b/drivers/i2c/algos/i2c-algo-pca.h | |||
@@ -0,0 +1,26 @@ | |||
1 | #ifndef I2C_PCA9564_H | ||
2 | #define I2C_PCA9564_H 1 | ||
3 | |||
4 | #define I2C_PCA_STA 0x00 /* STATUS Read Only */ | ||
5 | #define I2C_PCA_TO 0x00 /* TIMEOUT Write Only */ | ||
6 | #define I2C_PCA_DAT 0x01 /* DATA Read/Write */ | ||
7 | #define I2C_PCA_ADR 0x02 /* OWN ADR Read/Write */ | ||
8 | #define I2C_PCA_CON 0x03 /* CONTROL Read/Write */ | ||
9 | |||
10 | #define I2C_PCA_CON_AA 0x80 /* Assert Acknowledge */ | ||
11 | #define I2C_PCA_CON_ENSIO 0x40 /* Enable */ | ||
12 | #define I2C_PCA_CON_STA 0x20 /* Start */ | ||
13 | #define I2C_PCA_CON_STO 0x10 /* Stop */ | ||
14 | #define I2C_PCA_CON_SI 0x08 /* Serial Interrupt */ | ||
15 | #define I2C_PCA_CON_CR 0x07 /* Clock Rate (MASK) */ | ||
16 | |||
17 | #define I2C_PCA_CON_330kHz 0x00 | ||
18 | #define I2C_PCA_CON_288kHz 0x01 | ||
19 | #define I2C_PCA_CON_217kHz 0x02 | ||
20 | #define I2C_PCA_CON_146kHz 0x03 | ||
21 | #define I2C_PCA_CON_88kHz 0x04 | ||
22 | #define I2C_PCA_CON_59kHz 0x05 | ||
23 | #define I2C_PCA_CON_44kHz 0x06 | ||
24 | #define I2C_PCA_CON_36kHz 0x07 | ||
25 | |||
26 | #endif /* I2C_PCA9564_H */ | ||
diff --git a/drivers/i2c/algos/i2c-algo-pcf.c b/drivers/i2c/algos/i2c-algo-pcf.c new file mode 100644 index 000000000000..8d087dac32af --- /dev/null +++ b/drivers/i2c/algos/i2c-algo-pcf.c | |||
@@ -0,0 +1,507 @@ | |||
1 | /* ------------------------------------------------------------------------- */ | ||
2 | /* i2c-algo-pcf.c i2c driver algorithms for PCF8584 adapters */ | ||
3 | /* ------------------------------------------------------------------------- */ | ||
4 | /* Copyright (C) 1995-1997 Simon G. Vogl | ||
5 | 1998-2000 Hans Berglund | ||
6 | |||
7 | This program is free software; you can redistribute it and/or modify | ||
8 | it under the terms of the GNU General Public License as published by | ||
9 | the Free Software Foundation; either version 2 of the License, or | ||
10 | (at your option) any later version. | ||
11 | |||
12 | This program is distributed in the hope that it will be useful, | ||
13 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
15 | GNU General Public License for more details. | ||
16 | |||
17 | You should have received a copy of the GNU General Public License | ||
18 | along with this program; if not, write to the Free Software | ||
19 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ | ||
20 | /* ------------------------------------------------------------------------- */ | ||
21 | |||
22 | /* With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi> and | ||
23 | Frodo Looijaard <frodol@dds.nl> ,and also from Martin Bailey | ||
24 | <mbailey@littlefeet-inc.com> */ | ||
25 | |||
26 | /* Partially rewriten by Oleg I. Vdovikin <vdovikin@jscc.ru> to handle multiple | ||
27 | messages, proper stop/repstart signaling during receive, | ||
28 | added detect code */ | ||
29 | |||
30 | #include <linux/kernel.h> | ||
31 | #include <linux/module.h> | ||
32 | #include <linux/delay.h> | ||
33 | #include <linux/slab.h> | ||
34 | #include <linux/init.h> | ||
35 | #include <linux/errno.h> | ||
36 | #include <linux/i2c.h> | ||
37 | #include <linux/i2c-algo-pcf.h> | ||
38 | #include "i2c-algo-pcf.h" | ||
39 | |||
40 | |||
41 | #define DEB2(x) if (i2c_debug>=2) x | ||
42 | #define DEB3(x) if (i2c_debug>=3) x /* print several statistical values*/ | ||
43 | #define DEBPROTO(x) if (i2c_debug>=9) x; | ||
44 | /* debug the protocol by showing transferred bits */ | ||
45 | #define DEF_TIMEOUT 16 | ||
46 | |||
47 | /* module parameters: | ||
48 | */ | ||
49 | static int i2c_debug; | ||
50 | |||
51 | /* --- setting states on the bus with the right timing: --------------- */ | ||
52 | |||
53 | #define set_pcf(adap, ctl, val) adap->setpcf(adap->data, ctl, val) | ||
54 | #define get_pcf(adap, ctl) adap->getpcf(adap->data, ctl) | ||
55 | #define get_own(adap) adap->getown(adap->data) | ||
56 | #define get_clock(adap) adap->getclock(adap->data) | ||
57 | #define i2c_outb(adap, val) adap->setpcf(adap->data, 0, val) | ||
58 | #define i2c_inb(adap) adap->getpcf(adap->data, 0) | ||
59 | |||
60 | /* --- other auxiliary functions -------------------------------------- */ | ||
61 | |||
62 | static void i2c_start(struct i2c_algo_pcf_data *adap) | ||
63 | { | ||
64 | DEBPROTO(printk("S ")); | ||
65 | set_pcf(adap, 1, I2C_PCF_START); | ||
66 | } | ||
67 | |||
68 | static void i2c_repstart(struct i2c_algo_pcf_data *adap) | ||
69 | { | ||
70 | DEBPROTO(printk(" Sr ")); | ||
71 | set_pcf(adap, 1, I2C_PCF_REPSTART); | ||
72 | } | ||
73 | |||
74 | |||
75 | static void i2c_stop(struct i2c_algo_pcf_data *adap) | ||
76 | { | ||
77 | DEBPROTO(printk("P\n")); | ||
78 | set_pcf(adap, 1, I2C_PCF_STOP); | ||
79 | } | ||
80 | |||
81 | static int wait_for_bb(struct i2c_algo_pcf_data *adap) { | ||
82 | |||
83 | int timeout = DEF_TIMEOUT; | ||
84 | int status; | ||
85 | |||
86 | status = get_pcf(adap, 1); | ||
87 | #ifndef STUB_I2C | ||
88 | while (timeout-- && !(status & I2C_PCF_BB)) { | ||
89 | udelay(100); /* wait for 100 us */ | ||
90 | status = get_pcf(adap, 1); | ||
91 | } | ||
92 | #endif | ||
93 | if (timeout <= 0) { | ||
94 | printk(KERN_ERR "Timeout waiting for Bus Busy\n"); | ||
95 | } | ||
96 | |||
97 | return (timeout<=0); | ||
98 | } | ||
99 | |||
100 | |||
101 | static int wait_for_pin(struct i2c_algo_pcf_data *adap, int *status) { | ||
102 | |||
103 | int timeout = DEF_TIMEOUT; | ||
104 | |||
105 | *status = get_pcf(adap, 1); | ||
106 | #ifndef STUB_I2C | ||
107 | while (timeout-- && (*status & I2C_PCF_PIN)) { | ||
108 | adap->waitforpin(); | ||
109 | *status = get_pcf(adap, 1); | ||
110 | } | ||
111 | if (*status & I2C_PCF_LAB) { | ||
112 | DEB2(printk(KERN_INFO | ||
113 | "i2c-algo-pcf.o: lost arbitration (CSR 0x%02x)\n", | ||
114 | *status)); | ||
115 | /* Cleanup from LAB-- reset and enable ESO. | ||
116 | * This resets the PCF8584; since we've lost the bus, no | ||
117 | * further attempts should be made by callers to clean up | ||
118 | * (no i2c_stop() etc.) | ||
119 | */ | ||
120 | set_pcf(adap, 1, I2C_PCF_PIN); | ||
121 | set_pcf(adap, 1, I2C_PCF_ESO); | ||
122 | /* TODO: we should pause for a time period sufficient for any | ||
123 | * running I2C transaction to complete-- the arbitration | ||
124 | * logic won't work properly until the next START is seen. | ||
125 | */ | ||
126 | DEB2(printk(KERN_INFO | ||
127 | "i2c-algo-pcf.o: reset LAB condition (CSR 0x%02x)\n", | ||
128 | get_pcf(adap,1))); | ||
129 | return(-EINTR); | ||
130 | } | ||
131 | #endif | ||
132 | if (timeout <= 0) | ||
133 | return(-1); | ||
134 | else | ||
135 | return(0); | ||
136 | } | ||
137 | |||
138 | /* | ||
139 | * This should perform the 'PCF8584 initialization sequence' as described | ||
140 | * in the Philips IC12 data book (1995, Aug 29). | ||
141 | * There should be a 30 clock cycle wait after reset, I assume this | ||
142 | * has been fulfilled. | ||
143 | * There should be a delay at the end equal to the longest I2C message | ||
144 | * to synchronize the BB-bit (in multimaster systems). How long is | ||
145 | * this? I assume 1 second is always long enough. | ||
146 | * | ||
147 | * vdovikin: added detect code for PCF8584 | ||
148 | */ | ||
149 | static int pcf_init_8584 (struct i2c_algo_pcf_data *adap) | ||
150 | { | ||
151 | unsigned char temp; | ||
152 | |||
153 | DEB3(printk(KERN_DEBUG "i2c-algo-pcf.o: PCF state 0x%02x\n", get_pcf(adap, 1))); | ||
154 | |||
155 | /* S1=0x80: S0 selected, serial interface off */ | ||
156 | set_pcf(adap, 1, I2C_PCF_PIN); | ||
157 | /* check to see S1 now used as R/W ctrl - | ||
158 | PCF8584 does that when ESO is zero */ | ||
159 | if (((temp = get_pcf(adap, 1)) & 0x7f) != (0)) { | ||
160 | DEB2(printk(KERN_ERR "i2c-algo-pcf.o: PCF detection failed -- can't select S0 (0x%02x).\n", temp)); | ||
161 | return -ENXIO; /* definetly not PCF8584 */ | ||
162 | } | ||
163 | |||
164 | /* load own address in S0, effective address is (own << 1) */ | ||
165 | i2c_outb(adap, get_own(adap)); | ||
166 | /* check it's really written */ | ||
167 | if ((temp = i2c_inb(adap)) != get_own(adap)) { | ||
168 | DEB2(printk(KERN_ERR "i2c-algo-pcf.o: PCF detection failed -- can't set S0 (0x%02x).\n", temp)); | ||
169 | return -ENXIO; | ||
170 | } | ||
171 | |||
172 | /* S1=0xA0, next byte in S2 */ | ||
173 | set_pcf(adap, 1, I2C_PCF_PIN | I2C_PCF_ES1); | ||
174 | /* check to see S2 now selected */ | ||
175 | if (((temp = get_pcf(adap, 1)) & 0x7f) != I2C_PCF_ES1) { | ||
176 | DEB2(printk(KERN_ERR "i2c-algo-pcf.o: PCF detection failed -- can't select S2 (0x%02x).\n", temp)); | ||
177 | return -ENXIO; | ||
178 | } | ||
179 | |||
180 | /* load clock register S2 */ | ||
181 | i2c_outb(adap, get_clock(adap)); | ||
182 | /* check it's really written, the only 5 lowest bits does matter */ | ||
183 | if (((temp = i2c_inb(adap)) & 0x1f) != get_clock(adap)) { | ||
184 | DEB2(printk(KERN_ERR "i2c-algo-pcf.o: PCF detection failed -- can't set S2 (0x%02x).\n", temp)); | ||
185 | return -ENXIO; | ||
186 | } | ||
187 | |||
188 | /* Enable serial interface, idle, S0 selected */ | ||
189 | set_pcf(adap, 1, I2C_PCF_IDLE); | ||
190 | |||
191 | /* check to see PCF is really idled and we can access status register */ | ||
192 | if ((temp = get_pcf(adap, 1)) != (I2C_PCF_PIN | I2C_PCF_BB)) { | ||
193 | DEB2(printk(KERN_ERR "i2c-algo-pcf.o: PCF detection failed -- can't select S1` (0x%02x).\n", temp)); | ||
194 | return -ENXIO; | ||
195 | } | ||
196 | |||
197 | printk(KERN_DEBUG "i2c-algo-pcf.o: deteted and initialized PCF8584.\n"); | ||
198 | |||
199 | return 0; | ||
200 | } | ||
201 | |||
202 | |||
203 | /* ----- Utility functions | ||
204 | */ | ||
205 | |||
206 | static inline int try_address(struct i2c_algo_pcf_data *adap, | ||
207 | unsigned char addr, int retries) | ||
208 | { | ||
209 | int i, status, ret = -1; | ||
210 | int wfp; | ||
211 | for (i=0;i<retries;i++) { | ||
212 | i2c_outb(adap, addr); | ||
213 | i2c_start(adap); | ||
214 | status = get_pcf(adap, 1); | ||
215 | if ((wfp = wait_for_pin(adap, &status)) >= 0) { | ||
216 | if ((status & I2C_PCF_LRB) == 0) { | ||
217 | i2c_stop(adap); | ||
218 | break; /* success! */ | ||
219 | } | ||
220 | } | ||
221 | if (wfp == -EINTR) { | ||
222 | /* arbitration lost */ | ||
223 | udelay(adap->udelay); | ||
224 | return -EINTR; | ||
225 | } | ||
226 | i2c_stop(adap); | ||
227 | udelay(adap->udelay); | ||
228 | } | ||
229 | DEB2(if (i) printk(KERN_DEBUG "i2c-algo-pcf.o: needed %d retries for %d\n",i, | ||
230 | addr)); | ||
231 | return ret; | ||
232 | } | ||
233 | |||
234 | |||
235 | static int pcf_sendbytes(struct i2c_adapter *i2c_adap, const char *buf, | ||
236 | int count, int last) | ||
237 | { | ||
238 | struct i2c_algo_pcf_data *adap = i2c_adap->algo_data; | ||
239 | int wrcount, status, timeout; | ||
240 | |||
241 | for (wrcount=0; wrcount<count; ++wrcount) { | ||
242 | DEB2(dev_dbg(&i2c_adap->dev, "i2c_write: writing %2.2X\n", | ||
243 | buf[wrcount]&0xff)); | ||
244 | i2c_outb(adap, buf[wrcount]); | ||
245 | timeout = wait_for_pin(adap, &status); | ||
246 | if (timeout) { | ||
247 | if (timeout == -EINTR) { | ||
248 | /* arbitration lost */ | ||
249 | return -EINTR; | ||
250 | } | ||
251 | i2c_stop(adap); | ||
252 | dev_err(&i2c_adap->dev, "i2c_write: error - timeout.\n"); | ||
253 | return -EREMOTEIO; /* got a better one ?? */ | ||
254 | } | ||
255 | #ifndef STUB_I2C | ||
256 | if (status & I2C_PCF_LRB) { | ||
257 | i2c_stop(adap); | ||
258 | dev_err(&i2c_adap->dev, "i2c_write: error - no ack.\n"); | ||
259 | return -EREMOTEIO; /* got a better one ?? */ | ||
260 | } | ||
261 | #endif | ||
262 | } | ||
263 | if (last) { | ||
264 | i2c_stop(adap); | ||
265 | } | ||
266 | else { | ||
267 | i2c_repstart(adap); | ||
268 | } | ||
269 | |||
270 | return (wrcount); | ||
271 | } | ||
272 | |||
273 | |||
274 | static int pcf_readbytes(struct i2c_adapter *i2c_adap, char *buf, | ||
275 | int count, int last) | ||
276 | { | ||
277 | int i, status; | ||
278 | struct i2c_algo_pcf_data *adap = i2c_adap->algo_data; | ||
279 | int wfp; | ||
280 | |||
281 | /* increment number of bytes to read by one -- read dummy byte */ | ||
282 | for (i = 0; i <= count; i++) { | ||
283 | |||
284 | if ((wfp = wait_for_pin(adap, &status))) { | ||
285 | if (wfp == -EINTR) { | ||
286 | /* arbitration lost */ | ||
287 | return -EINTR; | ||
288 | } | ||
289 | i2c_stop(adap); | ||
290 | dev_err(&i2c_adap->dev, "pcf_readbytes timed out.\n"); | ||
291 | return (-1); | ||
292 | } | ||
293 | |||
294 | #ifndef STUB_I2C | ||
295 | if ((status & I2C_PCF_LRB) && (i != count)) { | ||
296 | i2c_stop(adap); | ||
297 | dev_err(&i2c_adap->dev, "i2c_read: i2c_inb, No ack.\n"); | ||
298 | return (-1); | ||
299 | } | ||
300 | #endif | ||
301 | |||
302 | if (i == count - 1) { | ||
303 | set_pcf(adap, 1, I2C_PCF_ESO); | ||
304 | } else | ||
305 | if (i == count) { | ||
306 | if (last) { | ||
307 | i2c_stop(adap); | ||
308 | } else { | ||
309 | i2c_repstart(adap); | ||
310 | } | ||
311 | }; | ||
312 | |||
313 | if (i) { | ||
314 | buf[i - 1] = i2c_inb(adap); | ||
315 | } else { | ||
316 | i2c_inb(adap); /* dummy read */ | ||
317 | } | ||
318 | } | ||
319 | |||
320 | return (i - 1); | ||
321 | } | ||
322 | |||
323 | |||
324 | static inline int pcf_doAddress(struct i2c_algo_pcf_data *adap, | ||
325 | struct i2c_msg *msg, int retries) | ||
326 | { | ||
327 | unsigned short flags = msg->flags; | ||
328 | unsigned char addr; | ||
329 | int ret; | ||
330 | if ( (flags & I2C_M_TEN) ) { | ||
331 | /* a ten bit address */ | ||
332 | addr = 0xf0 | (( msg->addr >> 7) & 0x03); | ||
333 | DEB2(printk(KERN_DEBUG "addr0: %d\n",addr)); | ||
334 | /* try extended address code...*/ | ||
335 | ret = try_address(adap, addr, retries); | ||
336 | if (ret!=1) { | ||
337 | printk(KERN_ERR "died at extended address code.\n"); | ||
338 | return -EREMOTEIO; | ||
339 | } | ||
340 | /* the remaining 8 bit address */ | ||
341 | i2c_outb(adap,msg->addr & 0x7f); | ||
342 | /* Status check comes here */ | ||
343 | if (ret != 1) { | ||
344 | printk(KERN_ERR "died at 2nd address code.\n"); | ||
345 | return -EREMOTEIO; | ||
346 | } | ||
347 | if ( flags & I2C_M_RD ) { | ||
348 | i2c_repstart(adap); | ||
349 | /* okay, now switch into reading mode */ | ||
350 | addr |= 0x01; | ||
351 | ret = try_address(adap, addr, retries); | ||
352 | if (ret!=1) { | ||
353 | printk(KERN_ERR "died at extended address code.\n"); | ||
354 | return -EREMOTEIO; | ||
355 | } | ||
356 | } | ||
357 | } else { /* normal 7bit address */ | ||
358 | addr = ( msg->addr << 1 ); | ||
359 | if (flags & I2C_M_RD ) | ||
360 | addr |= 1; | ||
361 | if (flags & I2C_M_REV_DIR_ADDR ) | ||
362 | addr ^= 1; | ||
363 | i2c_outb(adap, addr); | ||
364 | } | ||
365 | return 0; | ||
366 | } | ||
367 | |||
368 | static int pcf_xfer(struct i2c_adapter *i2c_adap, | ||
369 | struct i2c_msg *msgs, | ||
370 | int num) | ||
371 | { | ||
372 | struct i2c_algo_pcf_data *adap = i2c_adap->algo_data; | ||
373 | struct i2c_msg *pmsg; | ||
374 | int i; | ||
375 | int ret=0, timeout, status; | ||
376 | |||
377 | |||
378 | /* Check for bus busy */ | ||
379 | timeout = wait_for_bb(adap); | ||
380 | if (timeout) { | ||
381 | DEB2(printk(KERN_ERR "i2c-algo-pcf.o: " | ||
382 | "Timeout waiting for BB in pcf_xfer\n");) | ||
383 | return -EIO; | ||
384 | } | ||
385 | |||
386 | for (i = 0;ret >= 0 && i < num; i++) { | ||
387 | pmsg = &msgs[i]; | ||
388 | |||
389 | DEB2(printk(KERN_DEBUG "i2c-algo-pcf.o: Doing %s %d bytes to 0x%02x - %d of %d messages\n", | ||
390 | pmsg->flags & I2C_M_RD ? "read" : "write", | ||
391 | pmsg->len, pmsg->addr, i + 1, num);) | ||
392 | |||
393 | ret = pcf_doAddress(adap, pmsg, i2c_adap->retries); | ||
394 | |||
395 | /* Send START */ | ||
396 | if (i == 0) { | ||
397 | i2c_start(adap); | ||
398 | } | ||
399 | |||
400 | /* Wait for PIN (pending interrupt NOT) */ | ||
401 | timeout = wait_for_pin(adap, &status); | ||
402 | if (timeout) { | ||
403 | if (timeout == -EINTR) { | ||
404 | /* arbitration lost */ | ||
405 | return (-EINTR); | ||
406 | } | ||
407 | i2c_stop(adap); | ||
408 | DEB2(printk(KERN_ERR "i2c-algo-pcf.o: Timeout waiting " | ||
409 | "for PIN(1) in pcf_xfer\n");) | ||
410 | return (-EREMOTEIO); | ||
411 | } | ||
412 | |||
413 | #ifndef STUB_I2C | ||
414 | /* Check LRB (last rcvd bit - slave ack) */ | ||
415 | if (status & I2C_PCF_LRB) { | ||
416 | i2c_stop(adap); | ||
417 | DEB2(printk(KERN_ERR "i2c-algo-pcf.o: No LRB(1) in pcf_xfer\n");) | ||
418 | return (-EREMOTEIO); | ||
419 | } | ||
420 | #endif | ||
421 | |||
422 | DEB3(printk(KERN_DEBUG "i2c-algo-pcf.o: Msg %d, addr=0x%x, flags=0x%x, len=%d\n", | ||
423 | i, msgs[i].addr, msgs[i].flags, msgs[i].len);) | ||
424 | |||
425 | /* Read */ | ||
426 | if (pmsg->flags & I2C_M_RD) { | ||
427 | /* read bytes into buffer*/ | ||
428 | ret = pcf_readbytes(i2c_adap, pmsg->buf, pmsg->len, | ||
429 | (i + 1 == num)); | ||
430 | |||
431 | if (ret != pmsg->len) { | ||
432 | DEB2(printk(KERN_DEBUG "i2c-algo-pcf.o: fail: " | ||
433 | "only read %d bytes.\n",ret)); | ||
434 | } else { | ||
435 | DEB2(printk(KERN_DEBUG "i2c-algo-pcf.o: read %d bytes.\n",ret)); | ||
436 | } | ||
437 | } else { /* Write */ | ||
438 | ret = pcf_sendbytes(i2c_adap, pmsg->buf, pmsg->len, | ||
439 | (i + 1 == num)); | ||
440 | |||
441 | if (ret != pmsg->len) { | ||
442 | DEB2(printk(KERN_DEBUG "i2c-algo-pcf.o: fail: " | ||
443 | "only wrote %d bytes.\n",ret)); | ||
444 | } else { | ||
445 | DEB2(printk(KERN_DEBUG "i2c-algo-pcf.o: wrote %d bytes.\n",ret)); | ||
446 | } | ||
447 | } | ||
448 | } | ||
449 | |||
450 | return (i); | ||
451 | } | ||
452 | |||
453 | static u32 pcf_func(struct i2c_adapter *adap) | ||
454 | { | ||
455 | return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL | | ||
456 | I2C_FUNC_10BIT_ADDR | I2C_FUNC_PROTOCOL_MANGLING; | ||
457 | } | ||
458 | |||
459 | /* -----exported algorithm data: ------------------------------------- */ | ||
460 | |||
461 | static struct i2c_algorithm pcf_algo = { | ||
462 | .name = "PCF8584 algorithm", | ||
463 | .id = I2C_ALGO_PCF, | ||
464 | .master_xfer = pcf_xfer, | ||
465 | .functionality = pcf_func, | ||
466 | }; | ||
467 | |||
468 | /* | ||
469 | * registering functions to load algorithms at runtime | ||
470 | */ | ||
471 | int i2c_pcf_add_bus(struct i2c_adapter *adap) | ||
472 | { | ||
473 | struct i2c_algo_pcf_data *pcf_adap = adap->algo_data; | ||
474 | int rval; | ||
475 | |||
476 | DEB2(dev_dbg(&adap->dev, "hw routines registered.\n")); | ||
477 | |||
478 | /* register new adapter to i2c module... */ | ||
479 | |||
480 | adap->id |= pcf_algo.id; | ||
481 | adap->algo = &pcf_algo; | ||
482 | |||
483 | adap->timeout = 100; /* default values, should */ | ||
484 | adap->retries = 3; /* be replaced by defines */ | ||
485 | |||
486 | rval = pcf_init_8584(pcf_adap); | ||
487 | if (!rval) | ||
488 | i2c_add_adapter(adap); | ||
489 | return rval; | ||
490 | } | ||
491 | |||
492 | |||
493 | int i2c_pcf_del_bus(struct i2c_adapter *adap) | ||
494 | { | ||
495 | return i2c_del_adapter(adap); | ||
496 | } | ||
497 | |||
498 | EXPORT_SYMBOL(i2c_pcf_add_bus); | ||
499 | EXPORT_SYMBOL(i2c_pcf_del_bus); | ||
500 | |||
501 | MODULE_AUTHOR("Hans Berglund <hb@spacetec.no>"); | ||
502 | MODULE_DESCRIPTION("I2C-Bus PCF8584 algorithm"); | ||
503 | MODULE_LICENSE("GPL"); | ||
504 | |||
505 | module_param(i2c_debug, int, S_IRUGO | S_IWUSR); | ||
506 | MODULE_PARM_DESC(i2c_debug, | ||
507 | "debug level - 0 off; 1 normal; 2,3 more verbose; 9 pcf-protocol"); | ||
diff --git a/drivers/i2c/algos/i2c-algo-pcf.h b/drivers/i2c/algos/i2c-algo-pcf.h new file mode 100644 index 000000000000..5263a9eeb8d7 --- /dev/null +++ b/drivers/i2c/algos/i2c-algo-pcf.h | |||
@@ -0,0 +1,76 @@ | |||
1 | /* -------------------------------------------------------------------- */ | ||
2 | /* i2c-pcf8584.h: PCF 8584 global defines */ | ||
3 | /* -------------------------------------------------------------------- */ | ||
4 | /* Copyright (C) 1996 Simon G. Vogl | ||
5 | 1999 Hans Berglund | ||
6 | |||
7 | This program is free software; you can redistribute it and/or modify | ||
8 | it under the terms of the GNU General Public License as published by | ||
9 | the Free Software Foundation; either version 2 of the License, or | ||
10 | (at your option) any later version. | ||
11 | |||
12 | This program is distributed in the hope that it will be useful, | ||
13 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
15 | GNU General Public License for more details. | ||
16 | |||
17 | You should have received a copy of the GNU General Public License | ||
18 | along with this program; if not, write to the Free Software | ||
19 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ | ||
20 | /* -------------------------------------------------------------------- */ | ||
21 | |||
22 | /* With some changes from Frodo Looijaard <frodol@dds.nl> */ | ||
23 | |||
24 | #ifndef I2C_PCF8584_H | ||
25 | #define I2C_PCF8584_H 1 | ||
26 | |||
27 | /* ----- Control register bits ---------------------------------------- */ | ||
28 | #define I2C_PCF_PIN 0x80 | ||
29 | #define I2C_PCF_ESO 0x40 | ||
30 | #define I2C_PCF_ES1 0x20 | ||
31 | #define I2C_PCF_ES2 0x10 | ||
32 | #define I2C_PCF_ENI 0x08 | ||
33 | #define I2C_PCF_STA 0x04 | ||
34 | #define I2C_PCF_STO 0x02 | ||
35 | #define I2C_PCF_ACK 0x01 | ||
36 | |||
37 | #define I2C_PCF_START (I2C_PCF_PIN | I2C_PCF_ESO | I2C_PCF_STA | I2C_PCF_ACK) | ||
38 | #define I2C_PCF_STOP (I2C_PCF_PIN | I2C_PCF_ESO | I2C_PCF_STO | I2C_PCF_ACK) | ||
39 | #define I2C_PCF_REPSTART ( I2C_PCF_ESO | I2C_PCF_STA | I2C_PCF_ACK) | ||
40 | #define I2C_PCF_IDLE (I2C_PCF_PIN | I2C_PCF_ESO | I2C_PCF_ACK) | ||
41 | |||
42 | /* ----- Status register bits ----------------------------------------- */ | ||
43 | /*#define I2C_PCF_PIN 0x80 as above*/ | ||
44 | |||
45 | #define I2C_PCF_INI 0x40 /* 1 if not initialized */ | ||
46 | #define I2C_PCF_STS 0x20 | ||
47 | #define I2C_PCF_BER 0x10 | ||
48 | #define I2C_PCF_AD0 0x08 | ||
49 | #define I2C_PCF_LRB 0x08 | ||
50 | #define I2C_PCF_AAS 0x04 | ||
51 | #define I2C_PCF_LAB 0x02 | ||
52 | #define I2C_PCF_BB 0x01 | ||
53 | |||
54 | /* ----- Chip clock frequencies --------------------------------------- */ | ||
55 | #define I2C_PCF_CLK3 0x00 | ||
56 | #define I2C_PCF_CLK443 0x10 | ||
57 | #define I2C_PCF_CLK6 0x14 | ||
58 | #define I2C_PCF_CLK 0x18 | ||
59 | #define I2C_PCF_CLK12 0x1c | ||
60 | |||
61 | /* ----- transmission frequencies ------------------------------------- */ | ||
62 | #define I2C_PCF_TRNS90 0x00 /* 90 kHz */ | ||
63 | #define I2C_PCF_TRNS45 0x01 /* 45 kHz */ | ||
64 | #define I2C_PCF_TRNS11 0x02 /* 11 kHz */ | ||
65 | #define I2C_PCF_TRNS15 0x03 /* 1.5 kHz */ | ||
66 | |||
67 | |||
68 | /* ----- Access to internal registers according to ES1,ES2 ------------ */ | ||
69 | /* they are mapped to the data port ( a0 = 0 ) */ | ||
70 | /* available when ESO == 0 : */ | ||
71 | |||
72 | #define I2C_PCF_OWNADR 0 | ||
73 | #define I2C_PCF_INTREG I2C_PCF_ES2 | ||
74 | #define I2C_PCF_CLKREG I2C_PCF_ES1 | ||
75 | |||
76 | #endif /* I2C_PCF8584_H */ | ||
diff --git a/drivers/i2c/algos/i2c-algo-sgi.c b/drivers/i2c/algos/i2c-algo-sgi.c new file mode 100644 index 000000000000..422721b241e5 --- /dev/null +++ b/drivers/i2c/algos/i2c-algo-sgi.c | |||
@@ -0,0 +1,189 @@ | |||
1 | /* | ||
2 | * i2c-algo-sgi.c: i2c driver algorithms for SGI adapters. | ||
3 | * | ||
4 | * This file is subject to the terms and conditions of the GNU General Public | ||
5 | * License version 2 as published by the Free Software Foundation. | ||
6 | * | ||
7 | * Copyright (C) 2003 Ladislav Michl <ladis@linux-mips.org> | ||
8 | */ | ||
9 | |||
10 | #include <linux/kernel.h> | ||
11 | #include <linux/module.h> | ||
12 | #include <linux/init.h> | ||
13 | #include <linux/errno.h> | ||
14 | #include <linux/delay.h> | ||
15 | |||
16 | #include <linux/i2c.h> | ||
17 | #include <linux/i2c-algo-sgi.h> | ||
18 | |||
19 | |||
20 | #define SGI_I2C_FORCE_IDLE (0 << 0) | ||
21 | #define SGI_I2C_NOT_IDLE (1 << 0) | ||
22 | #define SGI_I2C_WRITE (0 << 1) | ||
23 | #define SGI_I2C_READ (1 << 1) | ||
24 | #define SGI_I2C_RELEASE_BUS (0 << 2) | ||
25 | #define SGI_I2C_HOLD_BUS (1 << 2) | ||
26 | #define SGI_I2C_XFER_DONE (0 << 4) | ||
27 | #define SGI_I2C_XFER_BUSY (1 << 4) | ||
28 | #define SGI_I2C_ACK (0 << 5) | ||
29 | #define SGI_I2C_NACK (1 << 5) | ||
30 | #define SGI_I2C_BUS_OK (0 << 7) | ||
31 | #define SGI_I2C_BUS_ERR (1 << 7) | ||
32 | |||
33 | #define get_control() adap->getctrl(adap->data) | ||
34 | #define set_control(val) adap->setctrl(adap->data, val) | ||
35 | #define read_data() adap->rdata(adap->data) | ||
36 | #define write_data(val) adap->wdata(adap->data, val) | ||
37 | |||
38 | |||
39 | static int wait_xfer_done(struct i2c_algo_sgi_data *adap) | ||
40 | { | ||
41 | int i; | ||
42 | |||
43 | for (i = 0; i < adap->xfer_timeout; i++) { | ||
44 | if ((get_control() & SGI_I2C_XFER_BUSY) == 0) | ||
45 | return 0; | ||
46 | udelay(1); | ||
47 | } | ||
48 | |||
49 | return -ETIMEDOUT; | ||
50 | } | ||
51 | |||
52 | static int wait_ack(struct i2c_algo_sgi_data *adap) | ||
53 | { | ||
54 | int i; | ||
55 | |||
56 | if (wait_xfer_done(adap)) | ||
57 | return -ETIMEDOUT; | ||
58 | for (i = 0; i < adap->ack_timeout; i++) { | ||
59 | if ((get_control() & SGI_I2C_NACK) == 0) | ||
60 | return 0; | ||
61 | udelay(1); | ||
62 | } | ||
63 | |||
64 | return -ETIMEDOUT; | ||
65 | } | ||
66 | |||
67 | static int force_idle(struct i2c_algo_sgi_data *adap) | ||
68 | { | ||
69 | int i; | ||
70 | |||
71 | set_control(SGI_I2C_FORCE_IDLE); | ||
72 | for (i = 0; i < adap->xfer_timeout; i++) { | ||
73 | if ((get_control() & SGI_I2C_NOT_IDLE) == 0) | ||
74 | goto out; | ||
75 | udelay(1); | ||
76 | } | ||
77 | return -ETIMEDOUT; | ||
78 | out: | ||
79 | if (get_control() & SGI_I2C_BUS_ERR) | ||
80 | return -EIO; | ||
81 | return 0; | ||
82 | } | ||
83 | |||
84 | static int do_address(struct i2c_algo_sgi_data *adap, unsigned int addr, | ||
85 | int rd) | ||
86 | { | ||
87 | if (rd) | ||
88 | set_control(SGI_I2C_NOT_IDLE); | ||
89 | /* Check if bus is idle, eventually force it to do so */ | ||
90 | if (get_control() & SGI_I2C_NOT_IDLE) | ||
91 | if (force_idle(adap)) | ||
92 | return -EIO; | ||
93 | /* Write out the i2c chip address and specify operation */ | ||
94 | set_control(SGI_I2C_HOLD_BUS | SGI_I2C_WRITE | SGI_I2C_NOT_IDLE); | ||
95 | if (rd) | ||
96 | addr |= 1; | ||
97 | write_data(addr); | ||
98 | if (wait_ack(adap)) | ||
99 | return -EIO; | ||
100 | return 0; | ||
101 | } | ||
102 | |||
103 | static int i2c_read(struct i2c_algo_sgi_data *adap, unsigned char *buf, | ||
104 | unsigned int len) | ||
105 | { | ||
106 | int i; | ||
107 | |||
108 | set_control(SGI_I2C_HOLD_BUS | SGI_I2C_READ | SGI_I2C_NOT_IDLE); | ||
109 | for (i = 0; i < len; i++) { | ||
110 | if (wait_xfer_done(adap)) | ||
111 | return -EIO; | ||
112 | buf[i] = read_data(); | ||
113 | } | ||
114 | set_control(SGI_I2C_RELEASE_BUS | SGI_I2C_FORCE_IDLE); | ||
115 | |||
116 | return 0; | ||
117 | |||
118 | } | ||
119 | |||
120 | static int i2c_write(struct i2c_algo_sgi_data *adap, unsigned char *buf, | ||
121 | unsigned int len) | ||
122 | { | ||
123 | int i; | ||
124 | |||
125 | /* We are already in write state */ | ||
126 | for (i = 0; i < len; i++) { | ||
127 | write_data(buf[i]); | ||
128 | if (wait_ack(adap)) | ||
129 | return -EIO; | ||
130 | } | ||
131 | return 0; | ||
132 | } | ||
133 | |||
134 | static int sgi_xfer(struct i2c_adapter *i2c_adap, struct i2c_msg *msgs, | ||
135 | int num) | ||
136 | { | ||
137 | struct i2c_algo_sgi_data *adap = i2c_adap->algo_data; | ||
138 | struct i2c_msg *p; | ||
139 | int i, err = 0; | ||
140 | |||
141 | for (i = 0; !err && i < num; i++) { | ||
142 | p = &msgs[i]; | ||
143 | err = do_address(adap, p->addr, p->flags & I2C_M_RD); | ||
144 | if (err || !p->len) | ||
145 | continue; | ||
146 | if (p->flags & I2C_M_RD) | ||
147 | err = i2c_read(adap, p->buf, p->len); | ||
148 | else | ||
149 | err = i2c_write(adap, p->buf, p->len); | ||
150 | } | ||
151 | |||
152 | return err; | ||
153 | } | ||
154 | |||
155 | static u32 sgi_func(struct i2c_adapter *adap) | ||
156 | { | ||
157 | return I2C_FUNC_SMBUS_EMUL; | ||
158 | } | ||
159 | |||
160 | static struct i2c_algorithm sgi_algo = { | ||
161 | .name = "SGI algorithm", | ||
162 | .id = I2C_ALGO_SGI, | ||
163 | .master_xfer = sgi_xfer, | ||
164 | .functionality = sgi_func, | ||
165 | }; | ||
166 | |||
167 | /* | ||
168 | * registering functions to load algorithms at runtime | ||
169 | */ | ||
170 | int i2c_sgi_add_bus(struct i2c_adapter *adap) | ||
171 | { | ||
172 | adap->id |= sgi_algo.id; | ||
173 | adap->algo = &sgi_algo; | ||
174 | |||
175 | return i2c_add_adapter(adap); | ||
176 | } | ||
177 | |||
178 | |||
179 | int i2c_sgi_del_bus(struct i2c_adapter *adap) | ||
180 | { | ||
181 | return i2c_del_adapter(adap); | ||
182 | } | ||
183 | |||
184 | EXPORT_SYMBOL(i2c_sgi_add_bus); | ||
185 | EXPORT_SYMBOL(i2c_sgi_del_bus); | ||
186 | |||
187 | MODULE_AUTHOR("Ladislav Michl <ladis@linux-mips.org>"); | ||
188 | MODULE_DESCRIPTION("I2C-Bus SGI algorithm"); | ||
189 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/i2c/algos/i2c-algo-sibyte.c b/drivers/i2c/algos/i2c-algo-sibyte.c new file mode 100644 index 000000000000..35789bb7126a --- /dev/null +++ b/drivers/i2c/algos/i2c-algo-sibyte.c | |||
@@ -0,0 +1,222 @@ | |||
1 | /* ------------------------------------------------------------------------- */ | ||
2 | /* i2c-algo-sibyte.c i2c driver algorithms for bit-shift adapters */ | ||
3 | /* ------------------------------------------------------------------------- */ | ||
4 | /* Copyright (C) 2001,2002,2003 Broadcom Corporation | ||
5 | Copyright (C) 1995-2000 Simon G. Vogl | ||
6 | |||
7 | This program is free software; you can redistribute it and/or modify | ||
8 | it under the terms of the GNU General Public License as published by | ||
9 | the Free Software Foundation; either version 2 of the License, or | ||
10 | (at your option) any later version. | ||
11 | |||
12 | This program is distributed in the hope that it will be useful, | ||
13 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
15 | GNU General Public License for more details. | ||
16 | |||
17 | You should have received a copy of the GNU General Public License | ||
18 | along with this program; if not, write to the Free Software | ||
19 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ | ||
20 | /* ------------------------------------------------------------------------- */ | ||
21 | |||
22 | /* With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi> and even | ||
23 | Frodo Looijaard <frodol@dds.nl>. */ | ||
24 | |||
25 | /* Ported for SiByte SOCs by Broadcom Corporation. */ | ||
26 | |||
27 | #include <linux/config.h> | ||
28 | #include <linux/kernel.h> | ||
29 | #include <linux/module.h> | ||
30 | #include <linux/init.h> | ||
31 | |||
32 | #include <asm/io.h> | ||
33 | #include <asm/sibyte/sb1250_regs.h> | ||
34 | #include <asm/sibyte/sb1250_smbus.h> | ||
35 | |||
36 | #include <linux/i2c.h> | ||
37 | #include <linux/i2c-algo-sibyte.h> | ||
38 | |||
39 | /* ----- global defines ----------------------------------------------- */ | ||
40 | #define SMB_CSR(a,r) ((long)(a->reg_base + r)) | ||
41 | |||
42 | /* ----- global variables --------------------------------------------- */ | ||
43 | |||
44 | /* module parameters: | ||
45 | */ | ||
46 | static int bit_scan=0; /* have a look at what's hanging 'round */ | ||
47 | |||
48 | |||
49 | static int smbus_xfer(struct i2c_adapter *i2c_adap, u16 addr, | ||
50 | unsigned short flags, char read_write, | ||
51 | u8 command, int size, union i2c_smbus_data * data) | ||
52 | { | ||
53 | struct i2c_algo_sibyte_data *adap = i2c_adap->algo_data; | ||
54 | int data_bytes = 0; | ||
55 | int error; | ||
56 | |||
57 | while (csr_in32(SMB_CSR(adap, R_SMB_STATUS)) & M_SMB_BUSY) | ||
58 | ; | ||
59 | |||
60 | switch (size) { | ||
61 | case I2C_SMBUS_QUICK: | ||
62 | csr_out32((V_SMB_ADDR(addr) | (read_write == I2C_SMBUS_READ ? M_SMB_QDATA : 0) | | ||
63 | V_SMB_TT_QUICKCMD), SMB_CSR(adap, R_SMB_START)); | ||
64 | break; | ||
65 | case I2C_SMBUS_BYTE: | ||
66 | if (read_write == I2C_SMBUS_READ) { | ||
67 | csr_out32((V_SMB_ADDR(addr) | V_SMB_TT_RD1BYTE), | ||
68 | SMB_CSR(adap, R_SMB_START)); | ||
69 | data_bytes = 1; | ||
70 | } else { | ||
71 | csr_out32(V_SMB_CMD(command), SMB_CSR(adap, R_SMB_CMD)); | ||
72 | csr_out32((V_SMB_ADDR(addr) | V_SMB_TT_WR1BYTE), | ||
73 | SMB_CSR(adap, R_SMB_START)); | ||
74 | } | ||
75 | break; | ||
76 | case I2C_SMBUS_BYTE_DATA: | ||
77 | csr_out32(V_SMB_CMD(command), SMB_CSR(adap, R_SMB_CMD)); | ||
78 | if (read_write == I2C_SMBUS_READ) { | ||
79 | csr_out32((V_SMB_ADDR(addr) | V_SMB_TT_CMD_RD1BYTE), | ||
80 | SMB_CSR(adap, R_SMB_START)); | ||
81 | data_bytes = 1; | ||
82 | } else { | ||
83 | csr_out32(V_SMB_LB(data->byte), SMB_CSR(adap, R_SMB_DATA)); | ||
84 | csr_out32((V_SMB_ADDR(addr) | V_SMB_TT_WR2BYTE), | ||
85 | SMB_CSR(adap, R_SMB_START)); | ||
86 | } | ||
87 | break; | ||
88 | case I2C_SMBUS_WORD_DATA: | ||
89 | csr_out32(V_SMB_CMD(command), SMB_CSR(adap, R_SMB_CMD)); | ||
90 | if (read_write == I2C_SMBUS_READ) { | ||
91 | csr_out32((V_SMB_ADDR(addr) | V_SMB_TT_CMD_RD2BYTE), | ||
92 | SMB_CSR(adap, R_SMB_START)); | ||
93 | data_bytes = 2; | ||
94 | } else { | ||
95 | csr_out32(V_SMB_LB(data->word & 0xff), SMB_CSR(adap, R_SMB_DATA)); | ||
96 | csr_out32(V_SMB_MB(data->word >> 8), SMB_CSR(adap, R_SMB_DATA)); | ||
97 | csr_out32((V_SMB_ADDR(addr) | V_SMB_TT_WR2BYTE), | ||
98 | SMB_CSR(adap, R_SMB_START)); | ||
99 | } | ||
100 | break; | ||
101 | default: | ||
102 | return -1; /* XXXKW better error code? */ | ||
103 | } | ||
104 | |||
105 | while (csr_in32(SMB_CSR(adap, R_SMB_STATUS)) & M_SMB_BUSY) | ||
106 | ; | ||
107 | |||
108 | error = csr_in32(SMB_CSR(adap, R_SMB_STATUS)); | ||
109 | if (error & M_SMB_ERROR) { | ||
110 | /* Clear error bit by writing a 1 */ | ||
111 | csr_out32(M_SMB_ERROR, SMB_CSR(adap, R_SMB_STATUS)); | ||
112 | return -1; /* XXXKW better error code? */ | ||
113 | } | ||
114 | |||
115 | if (data_bytes == 1) | ||
116 | data->byte = csr_in32(SMB_CSR(adap, R_SMB_DATA)) & 0xff; | ||
117 | if (data_bytes == 2) | ||
118 | data->word = csr_in32(SMB_CSR(adap, R_SMB_DATA)) & 0xffff; | ||
119 | |||
120 | return 0; | ||
121 | } | ||
122 | |||
123 | static int algo_control(struct i2c_adapter *adapter, | ||
124 | unsigned int cmd, unsigned long arg) | ||
125 | { | ||
126 | return 0; | ||
127 | } | ||
128 | |||
129 | static u32 bit_func(struct i2c_adapter *adap) | ||
130 | { | ||
131 | return (I2C_FUNC_SMBUS_QUICK | I2C_FUNC_SMBUS_BYTE | | ||
132 | I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA); | ||
133 | } | ||
134 | |||
135 | |||
136 | /* -----exported algorithm data: ------------------------------------- */ | ||
137 | |||
138 | static struct i2c_algorithm i2c_sibyte_algo = { | ||
139 | .name = "SiByte algorithm", | ||
140 | .id = I2C_ALGO_SIBYTE, | ||
141 | .smbus_xfer = smbus_xfer, | ||
142 | .algo_control = algo_control, /* ioctl */ | ||
143 | .functionality = bit_func, | ||
144 | }; | ||
145 | |||
146 | /* | ||
147 | * registering functions to load algorithms at runtime | ||
148 | */ | ||
149 | int i2c_sibyte_add_bus(struct i2c_adapter *i2c_adap, int speed) | ||
150 | { | ||
151 | int i; | ||
152 | struct i2c_algo_sibyte_data *adap = i2c_adap->algo_data; | ||
153 | |||
154 | /* register new adapter to i2c module... */ | ||
155 | |||
156 | i2c_adap->id |= i2c_sibyte_algo.id; | ||
157 | i2c_adap->algo = &i2c_sibyte_algo; | ||
158 | |||
159 | /* Set the frequency to 100 kHz */ | ||
160 | csr_out32(speed, SMB_CSR(adap,R_SMB_FREQ)); | ||
161 | csr_out32(0, SMB_CSR(adap,R_SMB_CONTROL)); | ||
162 | |||
163 | /* scan bus */ | ||
164 | if (bit_scan) { | ||
165 | union i2c_smbus_data data; | ||
166 | int rc; | ||
167 | printk(KERN_INFO " i2c-algo-sibyte.o: scanning bus %s.\n", | ||
168 | i2c_adap->name); | ||
169 | for (i = 0x00; i < 0x7f; i++) { | ||
170 | /* XXXKW is this a realistic probe? */ | ||
171 | rc = smbus_xfer(i2c_adap, i, 0, I2C_SMBUS_READ, 0, | ||
172 | I2C_SMBUS_BYTE_DATA, &data); | ||
173 | if (!rc) { | ||
174 | printk("(%02x)",i); | ||
175 | } else | ||
176 | printk("."); | ||
177 | } | ||
178 | printk("\n"); | ||
179 | } | ||
180 | |||
181 | i2c_add_adapter(i2c_adap); | ||
182 | |||
183 | return 0; | ||
184 | } | ||
185 | |||
186 | |||
187 | int i2c_sibyte_del_bus(struct i2c_adapter *adap) | ||
188 | { | ||
189 | int res; | ||
190 | |||
191 | if ((res = i2c_del_adapter(adap)) < 0) | ||
192 | return res; | ||
193 | |||
194 | return 0; | ||
195 | } | ||
196 | |||
197 | int __init i2c_algo_sibyte_init (void) | ||
198 | { | ||
199 | printk("i2c-algo-sibyte.o: i2c SiByte algorithm module\n"); | ||
200 | return 0; | ||
201 | } | ||
202 | |||
203 | |||
204 | EXPORT_SYMBOL(i2c_sibyte_add_bus); | ||
205 | EXPORT_SYMBOL(i2c_sibyte_del_bus); | ||
206 | |||
207 | #ifdef MODULE | ||
208 | MODULE_AUTHOR("Kip Walker, Broadcom Corp."); | ||
209 | MODULE_DESCRIPTION("SiByte I2C-Bus algorithm"); | ||
210 | MODULE_PARM(bit_scan, "i"); | ||
211 | MODULE_PARM_DESC(bit_scan, "Scan for active chips on the bus"); | ||
212 | MODULE_LICENSE("GPL"); | ||
213 | |||
214 | int init_module(void) | ||
215 | { | ||
216 | return i2c_algo_sibyte_init(); | ||
217 | } | ||
218 | |||
219 | void cleanup_module(void) | ||
220 | { | ||
221 | } | ||
222 | #endif | ||