i2c: Timeouts off by 1
[deliverable/linux.git] / drivers / i2c / busses / i2c-i801.c
1 /*
2 Copyright (c) 1998 - 2002 Frodo Looijaard <frodol@dds.nl>,
3 Philip Edelbrock <phil@netroedge.com>, and Mark D. Studebaker
4 <mdsxyz123@yahoo.com>
5 Copyright (C) 2007, 2008 Jean Delvare <khali@linux-fr.org>
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 /*
23 Supports the following Intel I/O Controller Hubs (ICH):
24
25 I/O Block I2C
26 region SMBus Block proc. block
27 Chip name PCI ID size PEC buffer call read
28 ----------------------------------------------------------------------
29 82801AA (ICH) 0x2413 16 no no no no
30 82801AB (ICH0) 0x2423 16 no no no no
31 82801BA (ICH2) 0x2443 16 no no no no
32 82801CA (ICH3) 0x2483 32 soft no no no
33 82801DB (ICH4) 0x24c3 32 hard yes no no
34 82801E (ICH5) 0x24d3 32 hard yes yes yes
35 6300ESB 0x25a4 32 hard yes yes yes
36 82801F (ICH6) 0x266a 32 hard yes yes yes
37 6310ESB/6320ESB 0x269b 32 hard yes yes yes
38 82801G (ICH7) 0x27da 32 hard yes yes yes
39 82801H (ICH8) 0x283e 32 hard yes yes yes
40 82801I (ICH9) 0x2930 32 hard yes yes yes
41 Tolapai 0x5032 32 hard yes yes yes
42 ICH10 0x3a30 32 hard yes yes yes
43 ICH10 0x3a60 32 hard yes yes yes
44 PCH 0x3b30 32 hard yes yes yes
45
46 Features supported by this driver:
47 Software PEC no
48 Hardware PEC yes
49 Block buffer yes
50 Block process call transaction no
51 I2C block read transaction yes (doesn't use the block buffer)
52
53 See the file Documentation/i2c/busses/i2c-i801 for details.
54 */
55
56 /* Note: we assume there can only be one I801, with one SMBus interface */
57
58 #include <linux/module.h>
59 #include <linux/pci.h>
60 #include <linux/kernel.h>
61 #include <linux/stddef.h>
62 #include <linux/delay.h>
63 #include <linux/ioport.h>
64 #include <linux/init.h>
65 #include <linux/i2c.h>
66 #include <linux/acpi.h>
67 #include <linux/io.h>
68 #include <linux/dmi.h>
69
70 /* I801 SMBus address offsets */
71 #define SMBHSTSTS (0 + i801_smba)
72 #define SMBHSTCNT (2 + i801_smba)
73 #define SMBHSTCMD (3 + i801_smba)
74 #define SMBHSTADD (4 + i801_smba)
75 #define SMBHSTDAT0 (5 + i801_smba)
76 #define SMBHSTDAT1 (6 + i801_smba)
77 #define SMBBLKDAT (7 + i801_smba)
78 #define SMBPEC (8 + i801_smba) /* ICH3 and later */
79 #define SMBAUXSTS (12 + i801_smba) /* ICH4 and later */
80 #define SMBAUXCTL (13 + i801_smba) /* ICH4 and later */
81
82 /* PCI Address Constants */
83 #define SMBBAR 4
84 #define SMBHSTCFG 0x040
85
86 /* Host configuration bits for SMBHSTCFG */
87 #define SMBHSTCFG_HST_EN 1
88 #define SMBHSTCFG_SMB_SMI_EN 2
89 #define SMBHSTCFG_I2C_EN 4
90
91 /* Auxillary control register bits, ICH4+ only */
92 #define SMBAUXCTL_CRC 1
93 #define SMBAUXCTL_E32B 2
94
95 /* kill bit for SMBHSTCNT */
96 #define SMBHSTCNT_KILL 2
97
98 /* Other settings */
99 #define MAX_TIMEOUT 100
100 #define ENABLE_INT9 0 /* set to 0x01 to enable - untested */
101
102 /* I801 command constants */
103 #define I801_QUICK 0x00
104 #define I801_BYTE 0x04
105 #define I801_BYTE_DATA 0x08
106 #define I801_WORD_DATA 0x0C
107 #define I801_PROC_CALL 0x10 /* unimplemented */
108 #define I801_BLOCK_DATA 0x14
109 #define I801_I2C_BLOCK_DATA 0x18 /* ICH5 and later */
110 #define I801_BLOCK_LAST 0x34
111 #define I801_I2C_BLOCK_LAST 0x38 /* ICH5 and later */
112 #define I801_START 0x40
113 #define I801_PEC_EN 0x80 /* ICH3 and later */
114
115 /* I801 Hosts Status register bits */
116 #define SMBHSTSTS_BYTE_DONE 0x80
117 #define SMBHSTSTS_INUSE_STS 0x40
118 #define SMBHSTSTS_SMBALERT_STS 0x20
119 #define SMBHSTSTS_FAILED 0x10
120 #define SMBHSTSTS_BUS_ERR 0x08
121 #define SMBHSTSTS_DEV_ERR 0x04
122 #define SMBHSTSTS_INTR 0x02
123 #define SMBHSTSTS_HOST_BUSY 0x01
124
125 #define STATUS_FLAGS (SMBHSTSTS_BYTE_DONE | SMBHSTSTS_FAILED | \
126 SMBHSTSTS_BUS_ERR | SMBHSTSTS_DEV_ERR | \
127 SMBHSTSTS_INTR)
128
129 static unsigned long i801_smba;
130 static unsigned char i801_original_hstcfg;
131 static struct pci_driver i801_driver;
132 static struct pci_dev *I801_dev;
133
134 #define FEATURE_SMBUS_PEC (1 << 0)
135 #define FEATURE_BLOCK_BUFFER (1 << 1)
136 #define FEATURE_BLOCK_PROC (1 << 2)
137 #define FEATURE_I2C_BLOCK_READ (1 << 3)
138 static unsigned int i801_features;
139
140 /* Make sure the SMBus host is ready to start transmitting.
141 Return 0 if it is, -EBUSY if it is not. */
142 static int i801_check_pre(void)
143 {
144 int status;
145
146 status = inb_p(SMBHSTSTS);
147 if (status & SMBHSTSTS_HOST_BUSY) {
148 dev_err(&I801_dev->dev, "SMBus is busy, can't use it!\n");
149 return -EBUSY;
150 }
151
152 status &= STATUS_FLAGS;
153 if (status) {
154 dev_dbg(&I801_dev->dev, "Clearing status flags (%02x)\n",
155 status);
156 outb_p(status, SMBHSTSTS);
157 status = inb_p(SMBHSTSTS) & STATUS_FLAGS;
158 if (status) {
159 dev_err(&I801_dev->dev,
160 "Failed clearing status flags (%02x)\n",
161 status);
162 return -EBUSY;
163 }
164 }
165
166 return 0;
167 }
168
169 /* Convert the status register to an error code, and clear it. */
170 static int i801_check_post(int status, int timeout)
171 {
172 int result = 0;
173
174 /* If the SMBus is still busy, we give up */
175 if (timeout) {
176 dev_err(&I801_dev->dev, "Transaction timeout\n");
177 /* try to stop the current command */
178 dev_dbg(&I801_dev->dev, "Terminating the current operation\n");
179 outb_p(inb_p(SMBHSTCNT) | SMBHSTCNT_KILL, SMBHSTCNT);
180 msleep(1);
181 outb_p(inb_p(SMBHSTCNT) & (~SMBHSTCNT_KILL), SMBHSTCNT);
182
183 /* Check if it worked */
184 status = inb_p(SMBHSTSTS);
185 if ((status & SMBHSTSTS_HOST_BUSY) ||
186 !(status & SMBHSTSTS_FAILED))
187 dev_err(&I801_dev->dev,
188 "Failed terminating the transaction\n");
189 outb_p(STATUS_FLAGS, SMBHSTSTS);
190 return -ETIMEDOUT;
191 }
192
193 if (status & SMBHSTSTS_FAILED) {
194 result = -EIO;
195 dev_err(&I801_dev->dev, "Transaction failed\n");
196 }
197 if (status & SMBHSTSTS_DEV_ERR) {
198 result = -ENXIO;
199 dev_dbg(&I801_dev->dev, "No response\n");
200 }
201 if (status & SMBHSTSTS_BUS_ERR) {
202 result = -EAGAIN;
203 dev_dbg(&I801_dev->dev, "Lost arbitration\n");
204 }
205
206 if (result) {
207 /* Clear error flags */
208 outb_p(status & STATUS_FLAGS, SMBHSTSTS);
209 status = inb_p(SMBHSTSTS) & STATUS_FLAGS;
210 if (status) {
211 dev_warn(&I801_dev->dev, "Failed clearing status "
212 "flags at end of transaction (%02x)\n",
213 status);
214 }
215 }
216
217 return result;
218 }
219
220 static int i801_transaction(int xact)
221 {
222 int status;
223 int result;
224 int timeout = 0;
225
226 result = i801_check_pre();
227 if (result < 0)
228 return result;
229
230 /* the current contents of SMBHSTCNT can be overwritten, since PEC,
231 * INTREN, SMBSCMD are passed in xact */
232 outb_p(xact | I801_START, SMBHSTCNT);
233
234 /* We will always wait for a fraction of a second! */
235 do {
236 msleep(1);
237 status = inb_p(SMBHSTSTS);
238 } while ((status & SMBHSTSTS_HOST_BUSY) && (timeout++ < MAX_TIMEOUT));
239
240 result = i801_check_post(status, timeout > MAX_TIMEOUT);
241 if (result < 0)
242 return result;
243
244 outb_p(SMBHSTSTS_INTR, SMBHSTSTS);
245 return 0;
246 }
247
248 /* wait for INTR bit as advised by Intel */
249 static void i801_wait_hwpec(void)
250 {
251 int timeout = 0;
252 int status;
253
254 do {
255 msleep(1);
256 status = inb_p(SMBHSTSTS);
257 } while ((!(status & SMBHSTSTS_INTR))
258 && (timeout++ < MAX_TIMEOUT));
259
260 if (timeout > MAX_TIMEOUT)
261 dev_dbg(&I801_dev->dev, "PEC Timeout!\n");
262
263 outb_p(status, SMBHSTSTS);
264 }
265
266 static int i801_block_transaction_by_block(union i2c_smbus_data *data,
267 char read_write, int hwpec)
268 {
269 int i, len;
270 int status;
271
272 inb_p(SMBHSTCNT); /* reset the data buffer index */
273
274 /* Use 32-byte buffer to process this transaction */
275 if (read_write == I2C_SMBUS_WRITE) {
276 len = data->block[0];
277 outb_p(len, SMBHSTDAT0);
278 for (i = 0; i < len; i++)
279 outb_p(data->block[i+1], SMBBLKDAT);
280 }
281
282 status = i801_transaction(I801_BLOCK_DATA | ENABLE_INT9 |
283 I801_PEC_EN * hwpec);
284 if (status)
285 return status;
286
287 if (read_write == I2C_SMBUS_READ) {
288 len = inb_p(SMBHSTDAT0);
289 if (len < 1 || len > I2C_SMBUS_BLOCK_MAX)
290 return -EPROTO;
291
292 data->block[0] = len;
293 for (i = 0; i < len; i++)
294 data->block[i + 1] = inb_p(SMBBLKDAT);
295 }
296 return 0;
297 }
298
299 static int i801_block_transaction_byte_by_byte(union i2c_smbus_data *data,
300 char read_write, int command,
301 int hwpec)
302 {
303 int i, len;
304 int smbcmd;
305 int status;
306 int result;
307 int timeout;
308
309 result = i801_check_pre();
310 if (result < 0)
311 return result;
312
313 len = data->block[0];
314
315 if (read_write == I2C_SMBUS_WRITE) {
316 outb_p(len, SMBHSTDAT0);
317 outb_p(data->block[1], SMBBLKDAT);
318 }
319
320 for (i = 1; i <= len; i++) {
321 if (i == len && read_write == I2C_SMBUS_READ) {
322 if (command == I2C_SMBUS_I2C_BLOCK_DATA)
323 smbcmd = I801_I2C_BLOCK_LAST;
324 else
325 smbcmd = I801_BLOCK_LAST;
326 } else {
327 if (command == I2C_SMBUS_I2C_BLOCK_DATA
328 && read_write == I2C_SMBUS_READ)
329 smbcmd = I801_I2C_BLOCK_DATA;
330 else
331 smbcmd = I801_BLOCK_DATA;
332 }
333 outb_p(smbcmd | ENABLE_INT9, SMBHSTCNT);
334
335 if (i == 1)
336 outb_p(inb(SMBHSTCNT) | I801_START, SMBHSTCNT);
337
338 /* We will always wait for a fraction of a second! */
339 timeout = 0;
340 do {
341 msleep(1);
342 status = inb_p(SMBHSTSTS);
343 }
344 while ((!(status & SMBHSTSTS_BYTE_DONE))
345 && (timeout++ < MAX_TIMEOUT));
346
347 result = i801_check_post(status, timeout > MAX_TIMEOUT);
348 if (result < 0)
349 return result;
350
351 if (i == 1 && read_write == I2C_SMBUS_READ
352 && command != I2C_SMBUS_I2C_BLOCK_DATA) {
353 len = inb_p(SMBHSTDAT0);
354 if (len < 1 || len > I2C_SMBUS_BLOCK_MAX) {
355 dev_err(&I801_dev->dev,
356 "Illegal SMBus block read size %d\n",
357 len);
358 /* Recover */
359 while (inb_p(SMBHSTSTS) & SMBHSTSTS_HOST_BUSY)
360 outb_p(SMBHSTSTS_BYTE_DONE, SMBHSTSTS);
361 outb_p(SMBHSTSTS_INTR, SMBHSTSTS);
362 return -EPROTO;
363 }
364 data->block[0] = len;
365 }
366
367 /* Retrieve/store value in SMBBLKDAT */
368 if (read_write == I2C_SMBUS_READ)
369 data->block[i] = inb_p(SMBBLKDAT);
370 if (read_write == I2C_SMBUS_WRITE && i+1 <= len)
371 outb_p(data->block[i+1], SMBBLKDAT);
372
373 /* signals SMBBLKDAT ready */
374 outb_p(SMBHSTSTS_BYTE_DONE | SMBHSTSTS_INTR, SMBHSTSTS);
375 }
376
377 return 0;
378 }
379
380 static int i801_set_block_buffer_mode(void)
381 {
382 outb_p(inb_p(SMBAUXCTL) | SMBAUXCTL_E32B, SMBAUXCTL);
383 if ((inb_p(SMBAUXCTL) & SMBAUXCTL_E32B) == 0)
384 return -EIO;
385 return 0;
386 }
387
388 /* Block transaction function */
389 static int i801_block_transaction(union i2c_smbus_data *data, char read_write,
390 int command, int hwpec)
391 {
392 int result = 0;
393 unsigned char hostc;
394
395 if (command == I2C_SMBUS_I2C_BLOCK_DATA) {
396 if (read_write == I2C_SMBUS_WRITE) {
397 /* set I2C_EN bit in configuration register */
398 pci_read_config_byte(I801_dev, SMBHSTCFG, &hostc);
399 pci_write_config_byte(I801_dev, SMBHSTCFG,
400 hostc | SMBHSTCFG_I2C_EN);
401 } else if (!(i801_features & FEATURE_I2C_BLOCK_READ)) {
402 dev_err(&I801_dev->dev,
403 "I2C block read is unsupported!\n");
404 return -EOPNOTSUPP;
405 }
406 }
407
408 if (read_write == I2C_SMBUS_WRITE
409 || command == I2C_SMBUS_I2C_BLOCK_DATA) {
410 if (data->block[0] < 1)
411 data->block[0] = 1;
412 if (data->block[0] > I2C_SMBUS_BLOCK_MAX)
413 data->block[0] = I2C_SMBUS_BLOCK_MAX;
414 } else {
415 data->block[0] = 32; /* max for SMBus block reads */
416 }
417
418 if ((i801_features & FEATURE_BLOCK_BUFFER)
419 && !(command == I2C_SMBUS_I2C_BLOCK_DATA
420 && read_write == I2C_SMBUS_READ)
421 && i801_set_block_buffer_mode() == 0)
422 result = i801_block_transaction_by_block(data, read_write,
423 hwpec);
424 else
425 result = i801_block_transaction_byte_by_byte(data, read_write,
426 command, hwpec);
427
428 if (result == 0 && hwpec)
429 i801_wait_hwpec();
430
431 if (command == I2C_SMBUS_I2C_BLOCK_DATA
432 && read_write == I2C_SMBUS_WRITE) {
433 /* restore saved configuration register value */
434 pci_write_config_byte(I801_dev, SMBHSTCFG, hostc);
435 }
436 return result;
437 }
438
439 /* Return negative errno on error. */
440 static s32 i801_access(struct i2c_adapter * adap, u16 addr,
441 unsigned short flags, char read_write, u8 command,
442 int size, union i2c_smbus_data * data)
443 {
444 int hwpec;
445 int block = 0;
446 int ret, xact = 0;
447
448 hwpec = (i801_features & FEATURE_SMBUS_PEC) && (flags & I2C_CLIENT_PEC)
449 && size != I2C_SMBUS_QUICK
450 && size != I2C_SMBUS_I2C_BLOCK_DATA;
451
452 switch (size) {
453 case I2C_SMBUS_QUICK:
454 outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
455 SMBHSTADD);
456 xact = I801_QUICK;
457 break;
458 case I2C_SMBUS_BYTE:
459 outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
460 SMBHSTADD);
461 if (read_write == I2C_SMBUS_WRITE)
462 outb_p(command, SMBHSTCMD);
463 xact = I801_BYTE;
464 break;
465 case I2C_SMBUS_BYTE_DATA:
466 outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
467 SMBHSTADD);
468 outb_p(command, SMBHSTCMD);
469 if (read_write == I2C_SMBUS_WRITE)
470 outb_p(data->byte, SMBHSTDAT0);
471 xact = I801_BYTE_DATA;
472 break;
473 case I2C_SMBUS_WORD_DATA:
474 outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
475 SMBHSTADD);
476 outb_p(command, SMBHSTCMD);
477 if (read_write == I2C_SMBUS_WRITE) {
478 outb_p(data->word & 0xff, SMBHSTDAT0);
479 outb_p((data->word & 0xff00) >> 8, SMBHSTDAT1);
480 }
481 xact = I801_WORD_DATA;
482 break;
483 case I2C_SMBUS_BLOCK_DATA:
484 outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
485 SMBHSTADD);
486 outb_p(command, SMBHSTCMD);
487 block = 1;
488 break;
489 case I2C_SMBUS_I2C_BLOCK_DATA:
490 /* NB: page 240 of ICH5 datasheet shows that the R/#W
491 * bit should be cleared here, even when reading */
492 outb_p((addr & 0x7f) << 1, SMBHSTADD);
493 if (read_write == I2C_SMBUS_READ) {
494 /* NB: page 240 of ICH5 datasheet also shows
495 * that DATA1 is the cmd field when reading */
496 outb_p(command, SMBHSTDAT1);
497 } else
498 outb_p(command, SMBHSTCMD);
499 block = 1;
500 break;
501 default:
502 dev_err(&I801_dev->dev, "Unsupported transaction %d\n", size);
503 return -EOPNOTSUPP;
504 }
505
506 if (hwpec) /* enable/disable hardware PEC */
507 outb_p(inb_p(SMBAUXCTL) | SMBAUXCTL_CRC, SMBAUXCTL);
508 else
509 outb_p(inb_p(SMBAUXCTL) & (~SMBAUXCTL_CRC), SMBAUXCTL);
510
511 if(block)
512 ret = i801_block_transaction(data, read_write, size, hwpec);
513 else
514 ret = i801_transaction(xact | ENABLE_INT9);
515
516 /* Some BIOSes don't like it when PEC is enabled at reboot or resume
517 time, so we forcibly disable it after every transaction. Turn off
518 E32B for the same reason. */
519 if (hwpec || block)
520 outb_p(inb_p(SMBAUXCTL) & ~(SMBAUXCTL_CRC | SMBAUXCTL_E32B),
521 SMBAUXCTL);
522
523 if(block)
524 return ret;
525 if(ret)
526 return ret;
527 if ((read_write == I2C_SMBUS_WRITE) || (xact == I801_QUICK))
528 return 0;
529
530 switch (xact & 0x7f) {
531 case I801_BYTE: /* Result put in SMBHSTDAT0 */
532 case I801_BYTE_DATA:
533 data->byte = inb_p(SMBHSTDAT0);
534 break;
535 case I801_WORD_DATA:
536 data->word = inb_p(SMBHSTDAT0) + (inb_p(SMBHSTDAT1) << 8);
537 break;
538 }
539 return 0;
540 }
541
542
543 static u32 i801_func(struct i2c_adapter *adapter)
544 {
545 return I2C_FUNC_SMBUS_QUICK | I2C_FUNC_SMBUS_BYTE |
546 I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA |
547 I2C_FUNC_SMBUS_BLOCK_DATA | I2C_FUNC_SMBUS_WRITE_I2C_BLOCK |
548 ((i801_features & FEATURE_SMBUS_PEC) ? I2C_FUNC_SMBUS_PEC : 0) |
549 ((i801_features & FEATURE_I2C_BLOCK_READ) ?
550 I2C_FUNC_SMBUS_READ_I2C_BLOCK : 0);
551 }
552
553 static const struct i2c_algorithm smbus_algorithm = {
554 .smbus_xfer = i801_access,
555 .functionality = i801_func,
556 };
557
558 static struct i2c_adapter i801_adapter = {
559 .owner = THIS_MODULE,
560 .class = I2C_CLASS_HWMON | I2C_CLASS_SPD,
561 .algo = &smbus_algorithm,
562 };
563
564 static struct pci_device_id i801_ids[] = {
565 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801AA_3) },
566 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801AB_3) },
567 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801BA_2) },
568 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801CA_3) },
569 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801DB_3) },
570 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801EB_3) },
571 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ESB_4) },
572 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH6_16) },
573 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH7_17) },
574 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ESB2_17) },
575 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH8_5) },
576 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH9_6) },
577 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_TOLAPAI_1) },
578 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH10_4) },
579 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH10_5) },
580 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_PCH_SMBUS) },
581 { 0, }
582 };
583
584 MODULE_DEVICE_TABLE (pci, i801_ids);
585
586 #if defined CONFIG_INPUT_APANEL || defined CONFIG_INPUT_APANEL_MODULE
587 static unsigned char apanel_addr;
588
589 /* Scan the system ROM for the signature "FJKEYINF" */
590 static __init const void __iomem *bios_signature(const void __iomem *bios)
591 {
592 ssize_t offset;
593 const unsigned char signature[] = "FJKEYINF";
594
595 for (offset = 0; offset < 0x10000; offset += 0x10) {
596 if (check_signature(bios + offset, signature,
597 sizeof(signature)-1))
598 return bios + offset;
599 }
600 return NULL;
601 }
602
603 static void __init input_apanel_init(void)
604 {
605 void __iomem *bios;
606 const void __iomem *p;
607
608 bios = ioremap(0xF0000, 0x10000); /* Can't fail */
609 p = bios_signature(bios);
610 if (p) {
611 /* just use the first address */
612 apanel_addr = readb(p + 8 + 3) >> 1;
613 }
614 iounmap(bios);
615 }
616 #else
617 static void __init input_apanel_init(void) {}
618 #endif
619
620 #if defined CONFIG_SENSORS_FSCHMD || defined CONFIG_SENSORS_FSCHMD_MODULE
621 struct dmi_onboard_device_info {
622 const char *name;
623 u8 type;
624 unsigned short i2c_addr;
625 const char *i2c_type;
626 };
627
628 static struct dmi_onboard_device_info __devinitdata dmi_devices[] = {
629 { "Syleus", DMI_DEV_TYPE_OTHER, 0x73, "fscsyl" },
630 { "Hermes", DMI_DEV_TYPE_OTHER, 0x73, "fscher" },
631 { "Hades", DMI_DEV_TYPE_OTHER, 0x73, "fschds" },
632 };
633
634 static void __devinit dmi_check_onboard_device(u8 type, const char *name,
635 struct i2c_adapter *adap)
636 {
637 int i;
638 struct i2c_board_info info;
639
640 for (i = 0; i < ARRAY_SIZE(dmi_devices); i++) {
641 /* & ~0x80, ignore enabled/disabled bit */
642 if ((type & ~0x80) != dmi_devices[i].type)
643 continue;
644 if (strcmp(name, dmi_devices[i].name))
645 continue;
646
647 memset(&info, 0, sizeof(struct i2c_board_info));
648 info.addr = dmi_devices[i].i2c_addr;
649 strlcpy(info.type, dmi_devices[i].i2c_type, I2C_NAME_SIZE);
650 i2c_new_device(adap, &info);
651 break;
652 }
653 }
654
655 /* We use our own function to check for onboard devices instead of
656 dmi_find_device() as some buggy BIOS's have the devices we are interested
657 in marked as disabled */
658 static void __devinit dmi_check_onboard_devices(const struct dmi_header *dm,
659 void *adap)
660 {
661 int i, count;
662
663 if (dm->type != 10)
664 return;
665
666 count = (dm->length - sizeof(struct dmi_header)) / 2;
667 for (i = 0; i < count; i++) {
668 const u8 *d = (char *)(dm + 1) + (i * 2);
669 const char *name = ((char *) dm) + dm->length;
670 u8 type = d[0];
671 u8 s = d[1];
672
673 if (!s)
674 continue;
675 s--;
676 while (s > 0 && name[0]) {
677 name += strlen(name) + 1;
678 s--;
679 }
680 if (name[0] == 0) /* Bogus string reference */
681 continue;
682
683 dmi_check_onboard_device(type, name, adap);
684 }
685 }
686 #endif
687
688 static int __devinit i801_probe(struct pci_dev *dev, const struct pci_device_id *id)
689 {
690 unsigned char temp;
691 int err;
692 #if defined CONFIG_SENSORS_FSCHMD || defined CONFIG_SENSORS_FSCHMD_MODULE
693 const char *vendor;
694 #endif
695
696 I801_dev = dev;
697 i801_features = 0;
698 switch (dev->device) {
699 case PCI_DEVICE_ID_INTEL_82801EB_3:
700 case PCI_DEVICE_ID_INTEL_ESB_4:
701 case PCI_DEVICE_ID_INTEL_ICH6_16:
702 case PCI_DEVICE_ID_INTEL_ICH7_17:
703 case PCI_DEVICE_ID_INTEL_ESB2_17:
704 case PCI_DEVICE_ID_INTEL_ICH8_5:
705 case PCI_DEVICE_ID_INTEL_ICH9_6:
706 case PCI_DEVICE_ID_INTEL_TOLAPAI_1:
707 case PCI_DEVICE_ID_INTEL_ICH10_4:
708 case PCI_DEVICE_ID_INTEL_ICH10_5:
709 case PCI_DEVICE_ID_INTEL_PCH_SMBUS:
710 i801_features |= FEATURE_I2C_BLOCK_READ;
711 /* fall through */
712 case PCI_DEVICE_ID_INTEL_82801DB_3:
713 i801_features |= FEATURE_SMBUS_PEC;
714 i801_features |= FEATURE_BLOCK_BUFFER;
715 break;
716 }
717
718 err = pci_enable_device(dev);
719 if (err) {
720 dev_err(&dev->dev, "Failed to enable SMBus PCI device (%d)\n",
721 err);
722 goto exit;
723 }
724
725 /* Determine the address of the SMBus area */
726 i801_smba = pci_resource_start(dev, SMBBAR);
727 if (!i801_smba) {
728 dev_err(&dev->dev, "SMBus base address uninitialized, "
729 "upgrade BIOS\n");
730 err = -ENODEV;
731 goto exit;
732 }
733
734 err = acpi_check_resource_conflict(&dev->resource[SMBBAR]);
735 if (err)
736 goto exit;
737
738 err = pci_request_region(dev, SMBBAR, i801_driver.name);
739 if (err) {
740 dev_err(&dev->dev, "Failed to request SMBus region "
741 "0x%lx-0x%Lx\n", i801_smba,
742 (unsigned long long)pci_resource_end(dev, SMBBAR));
743 goto exit;
744 }
745
746 pci_read_config_byte(I801_dev, SMBHSTCFG, &temp);
747 i801_original_hstcfg = temp;
748 temp &= ~SMBHSTCFG_I2C_EN; /* SMBus timing */
749 if (!(temp & SMBHSTCFG_HST_EN)) {
750 dev_info(&dev->dev, "Enabling SMBus device\n");
751 temp |= SMBHSTCFG_HST_EN;
752 }
753 pci_write_config_byte(I801_dev, SMBHSTCFG, temp);
754
755 if (temp & SMBHSTCFG_SMB_SMI_EN)
756 dev_dbg(&dev->dev, "SMBus using interrupt SMI#\n");
757 else
758 dev_dbg(&dev->dev, "SMBus using PCI Interrupt\n");
759
760 /* Clear special mode bits */
761 if (i801_features & (FEATURE_SMBUS_PEC | FEATURE_BLOCK_BUFFER))
762 outb_p(inb_p(SMBAUXCTL) & ~(SMBAUXCTL_CRC | SMBAUXCTL_E32B),
763 SMBAUXCTL);
764
765 /* set up the sysfs linkage to our parent device */
766 i801_adapter.dev.parent = &dev->dev;
767
768 snprintf(i801_adapter.name, sizeof(i801_adapter.name),
769 "SMBus I801 adapter at %04lx", i801_smba);
770 err = i2c_add_adapter(&i801_adapter);
771 if (err) {
772 dev_err(&dev->dev, "Failed to add SMBus adapter\n");
773 goto exit_release;
774 }
775
776 /* Register optional slaves */
777 #if defined CONFIG_INPUT_APANEL || defined CONFIG_INPUT_APANEL_MODULE
778 if (apanel_addr) {
779 struct i2c_board_info info;
780
781 memset(&info, 0, sizeof(struct i2c_board_info));
782 info.addr = apanel_addr;
783 strlcpy(info.type, "fujitsu_apanel", I2C_NAME_SIZE);
784 i2c_new_device(&i801_adapter, &info);
785 }
786 #endif
787 #if defined CONFIG_SENSORS_FSCHMD || defined CONFIG_SENSORS_FSCHMD_MODULE
788 vendor = dmi_get_system_info(DMI_BOARD_VENDOR);
789 if (vendor && !strcmp(vendor, "FUJITSU SIEMENS"))
790 dmi_walk(dmi_check_onboard_devices, &i801_adapter);
791 #endif
792
793 return 0;
794
795 exit_release:
796 pci_release_region(dev, SMBBAR);
797 exit:
798 return err;
799 }
800
801 static void __devexit i801_remove(struct pci_dev *dev)
802 {
803 i2c_del_adapter(&i801_adapter);
804 pci_write_config_byte(I801_dev, SMBHSTCFG, i801_original_hstcfg);
805 pci_release_region(dev, SMBBAR);
806 /*
807 * do not call pci_disable_device(dev) since it can cause hard hangs on
808 * some systems during power-off (eg. Fujitsu-Siemens Lifebook E8010)
809 */
810 }
811
812 #ifdef CONFIG_PM
813 static int i801_suspend(struct pci_dev *dev, pm_message_t mesg)
814 {
815 pci_save_state(dev);
816 pci_write_config_byte(dev, SMBHSTCFG, i801_original_hstcfg);
817 pci_set_power_state(dev, pci_choose_state(dev, mesg));
818 return 0;
819 }
820
821 static int i801_resume(struct pci_dev *dev)
822 {
823 pci_set_power_state(dev, PCI_D0);
824 pci_restore_state(dev);
825 return pci_enable_device(dev);
826 }
827 #else
828 #define i801_suspend NULL
829 #define i801_resume NULL
830 #endif
831
832 static struct pci_driver i801_driver = {
833 .name = "i801_smbus",
834 .id_table = i801_ids,
835 .probe = i801_probe,
836 .remove = __devexit_p(i801_remove),
837 .suspend = i801_suspend,
838 .resume = i801_resume,
839 };
840
841 static int __init i2c_i801_init(void)
842 {
843 input_apanel_init();
844 return pci_register_driver(&i801_driver);
845 }
846
847 static void __exit i2c_i801_exit(void)
848 {
849 pci_unregister_driver(&i801_driver);
850 }
851
852 MODULE_AUTHOR("Mark D. Studebaker <mdsxyz123@yahoo.com>, "
853 "Jean Delvare <khali@linux-fr.org>");
854 MODULE_DESCRIPTION("I801 SMBus driver");
855 MODULE_LICENSE("GPL");
856
857 module_init(i2c_i801_init);
858 module_exit(i2c_i801_exit);
This page took 0.063279 seconds and 5 git commands to generate.