Merge branch 'acpica'
[platform/adaptation/renesas_rcar/renesas_kernel.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 - 2012  Jean Delvare <khali@linux-fr.org>
6     Copyright (C) 2010         Intel Corporation,
7                                David Woodhouse <dwmw2@infradead.org>
8
9     This program is free software; you can redistribute it and/or modify
10     it under the terms of the GNU General Public License as published by
11     the Free Software Foundation; either version 2 of the License, or
12     (at your option) any later version.
13
14     This program is distributed in the hope that it will be useful,
15     but WITHOUT ANY WARRANTY; without even the implied warranty of
16     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17     GNU General Public License for more details.
18
19     You should have received a copy of the GNU General Public License
20     along with this program; if not, write to the Free Software
21     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 */
23
24 /*
25   Supports the following Intel I/O Controller Hubs (ICH):
26
27                                   I/O                     Block   I2C
28                                   region  SMBus   Block   proc.   block
29   Chip name             PCI ID    size    PEC     buffer  call    read
30   ----------------------------------------------------------------------
31   82801AA  (ICH)        0x2413     16      no      no      no      no
32   82801AB  (ICH0)       0x2423     16      no      no      no      no
33   82801BA  (ICH2)       0x2443     16      no      no      no      no
34   82801CA  (ICH3)       0x2483     32     soft     no      no      no
35   82801DB  (ICH4)       0x24c3     32     hard     yes     no      no
36   82801E   (ICH5)       0x24d3     32     hard     yes     yes     yes
37   6300ESB               0x25a4     32     hard     yes     yes     yes
38   82801F   (ICH6)       0x266a     32     hard     yes     yes     yes
39   6310ESB/6320ESB       0x269b     32     hard     yes     yes     yes
40   82801G   (ICH7)       0x27da     32     hard     yes     yes     yes
41   82801H   (ICH8)       0x283e     32     hard     yes     yes     yes
42   82801I   (ICH9)       0x2930     32     hard     yes     yes     yes
43   EP80579 (Tolapai)     0x5032     32     hard     yes     yes     yes
44   ICH10                 0x3a30     32     hard     yes     yes     yes
45   ICH10                 0x3a60     32     hard     yes     yes     yes
46   5/3400 Series (PCH)   0x3b30     32     hard     yes     yes     yes
47   6 Series (PCH)        0x1c22     32     hard     yes     yes     yes
48   Patsburg (PCH)        0x1d22     32     hard     yes     yes     yes
49   Patsburg (PCH) IDF    0x1d70     32     hard     yes     yes     yes
50   Patsburg (PCH) IDF    0x1d71     32     hard     yes     yes     yes
51   Patsburg (PCH) IDF    0x1d72     32     hard     yes     yes     yes
52   DH89xxCC (PCH)        0x2330     32     hard     yes     yes     yes
53   Panther Point (PCH)   0x1e22     32     hard     yes     yes     yes
54   Lynx Point (PCH)      0x8c22     32     hard     yes     yes     yes
55   Lynx Point-LP (PCH)   0x9c22     32     hard     yes     yes     yes
56   Avoton (SOC)          0x1f3c     32     hard     yes     yes     yes
57   Wellsburg (PCH)       0x8d22     32     hard     yes     yes     yes
58   Wellsburg (PCH) MS    0x8d7d     32     hard     yes     yes     yes
59   Wellsburg (PCH) MS    0x8d7e     32     hard     yes     yes     yes
60   Wellsburg (PCH) MS    0x8d7f     32     hard     yes     yes     yes
61   Coleto Creek (PCH)    0x23b0     32     hard     yes     yes     yes
62   Wildcat Point-LP (PCH)   0x9ca2     32     hard     yes     yes     yes
63
64   Features supported by this driver:
65   Software PEC                     no
66   Hardware PEC                     yes
67   Block buffer                     yes
68   Block process call transaction   no
69   I2C block read transaction       yes  (doesn't use the block buffer)
70   Slave mode                       no
71   Interrupt processing             yes
72
73   See the file Documentation/i2c/busses/i2c-i801 for details.
74 */
75
76 #include <linux/interrupt.h>
77 #include <linux/module.h>
78 #include <linux/pci.h>
79 #include <linux/kernel.h>
80 #include <linux/stddef.h>
81 #include <linux/delay.h>
82 #include <linux/ioport.h>
83 #include <linux/init.h>
84 #include <linux/i2c.h>
85 #include <linux/acpi.h>
86 #include <linux/io.h>
87 #include <linux/dmi.h>
88 #include <linux/slab.h>
89 #include <linux/wait.h>
90 #include <linux/err.h>
91
92 #if (defined CONFIG_I2C_MUX_GPIO || defined CONFIG_I2C_MUX_GPIO_MODULE) && \
93                 defined CONFIG_DMI
94 #include <linux/gpio.h>
95 #include <linux/i2c-mux-gpio.h>
96 #include <linux/platform_device.h>
97 #endif
98
99 /* I801 SMBus address offsets */
100 #define SMBHSTSTS(p)    (0 + (p)->smba)
101 #define SMBHSTCNT(p)    (2 + (p)->smba)
102 #define SMBHSTCMD(p)    (3 + (p)->smba)
103 #define SMBHSTADD(p)    (4 + (p)->smba)
104 #define SMBHSTDAT0(p)   (5 + (p)->smba)
105 #define SMBHSTDAT1(p)   (6 + (p)->smba)
106 #define SMBBLKDAT(p)    (7 + (p)->smba)
107 #define SMBPEC(p)       (8 + (p)->smba)         /* ICH3 and later */
108 #define SMBAUXSTS(p)    (12 + (p)->smba)        /* ICH4 and later */
109 #define SMBAUXCTL(p)    (13 + (p)->smba)        /* ICH4 and later */
110
111 /* PCI Address Constants */
112 #define SMBBAR          4
113 #define SMBPCISTS       0x006
114 #define SMBHSTCFG       0x040
115
116 /* Host status bits for SMBPCISTS */
117 #define SMBPCISTS_INTS          0x08
118
119 /* Host configuration bits for SMBHSTCFG */
120 #define SMBHSTCFG_HST_EN        1
121 #define SMBHSTCFG_SMB_SMI_EN    2
122 #define SMBHSTCFG_I2C_EN        4
123
124 /* Auxiliary control register bits, ICH4+ only */
125 #define SMBAUXCTL_CRC           1
126 #define SMBAUXCTL_E32B          2
127
128 /* Other settings */
129 #define MAX_RETRIES             400
130
131 /* I801 command constants */
132 #define I801_QUICK              0x00
133 #define I801_BYTE               0x04
134 #define I801_BYTE_DATA          0x08
135 #define I801_WORD_DATA          0x0C
136 #define I801_PROC_CALL          0x10    /* unimplemented */
137 #define I801_BLOCK_DATA         0x14
138 #define I801_I2C_BLOCK_DATA     0x18    /* ICH5 and later */
139
140 /* I801 Host Control register bits */
141 #define SMBHSTCNT_INTREN        0x01
142 #define SMBHSTCNT_KILL          0x02
143 #define SMBHSTCNT_LAST_BYTE     0x20
144 #define SMBHSTCNT_START         0x40
145 #define SMBHSTCNT_PEC_EN        0x80    /* ICH3 and later */
146
147 /* I801 Hosts Status register bits */
148 #define SMBHSTSTS_BYTE_DONE     0x80
149 #define SMBHSTSTS_INUSE_STS     0x40
150 #define SMBHSTSTS_SMBALERT_STS  0x20
151 #define SMBHSTSTS_FAILED        0x10
152 #define SMBHSTSTS_BUS_ERR       0x08
153 #define SMBHSTSTS_DEV_ERR       0x04
154 #define SMBHSTSTS_INTR          0x02
155 #define SMBHSTSTS_HOST_BUSY     0x01
156
157 #define STATUS_ERROR_FLAGS      (SMBHSTSTS_FAILED | SMBHSTSTS_BUS_ERR | \
158                                  SMBHSTSTS_DEV_ERR)
159
160 #define STATUS_FLAGS            (SMBHSTSTS_BYTE_DONE | SMBHSTSTS_INTR | \
161                                  STATUS_ERROR_FLAGS)
162
163 /* Older devices have their ID defined in <linux/pci_ids.h> */
164 #define PCI_DEVICE_ID_INTEL_COUGARPOINT_SMBUS   0x1c22
165 #define PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS      0x1d22
166 /* Patsburg also has three 'Integrated Device Function' SMBus controllers */
167 #define PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS_IDF0 0x1d70
168 #define PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS_IDF1 0x1d71
169 #define PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS_IDF2 0x1d72
170 #define PCI_DEVICE_ID_INTEL_PANTHERPOINT_SMBUS  0x1e22
171 #define PCI_DEVICE_ID_INTEL_AVOTON_SMBUS        0x1f3c
172 #define PCI_DEVICE_ID_INTEL_DH89XXCC_SMBUS      0x2330
173 #define PCI_DEVICE_ID_INTEL_COLETOCREEK_SMBUS   0x23b0
174 #define PCI_DEVICE_ID_INTEL_5_3400_SERIES_SMBUS 0x3b30
175 #define PCI_DEVICE_ID_INTEL_LYNXPOINT_SMBUS     0x8c22
176 #define PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS     0x8d22
177 #define PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS_MS0 0x8d7d
178 #define PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS_MS1 0x8d7e
179 #define PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS_MS2 0x8d7f
180 #define PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_SMBUS  0x9c22
181 #define PCI_DEVICE_ID_INTEL_WILDCATPOINT_LP_SMBUS       0x9ca2
182
183 struct i801_mux_config {
184         char *gpio_chip;
185         unsigned values[3];
186         int n_values;
187         unsigned classes[3];
188         unsigned gpios[2];              /* Relative to gpio_chip->base */
189         int n_gpios;
190 };
191
192 struct i801_priv {
193         struct i2c_adapter adapter;
194         unsigned long smba;
195         unsigned char original_hstcfg;
196         struct pci_dev *pci_dev;
197         unsigned int features;
198
199         /* isr processing */
200         wait_queue_head_t waitq;
201         u8 status;
202
203         /* Command state used by isr for byte-by-byte block transactions */
204         u8 cmd;
205         bool is_read;
206         int count;
207         int len;
208         u8 *data;
209
210 #if (defined CONFIG_I2C_MUX_GPIO || defined CONFIG_I2C_MUX_GPIO_MODULE) && \
211                 defined CONFIG_DMI
212         const struct i801_mux_config *mux_drvdata;
213         struct platform_device *mux_pdev;
214 #endif
215 };
216
217 static struct pci_driver i801_driver;
218
219 #define FEATURE_SMBUS_PEC       (1 << 0)
220 #define FEATURE_BLOCK_BUFFER    (1 << 1)
221 #define FEATURE_BLOCK_PROC      (1 << 2)
222 #define FEATURE_I2C_BLOCK_READ  (1 << 3)
223 #define FEATURE_IRQ             (1 << 4)
224 /* Not really a feature, but it's convenient to handle it as such */
225 #define FEATURE_IDF             (1 << 15)
226
227 static const char *i801_feature_names[] = {
228         "SMBus PEC",
229         "Block buffer",
230         "Block process call",
231         "I2C block read",
232         "Interrupt",
233 };
234
235 static unsigned int disable_features;
236 module_param(disable_features, uint, S_IRUGO | S_IWUSR);
237 MODULE_PARM_DESC(disable_features, "Disable selected driver features:\n"
238         "\t\t  0x01  disable SMBus PEC\n"
239         "\t\t  0x02  disable the block buffer\n"
240         "\t\t  0x08  disable the I2C block read functionality\n"
241         "\t\t  0x10  don't use interrupts ");
242
243 /* Make sure the SMBus host is ready to start transmitting.
244    Return 0 if it is, -EBUSY if it is not. */
245 static int i801_check_pre(struct i801_priv *priv)
246 {
247         int status;
248
249         status = inb_p(SMBHSTSTS(priv));
250         if (status & SMBHSTSTS_HOST_BUSY) {
251                 dev_err(&priv->pci_dev->dev, "SMBus is busy, can't use it!\n");
252                 return -EBUSY;
253         }
254
255         status &= STATUS_FLAGS;
256         if (status) {
257                 dev_dbg(&priv->pci_dev->dev, "Clearing status flags (%02x)\n",
258                         status);
259                 outb_p(status, SMBHSTSTS(priv));
260                 status = inb_p(SMBHSTSTS(priv)) & STATUS_FLAGS;
261                 if (status) {
262                         dev_err(&priv->pci_dev->dev,
263                                 "Failed clearing status flags (%02x)\n",
264                                 status);
265                         return -EBUSY;
266                 }
267         }
268
269         return 0;
270 }
271
272 /*
273  * Convert the status register to an error code, and clear it.
274  * Note that status only contains the bits we want to clear, not the
275  * actual register value.
276  */
277 static int i801_check_post(struct i801_priv *priv, int status)
278 {
279         int result = 0;
280
281         /*
282          * If the SMBus is still busy, we give up
283          * Note: This timeout condition only happens when using polling
284          * transactions.  For interrupt operation, NAK/timeout is indicated by
285          * DEV_ERR.
286          */
287         if (unlikely(status < 0)) {
288                 dev_err(&priv->pci_dev->dev, "Transaction timeout\n");
289                 /* try to stop the current command */
290                 dev_dbg(&priv->pci_dev->dev, "Terminating the current operation\n");
291                 outb_p(inb_p(SMBHSTCNT(priv)) | SMBHSTCNT_KILL,
292                        SMBHSTCNT(priv));
293                 usleep_range(1000, 2000);
294                 outb_p(inb_p(SMBHSTCNT(priv)) & (~SMBHSTCNT_KILL),
295                        SMBHSTCNT(priv));
296
297                 /* Check if it worked */
298                 status = inb_p(SMBHSTSTS(priv));
299                 if ((status & SMBHSTSTS_HOST_BUSY) ||
300                     !(status & SMBHSTSTS_FAILED))
301                         dev_err(&priv->pci_dev->dev,
302                                 "Failed terminating the transaction\n");
303                 outb_p(STATUS_FLAGS, SMBHSTSTS(priv));
304                 return -ETIMEDOUT;
305         }
306
307         if (status & SMBHSTSTS_FAILED) {
308                 result = -EIO;
309                 dev_err(&priv->pci_dev->dev, "Transaction failed\n");
310         }
311         if (status & SMBHSTSTS_DEV_ERR) {
312                 result = -ENXIO;
313                 dev_dbg(&priv->pci_dev->dev, "No response\n");
314         }
315         if (status & SMBHSTSTS_BUS_ERR) {
316                 result = -EAGAIN;
317                 dev_dbg(&priv->pci_dev->dev, "Lost arbitration\n");
318         }
319
320         /* Clear status flags except BYTE_DONE, to be cleared by caller */
321         outb_p(status, SMBHSTSTS(priv));
322
323         return result;
324 }
325
326 /* Wait for BUSY being cleared and either INTR or an error flag being set */
327 static int i801_wait_intr(struct i801_priv *priv)
328 {
329         int timeout = 0;
330         int status;
331
332         /* We will always wait for a fraction of a second! */
333         do {
334                 usleep_range(250, 500);
335                 status = inb_p(SMBHSTSTS(priv));
336         } while (((status & SMBHSTSTS_HOST_BUSY) ||
337                   !(status & (STATUS_ERROR_FLAGS | SMBHSTSTS_INTR))) &&
338                  (timeout++ < MAX_RETRIES));
339
340         if (timeout > MAX_RETRIES) {
341                 dev_dbg(&priv->pci_dev->dev, "INTR Timeout!\n");
342                 return -ETIMEDOUT;
343         }
344         return status & (STATUS_ERROR_FLAGS | SMBHSTSTS_INTR);
345 }
346
347 /* Wait for either BYTE_DONE or an error flag being set */
348 static int i801_wait_byte_done(struct i801_priv *priv)
349 {
350         int timeout = 0;
351         int status;
352
353         /* We will always wait for a fraction of a second! */
354         do {
355                 usleep_range(250, 500);
356                 status = inb_p(SMBHSTSTS(priv));
357         } while (!(status & (STATUS_ERROR_FLAGS | SMBHSTSTS_BYTE_DONE)) &&
358                  (timeout++ < MAX_RETRIES));
359
360         if (timeout > MAX_RETRIES) {
361                 dev_dbg(&priv->pci_dev->dev, "BYTE_DONE Timeout!\n");
362                 return -ETIMEDOUT;
363         }
364         return status & STATUS_ERROR_FLAGS;
365 }
366
367 static int i801_transaction(struct i801_priv *priv, int xact)
368 {
369         int status;
370         int result;
371
372         result = i801_check_pre(priv);
373         if (result < 0)
374                 return result;
375
376         if (priv->features & FEATURE_IRQ) {
377                 outb_p(xact | SMBHSTCNT_INTREN | SMBHSTCNT_START,
378                        SMBHSTCNT(priv));
379                 wait_event(priv->waitq, (status = priv->status));
380                 priv->status = 0;
381                 return i801_check_post(priv, status);
382         }
383
384         /* the current contents of SMBHSTCNT can be overwritten, since PEC,
385          * SMBSCMD are passed in xact */
386         outb_p(xact | SMBHSTCNT_START, SMBHSTCNT(priv));
387
388         status = i801_wait_intr(priv);
389         return i801_check_post(priv, status);
390 }
391
392 static int i801_block_transaction_by_block(struct i801_priv *priv,
393                                            union i2c_smbus_data *data,
394                                            char read_write, int hwpec)
395 {
396         int i, len;
397         int status;
398
399         inb_p(SMBHSTCNT(priv)); /* reset the data buffer index */
400
401         /* Use 32-byte buffer to process this transaction */
402         if (read_write == I2C_SMBUS_WRITE) {
403                 len = data->block[0];
404                 outb_p(len, SMBHSTDAT0(priv));
405                 for (i = 0; i < len; i++)
406                         outb_p(data->block[i+1], SMBBLKDAT(priv));
407         }
408
409         status = i801_transaction(priv, I801_BLOCK_DATA |
410                                   (hwpec ? SMBHSTCNT_PEC_EN : 0));
411         if (status)
412                 return status;
413
414         if (read_write == I2C_SMBUS_READ) {
415                 len = inb_p(SMBHSTDAT0(priv));
416                 if (len < 1 || len > I2C_SMBUS_BLOCK_MAX)
417                         return -EPROTO;
418
419                 data->block[0] = len;
420                 for (i = 0; i < len; i++)
421                         data->block[i + 1] = inb_p(SMBBLKDAT(priv));
422         }
423         return 0;
424 }
425
426 static void i801_isr_byte_done(struct i801_priv *priv)
427 {
428         if (priv->is_read) {
429                 /* For SMBus block reads, length is received with first byte */
430                 if (((priv->cmd & 0x1c) == I801_BLOCK_DATA) &&
431                     (priv->count == 0)) {
432                         priv->len = inb_p(SMBHSTDAT0(priv));
433                         if (priv->len < 1 || priv->len > I2C_SMBUS_BLOCK_MAX) {
434                                 dev_err(&priv->pci_dev->dev,
435                                         "Illegal SMBus block read size %d\n",
436                                         priv->len);
437                                 /* FIXME: Recover */
438                                 priv->len = I2C_SMBUS_BLOCK_MAX;
439                         } else {
440                                 dev_dbg(&priv->pci_dev->dev,
441                                         "SMBus block read size is %d\n",
442                                         priv->len);
443                         }
444                         priv->data[-1] = priv->len;
445                 }
446
447                 /* Read next byte */
448                 if (priv->count < priv->len)
449                         priv->data[priv->count++] = inb(SMBBLKDAT(priv));
450                 else
451                         dev_dbg(&priv->pci_dev->dev,
452                                 "Discarding extra byte on block read\n");
453
454                 /* Set LAST_BYTE for last byte of read transaction */
455                 if (priv->count == priv->len - 1)
456                         outb_p(priv->cmd | SMBHSTCNT_LAST_BYTE,
457                                SMBHSTCNT(priv));
458         } else if (priv->count < priv->len - 1) {
459                 /* Write next byte, except for IRQ after last byte */
460                 outb_p(priv->data[++priv->count], SMBBLKDAT(priv));
461         }
462
463         /* Clear BYTE_DONE to continue with next byte */
464         outb_p(SMBHSTSTS_BYTE_DONE, SMBHSTSTS(priv));
465 }
466
467 /*
468  * There are two kinds of interrupts:
469  *
470  * 1) i801 signals transaction completion with one of these interrupts:
471  *      INTR - Success
472  *      DEV_ERR - Invalid command, NAK or communication timeout
473  *      BUS_ERR - SMI# transaction collision
474  *      FAILED - transaction was canceled due to a KILL request
475  *    When any of these occur, update ->status and wake up the waitq.
476  *    ->status must be cleared before kicking off the next transaction.
477  *
478  * 2) For byte-by-byte (I2C read/write) transactions, one BYTE_DONE interrupt
479  *    occurs for each byte of a byte-by-byte to prepare the next byte.
480  */
481 static irqreturn_t i801_isr(int irq, void *dev_id)
482 {
483         struct i801_priv *priv = dev_id;
484         u16 pcists;
485         u8 status;
486
487         /* Confirm this is our interrupt */
488         pci_read_config_word(priv->pci_dev, SMBPCISTS, &pcists);
489         if (!(pcists & SMBPCISTS_INTS))
490                 return IRQ_NONE;
491
492         status = inb_p(SMBHSTSTS(priv));
493         if (status != 0x42)
494                 dev_dbg(&priv->pci_dev->dev, "irq: status = %02x\n", status);
495
496         if (status & SMBHSTSTS_BYTE_DONE)
497                 i801_isr_byte_done(priv);
498
499         /*
500          * Clear irq sources and report transaction result.
501          * ->status must be cleared before the next transaction is started.
502          */
503         status &= SMBHSTSTS_INTR | STATUS_ERROR_FLAGS;
504         if (status) {
505                 outb_p(status, SMBHSTSTS(priv));
506                 priv->status |= status;
507                 wake_up(&priv->waitq);
508         }
509
510         return IRQ_HANDLED;
511 }
512
513 /*
514  * For "byte-by-byte" block transactions:
515  *   I2C write uses cmd=I801_BLOCK_DATA, I2C_EN=1
516  *   I2C read uses cmd=I801_I2C_BLOCK_DATA
517  */
518 static int i801_block_transaction_byte_by_byte(struct i801_priv *priv,
519                                                union i2c_smbus_data *data,
520                                                char read_write, int command,
521                                                int hwpec)
522 {
523         int i, len;
524         int smbcmd;
525         int status;
526         int result;
527
528         result = i801_check_pre(priv);
529         if (result < 0)
530                 return result;
531
532         len = data->block[0];
533
534         if (read_write == I2C_SMBUS_WRITE) {
535                 outb_p(len, SMBHSTDAT0(priv));
536                 outb_p(data->block[1], SMBBLKDAT(priv));
537         }
538
539         if (command == I2C_SMBUS_I2C_BLOCK_DATA &&
540             read_write == I2C_SMBUS_READ)
541                 smbcmd = I801_I2C_BLOCK_DATA;
542         else
543                 smbcmd = I801_BLOCK_DATA;
544
545         if (priv->features & FEATURE_IRQ) {
546                 priv->is_read = (read_write == I2C_SMBUS_READ);
547                 if (len == 1 && priv->is_read)
548                         smbcmd |= SMBHSTCNT_LAST_BYTE;
549                 priv->cmd = smbcmd | SMBHSTCNT_INTREN;
550                 priv->len = len;
551                 priv->count = 0;
552                 priv->data = &data->block[1];
553
554                 outb_p(priv->cmd | SMBHSTCNT_START, SMBHSTCNT(priv));
555                 wait_event(priv->waitq, (status = priv->status));
556                 priv->status = 0;
557                 return i801_check_post(priv, status);
558         }
559
560         for (i = 1; i <= len; i++) {
561                 if (i == len && read_write == I2C_SMBUS_READ)
562                         smbcmd |= SMBHSTCNT_LAST_BYTE;
563                 outb_p(smbcmd, SMBHSTCNT(priv));
564
565                 if (i == 1)
566                         outb_p(inb(SMBHSTCNT(priv)) | SMBHSTCNT_START,
567                                SMBHSTCNT(priv));
568
569                 status = i801_wait_byte_done(priv);
570                 if (status)
571                         goto exit;
572
573                 if (i == 1 && read_write == I2C_SMBUS_READ
574                  && command != I2C_SMBUS_I2C_BLOCK_DATA) {
575                         len = inb_p(SMBHSTDAT0(priv));
576                         if (len < 1 || len > I2C_SMBUS_BLOCK_MAX) {
577                                 dev_err(&priv->pci_dev->dev,
578                                         "Illegal SMBus block read size %d\n",
579                                         len);
580                                 /* Recover */
581                                 while (inb_p(SMBHSTSTS(priv)) &
582                                        SMBHSTSTS_HOST_BUSY)
583                                         outb_p(SMBHSTSTS_BYTE_DONE,
584                                                SMBHSTSTS(priv));
585                                 outb_p(SMBHSTSTS_INTR, SMBHSTSTS(priv));
586                                 return -EPROTO;
587                         }
588                         data->block[0] = len;
589                 }
590
591                 /* Retrieve/store value in SMBBLKDAT */
592                 if (read_write == I2C_SMBUS_READ)
593                         data->block[i] = inb_p(SMBBLKDAT(priv));
594                 if (read_write == I2C_SMBUS_WRITE && i+1 <= len)
595                         outb_p(data->block[i+1], SMBBLKDAT(priv));
596
597                 /* signals SMBBLKDAT ready */
598                 outb_p(SMBHSTSTS_BYTE_DONE, SMBHSTSTS(priv));
599         }
600
601         status = i801_wait_intr(priv);
602 exit:
603         return i801_check_post(priv, status);
604 }
605
606 static int i801_set_block_buffer_mode(struct i801_priv *priv)
607 {
608         outb_p(inb_p(SMBAUXCTL(priv)) | SMBAUXCTL_E32B, SMBAUXCTL(priv));
609         if ((inb_p(SMBAUXCTL(priv)) & SMBAUXCTL_E32B) == 0)
610                 return -EIO;
611         return 0;
612 }
613
614 /* Block transaction function */
615 static int i801_block_transaction(struct i801_priv *priv,
616                                   union i2c_smbus_data *data, char read_write,
617                                   int command, int hwpec)
618 {
619         int result = 0;
620         unsigned char hostc;
621
622         if (command == I2C_SMBUS_I2C_BLOCK_DATA) {
623                 if (read_write == I2C_SMBUS_WRITE) {
624                         /* set I2C_EN bit in configuration register */
625                         pci_read_config_byte(priv->pci_dev, SMBHSTCFG, &hostc);
626                         pci_write_config_byte(priv->pci_dev, SMBHSTCFG,
627                                               hostc | SMBHSTCFG_I2C_EN);
628                 } else if (!(priv->features & FEATURE_I2C_BLOCK_READ)) {
629                         dev_err(&priv->pci_dev->dev,
630                                 "I2C block read is unsupported!\n");
631                         return -EOPNOTSUPP;
632                 }
633         }
634
635         if (read_write == I2C_SMBUS_WRITE
636          || command == I2C_SMBUS_I2C_BLOCK_DATA) {
637                 if (data->block[0] < 1)
638                         data->block[0] = 1;
639                 if (data->block[0] > I2C_SMBUS_BLOCK_MAX)
640                         data->block[0] = I2C_SMBUS_BLOCK_MAX;
641         } else {
642                 data->block[0] = 32;    /* max for SMBus block reads */
643         }
644
645         /* Experience has shown that the block buffer can only be used for
646            SMBus (not I2C) block transactions, even though the datasheet
647            doesn't mention this limitation. */
648         if ((priv->features & FEATURE_BLOCK_BUFFER)
649          && command != I2C_SMBUS_I2C_BLOCK_DATA
650          && i801_set_block_buffer_mode(priv) == 0)
651                 result = i801_block_transaction_by_block(priv, data,
652                                                          read_write, hwpec);
653         else
654                 result = i801_block_transaction_byte_by_byte(priv, data,
655                                                              read_write,
656                                                              command, hwpec);
657
658         if (command == I2C_SMBUS_I2C_BLOCK_DATA
659          && read_write == I2C_SMBUS_WRITE) {
660                 /* restore saved configuration register value */
661                 pci_write_config_byte(priv->pci_dev, SMBHSTCFG, hostc);
662         }
663         return result;
664 }
665
666 /* Return negative errno on error. */
667 static s32 i801_access(struct i2c_adapter *adap, u16 addr,
668                        unsigned short flags, char read_write, u8 command,
669                        int size, union i2c_smbus_data *data)
670 {
671         int hwpec;
672         int block = 0;
673         int ret, xact = 0;
674         struct i801_priv *priv = i2c_get_adapdata(adap);
675
676         hwpec = (priv->features & FEATURE_SMBUS_PEC) && (flags & I2C_CLIENT_PEC)
677                 && size != I2C_SMBUS_QUICK
678                 && size != I2C_SMBUS_I2C_BLOCK_DATA;
679
680         switch (size) {
681         case I2C_SMBUS_QUICK:
682                 outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
683                        SMBHSTADD(priv));
684                 xact = I801_QUICK;
685                 break;
686         case I2C_SMBUS_BYTE:
687                 outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
688                        SMBHSTADD(priv));
689                 if (read_write == I2C_SMBUS_WRITE)
690                         outb_p(command, SMBHSTCMD(priv));
691                 xact = I801_BYTE;
692                 break;
693         case I2C_SMBUS_BYTE_DATA:
694                 outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
695                        SMBHSTADD(priv));
696                 outb_p(command, SMBHSTCMD(priv));
697                 if (read_write == I2C_SMBUS_WRITE)
698                         outb_p(data->byte, SMBHSTDAT0(priv));
699                 xact = I801_BYTE_DATA;
700                 break;
701         case I2C_SMBUS_WORD_DATA:
702                 outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
703                        SMBHSTADD(priv));
704                 outb_p(command, SMBHSTCMD(priv));
705                 if (read_write == I2C_SMBUS_WRITE) {
706                         outb_p(data->word & 0xff, SMBHSTDAT0(priv));
707                         outb_p((data->word & 0xff00) >> 8, SMBHSTDAT1(priv));
708                 }
709                 xact = I801_WORD_DATA;
710                 break;
711         case I2C_SMBUS_BLOCK_DATA:
712                 outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
713                        SMBHSTADD(priv));
714                 outb_p(command, SMBHSTCMD(priv));
715                 block = 1;
716                 break;
717         case I2C_SMBUS_I2C_BLOCK_DATA:
718                 /* NB: page 240 of ICH5 datasheet shows that the R/#W
719                  * bit should be cleared here, even when reading */
720                 outb_p((addr & 0x7f) << 1, SMBHSTADD(priv));
721                 if (read_write == I2C_SMBUS_READ) {
722                         /* NB: page 240 of ICH5 datasheet also shows
723                          * that DATA1 is the cmd field when reading */
724                         outb_p(command, SMBHSTDAT1(priv));
725                 } else
726                         outb_p(command, SMBHSTCMD(priv));
727                 block = 1;
728                 break;
729         default:
730                 dev_err(&priv->pci_dev->dev, "Unsupported transaction %d\n",
731                         size);
732                 return -EOPNOTSUPP;
733         }
734
735         if (hwpec)      /* enable/disable hardware PEC */
736                 outb_p(inb_p(SMBAUXCTL(priv)) | SMBAUXCTL_CRC, SMBAUXCTL(priv));
737         else
738                 outb_p(inb_p(SMBAUXCTL(priv)) & (~SMBAUXCTL_CRC),
739                        SMBAUXCTL(priv));
740
741         if (block)
742                 ret = i801_block_transaction(priv, data, read_write, size,
743                                              hwpec);
744         else
745                 ret = i801_transaction(priv, xact);
746
747         /* Some BIOSes don't like it when PEC is enabled at reboot or resume
748            time, so we forcibly disable it after every transaction. Turn off
749            E32B for the same reason. */
750         if (hwpec || block)
751                 outb_p(inb_p(SMBAUXCTL(priv)) &
752                        ~(SMBAUXCTL_CRC | SMBAUXCTL_E32B), SMBAUXCTL(priv));
753
754         if (block)
755                 return ret;
756         if (ret)
757                 return ret;
758         if ((read_write == I2C_SMBUS_WRITE) || (xact == I801_QUICK))
759                 return 0;
760
761         switch (xact & 0x7f) {
762         case I801_BYTE: /* Result put in SMBHSTDAT0 */
763         case I801_BYTE_DATA:
764                 data->byte = inb_p(SMBHSTDAT0(priv));
765                 break;
766         case I801_WORD_DATA:
767                 data->word = inb_p(SMBHSTDAT0(priv)) +
768                              (inb_p(SMBHSTDAT1(priv)) << 8);
769                 break;
770         }
771         return 0;
772 }
773
774
775 static u32 i801_func(struct i2c_adapter *adapter)
776 {
777         struct i801_priv *priv = i2c_get_adapdata(adapter);
778
779         return I2C_FUNC_SMBUS_QUICK | I2C_FUNC_SMBUS_BYTE |
780                I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA |
781                I2C_FUNC_SMBUS_BLOCK_DATA | I2C_FUNC_SMBUS_WRITE_I2C_BLOCK |
782                ((priv->features & FEATURE_SMBUS_PEC) ? I2C_FUNC_SMBUS_PEC : 0) |
783                ((priv->features & FEATURE_I2C_BLOCK_READ) ?
784                 I2C_FUNC_SMBUS_READ_I2C_BLOCK : 0);
785 }
786
787 static const struct i2c_algorithm smbus_algorithm = {
788         .smbus_xfer     = i801_access,
789         .functionality  = i801_func,
790 };
791
792 static DEFINE_PCI_DEVICE_TABLE(i801_ids) = {
793         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801AA_3) },
794         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801AB_3) },
795         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801BA_2) },
796         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801CA_3) },
797         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801DB_3) },
798         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801EB_3) },
799         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ESB_4) },
800         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH6_16) },
801         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH7_17) },
802         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ESB2_17) },
803         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH8_5) },
804         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH9_6) },
805         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_EP80579_1) },
806         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH10_4) },
807         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH10_5) },
808         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_5_3400_SERIES_SMBUS) },
809         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_COUGARPOINT_SMBUS) },
810         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS) },
811         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS_IDF0) },
812         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS_IDF1) },
813         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS_IDF2) },
814         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_DH89XXCC_SMBUS) },
815         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_PANTHERPOINT_SMBUS) },
816         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_LYNXPOINT_SMBUS) },
817         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_SMBUS) },
818         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_AVOTON_SMBUS) },
819         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS) },
820         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS_MS0) },
821         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS_MS1) },
822         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS_MS2) },
823         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_COLETOCREEK_SMBUS) },
824         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_WILDCATPOINT_LP_SMBUS) },
825         { 0, }
826 };
827
828 MODULE_DEVICE_TABLE(pci, i801_ids);
829
830 #if defined CONFIG_X86 && defined CONFIG_DMI
831 static unsigned char apanel_addr;
832
833 /* Scan the system ROM for the signature "FJKEYINF" */
834 static __init const void __iomem *bios_signature(const void __iomem *bios)
835 {
836         ssize_t offset;
837         const unsigned char signature[] = "FJKEYINF";
838
839         for (offset = 0; offset < 0x10000; offset += 0x10) {
840                 if (check_signature(bios + offset, signature,
841                                     sizeof(signature)-1))
842                         return bios + offset;
843         }
844         return NULL;
845 }
846
847 static void __init input_apanel_init(void)
848 {
849         void __iomem *bios;
850         const void __iomem *p;
851
852         bios = ioremap(0xF0000, 0x10000); /* Can't fail */
853         p = bios_signature(bios);
854         if (p) {
855                 /* just use the first address */
856                 apanel_addr = readb(p + 8 + 3) >> 1;
857         }
858         iounmap(bios);
859 }
860
861 struct dmi_onboard_device_info {
862         const char *name;
863         u8 type;
864         unsigned short i2c_addr;
865         const char *i2c_type;
866 };
867
868 static const struct dmi_onboard_device_info dmi_devices[] = {
869         { "Syleus", DMI_DEV_TYPE_OTHER, 0x73, "fscsyl" },
870         { "Hermes", DMI_DEV_TYPE_OTHER, 0x73, "fscher" },
871         { "Hades",  DMI_DEV_TYPE_OTHER, 0x73, "fschds" },
872 };
873
874 static void dmi_check_onboard_device(u8 type, const char *name,
875                                      struct i2c_adapter *adap)
876 {
877         int i;
878         struct i2c_board_info info;
879
880         for (i = 0; i < ARRAY_SIZE(dmi_devices); i++) {
881                 /* & ~0x80, ignore enabled/disabled bit */
882                 if ((type & ~0x80) != dmi_devices[i].type)
883                         continue;
884                 if (strcasecmp(name, dmi_devices[i].name))
885                         continue;
886
887                 memset(&info, 0, sizeof(struct i2c_board_info));
888                 info.addr = dmi_devices[i].i2c_addr;
889                 strlcpy(info.type, dmi_devices[i].i2c_type, I2C_NAME_SIZE);
890                 i2c_new_device(adap, &info);
891                 break;
892         }
893 }
894
895 /* We use our own function to check for onboard devices instead of
896    dmi_find_device() as some buggy BIOS's have the devices we are interested
897    in marked as disabled */
898 static void dmi_check_onboard_devices(const struct dmi_header *dm, void *adap)
899 {
900         int i, count;
901
902         if (dm->type != 10)
903                 return;
904
905         count = (dm->length - sizeof(struct dmi_header)) / 2;
906         for (i = 0; i < count; i++) {
907                 const u8 *d = (char *)(dm + 1) + (i * 2);
908                 const char *name = ((char *) dm) + dm->length;
909                 u8 type = d[0];
910                 u8 s = d[1];
911
912                 if (!s)
913                         continue;
914                 s--;
915                 while (s > 0 && name[0]) {
916                         name += strlen(name) + 1;
917                         s--;
918                 }
919                 if (name[0] == 0) /* Bogus string reference */
920                         continue;
921
922                 dmi_check_onboard_device(type, name, adap);
923         }
924 }
925
926 /* Register optional slaves */
927 static void i801_probe_optional_slaves(struct i801_priv *priv)
928 {
929         /* Only register slaves on main SMBus channel */
930         if (priv->features & FEATURE_IDF)
931                 return;
932
933         if (apanel_addr) {
934                 struct i2c_board_info info;
935
936                 memset(&info, 0, sizeof(struct i2c_board_info));
937                 info.addr = apanel_addr;
938                 strlcpy(info.type, "fujitsu_apanel", I2C_NAME_SIZE);
939                 i2c_new_device(&priv->adapter, &info);
940         }
941
942         if (dmi_name_in_vendors("FUJITSU"))
943                 dmi_walk(dmi_check_onboard_devices, &priv->adapter);
944 }
945 #else
946 static void __init input_apanel_init(void) {}
947 static void i801_probe_optional_slaves(struct i801_priv *priv) {}
948 #endif  /* CONFIG_X86 && CONFIG_DMI */
949
950 #if (defined CONFIG_I2C_MUX_GPIO || defined CONFIG_I2C_MUX_GPIO_MODULE) && \
951                 defined CONFIG_DMI
952 static struct i801_mux_config i801_mux_config_asus_z8_d12 = {
953         .gpio_chip = "gpio_ich",
954         .values = { 0x02, 0x03 },
955         .n_values = 2,
956         .classes = { I2C_CLASS_SPD, I2C_CLASS_SPD },
957         .gpios = { 52, 53 },
958         .n_gpios = 2,
959 };
960
961 static struct i801_mux_config i801_mux_config_asus_z8_d18 = {
962         .gpio_chip = "gpio_ich",
963         .values = { 0x02, 0x03, 0x01 },
964         .n_values = 3,
965         .classes = { I2C_CLASS_SPD, I2C_CLASS_SPD, I2C_CLASS_SPD },
966         .gpios = { 52, 53 },
967         .n_gpios = 2,
968 };
969
970 static const struct dmi_system_id mux_dmi_table[] = {
971         {
972                 .matches = {
973                         DMI_MATCH(DMI_BOARD_VENDOR, "ASUSTeK Computer INC."),
974                         DMI_MATCH(DMI_BOARD_NAME, "Z8NA-D6(C)"),
975                 },
976                 .driver_data = &i801_mux_config_asus_z8_d12,
977         },
978         {
979                 .matches = {
980                         DMI_MATCH(DMI_BOARD_VENDOR, "ASUSTeK Computer INC."),
981                         DMI_MATCH(DMI_BOARD_NAME, "Z8P(N)E-D12(X)"),
982                 },
983                 .driver_data = &i801_mux_config_asus_z8_d12,
984         },
985         {
986                 .matches = {
987                         DMI_MATCH(DMI_BOARD_VENDOR, "ASUSTeK Computer INC."),
988                         DMI_MATCH(DMI_BOARD_NAME, "Z8NH-D12"),
989                 },
990                 .driver_data = &i801_mux_config_asus_z8_d12,
991         },
992         {
993                 .matches = {
994                         DMI_MATCH(DMI_BOARD_VENDOR, "ASUSTeK Computer INC."),
995                         DMI_MATCH(DMI_BOARD_NAME, "Z8PH-D12/IFB"),
996                 },
997                 .driver_data = &i801_mux_config_asus_z8_d12,
998         },
999         {
1000                 .matches = {
1001                         DMI_MATCH(DMI_BOARD_VENDOR, "ASUSTeK Computer INC."),
1002                         DMI_MATCH(DMI_BOARD_NAME, "Z8NR-D12"),
1003                 },
1004                 .driver_data = &i801_mux_config_asus_z8_d12,
1005         },
1006         {
1007                 .matches = {
1008                         DMI_MATCH(DMI_BOARD_VENDOR, "ASUSTeK Computer INC."),
1009                         DMI_MATCH(DMI_BOARD_NAME, "Z8P(N)H-D12"),
1010                 },
1011                 .driver_data = &i801_mux_config_asus_z8_d12,
1012         },
1013         {
1014                 .matches = {
1015                         DMI_MATCH(DMI_BOARD_VENDOR, "ASUSTeK Computer INC."),
1016                         DMI_MATCH(DMI_BOARD_NAME, "Z8PG-D18"),
1017                 },
1018                 .driver_data = &i801_mux_config_asus_z8_d18,
1019         },
1020         {
1021                 .matches = {
1022                         DMI_MATCH(DMI_BOARD_VENDOR, "ASUSTeK Computer INC."),
1023                         DMI_MATCH(DMI_BOARD_NAME, "Z8PE-D18"),
1024                 },
1025                 .driver_data = &i801_mux_config_asus_z8_d18,
1026         },
1027         {
1028                 .matches = {
1029                         DMI_MATCH(DMI_BOARD_VENDOR, "ASUSTeK Computer INC."),
1030                         DMI_MATCH(DMI_BOARD_NAME, "Z8PS-D12"),
1031                 },
1032                 .driver_data = &i801_mux_config_asus_z8_d12,
1033         },
1034         { }
1035 };
1036
1037 /* Setup multiplexing if needed */
1038 static int i801_add_mux(struct i801_priv *priv)
1039 {
1040         struct device *dev = &priv->adapter.dev;
1041         const struct i801_mux_config *mux_config;
1042         struct i2c_mux_gpio_platform_data gpio_data;
1043         int err;
1044
1045         if (!priv->mux_drvdata)
1046                 return 0;
1047         mux_config = priv->mux_drvdata;
1048
1049         /* Prepare the platform data */
1050         memset(&gpio_data, 0, sizeof(struct i2c_mux_gpio_platform_data));
1051         gpio_data.parent = priv->adapter.nr;
1052         gpio_data.values = mux_config->values;
1053         gpio_data.n_values = mux_config->n_values;
1054         gpio_data.classes = mux_config->classes;
1055         gpio_data.gpio_chip = mux_config->gpio_chip;
1056         gpio_data.gpios = mux_config->gpios;
1057         gpio_data.n_gpios = mux_config->n_gpios;
1058         gpio_data.idle = I2C_MUX_GPIO_NO_IDLE;
1059
1060         /* Register the mux device */
1061         priv->mux_pdev = platform_device_register_data(dev, "i2c-mux-gpio",
1062                                 PLATFORM_DEVID_AUTO, &gpio_data,
1063                                 sizeof(struct i2c_mux_gpio_platform_data));
1064         if (IS_ERR(priv->mux_pdev)) {
1065                 err = PTR_ERR(priv->mux_pdev);
1066                 priv->mux_pdev = NULL;
1067                 dev_err(dev, "Failed to register i2c-mux-gpio device\n");
1068                 return err;
1069         }
1070
1071         return 0;
1072 }
1073
1074 static void i801_del_mux(struct i801_priv *priv)
1075 {
1076         if (priv->mux_pdev)
1077                 platform_device_unregister(priv->mux_pdev);
1078 }
1079
1080 static unsigned int i801_get_adapter_class(struct i801_priv *priv)
1081 {
1082         const struct dmi_system_id *id;
1083         const struct i801_mux_config *mux_config;
1084         unsigned int class = I2C_CLASS_HWMON | I2C_CLASS_SPD;
1085         int i;
1086
1087         id = dmi_first_match(mux_dmi_table);
1088         if (id) {
1089                 /* Remove branch classes from trunk */
1090                 mux_config = id->driver_data;
1091                 for (i = 0; i < mux_config->n_values; i++)
1092                         class &= ~mux_config->classes[i];
1093
1094                 /* Remember for later */
1095                 priv->mux_drvdata = mux_config;
1096         }
1097
1098         return class;
1099 }
1100 #else
1101 static inline int i801_add_mux(struct i801_priv *priv) { return 0; }
1102 static inline void i801_del_mux(struct i801_priv *priv) { }
1103
1104 static inline unsigned int i801_get_adapter_class(struct i801_priv *priv)
1105 {
1106         return I2C_CLASS_HWMON | I2C_CLASS_SPD;
1107 }
1108 #endif
1109
1110 static int i801_probe(struct pci_dev *dev, const struct pci_device_id *id)
1111 {
1112         unsigned char temp;
1113         int err, i;
1114         struct i801_priv *priv;
1115
1116         priv = kzalloc(sizeof(*priv), GFP_KERNEL);
1117         if (!priv)
1118                 return -ENOMEM;
1119
1120         i2c_set_adapdata(&priv->adapter, priv);
1121         priv->adapter.owner = THIS_MODULE;
1122         priv->adapter.class = i801_get_adapter_class(priv);
1123         priv->adapter.algo = &smbus_algorithm;
1124
1125         priv->pci_dev = dev;
1126         switch (dev->device) {
1127         case PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS_IDF0:
1128         case PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS_IDF1:
1129         case PCI_DEVICE_ID_INTEL_PATSBURG_SMBUS_IDF2:
1130         case PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS_MS0:
1131         case PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS_MS1:
1132         case PCI_DEVICE_ID_INTEL_WELLSBURG_SMBUS_MS2:
1133                 priv->features |= FEATURE_IDF;
1134                 /* fall through */
1135         default:
1136                 priv->features |= FEATURE_I2C_BLOCK_READ;
1137                 priv->features |= FEATURE_IRQ;
1138                 /* fall through */
1139         case PCI_DEVICE_ID_INTEL_82801DB_3:
1140                 priv->features |= FEATURE_SMBUS_PEC;
1141                 priv->features |= FEATURE_BLOCK_BUFFER;
1142                 /* fall through */
1143         case PCI_DEVICE_ID_INTEL_82801CA_3:
1144         case PCI_DEVICE_ID_INTEL_82801BA_2:
1145         case PCI_DEVICE_ID_INTEL_82801AB_3:
1146         case PCI_DEVICE_ID_INTEL_82801AA_3:
1147                 break;
1148         }
1149
1150         /* Disable features on user request */
1151         for (i = 0; i < ARRAY_SIZE(i801_feature_names); i++) {
1152                 if (priv->features & disable_features & (1 << i))
1153                         dev_notice(&dev->dev, "%s disabled by user\n",
1154                                    i801_feature_names[i]);
1155         }
1156         priv->features &= ~disable_features;
1157
1158         err = pci_enable_device(dev);
1159         if (err) {
1160                 dev_err(&dev->dev, "Failed to enable SMBus PCI device (%d)\n",
1161                         err);
1162                 goto exit;
1163         }
1164
1165         /* Determine the address of the SMBus area */
1166         priv->smba = pci_resource_start(dev, SMBBAR);
1167         if (!priv->smba) {
1168                 dev_err(&dev->dev, "SMBus base address uninitialized, "
1169                         "upgrade BIOS\n");
1170                 err = -ENODEV;
1171                 goto exit;
1172         }
1173
1174         err = acpi_check_resource_conflict(&dev->resource[SMBBAR]);
1175         if (err) {
1176                 err = -ENODEV;
1177                 goto exit;
1178         }
1179
1180         err = pci_request_region(dev, SMBBAR, i801_driver.name);
1181         if (err) {
1182                 dev_err(&dev->dev, "Failed to request SMBus region "
1183                         "0x%lx-0x%Lx\n", priv->smba,
1184                         (unsigned long long)pci_resource_end(dev, SMBBAR));
1185                 goto exit;
1186         }
1187
1188         pci_read_config_byte(priv->pci_dev, SMBHSTCFG, &temp);
1189         priv->original_hstcfg = temp;
1190         temp &= ~SMBHSTCFG_I2C_EN;      /* SMBus timing */
1191         if (!(temp & SMBHSTCFG_HST_EN)) {
1192                 dev_info(&dev->dev, "Enabling SMBus device\n");
1193                 temp |= SMBHSTCFG_HST_EN;
1194         }
1195         pci_write_config_byte(priv->pci_dev, SMBHSTCFG, temp);
1196
1197         if (temp & SMBHSTCFG_SMB_SMI_EN) {
1198                 dev_dbg(&dev->dev, "SMBus using interrupt SMI#\n");
1199                 /* Disable SMBus interrupt feature if SMBus using SMI# */
1200                 priv->features &= ~FEATURE_IRQ;
1201         }
1202
1203         /* Clear special mode bits */
1204         if (priv->features & (FEATURE_SMBUS_PEC | FEATURE_BLOCK_BUFFER))
1205                 outb_p(inb_p(SMBAUXCTL(priv)) &
1206                        ~(SMBAUXCTL_CRC | SMBAUXCTL_E32B), SMBAUXCTL(priv));
1207
1208         if (priv->features & FEATURE_IRQ) {
1209                 init_waitqueue_head(&priv->waitq);
1210
1211                 err = request_irq(dev->irq, i801_isr, IRQF_SHARED,
1212                                   i801_driver.name, priv);
1213                 if (err) {
1214                         dev_err(&dev->dev, "Failed to allocate irq %d: %d\n",
1215                                 dev->irq, err);
1216                         goto exit_release;
1217                 }
1218                 dev_info(&dev->dev, "SMBus using PCI Interrupt\n");
1219         }
1220
1221         /* set up the sysfs linkage to our parent device */
1222         priv->adapter.dev.parent = &dev->dev;
1223
1224         /* Retry up to 3 times on lost arbitration */
1225         priv->adapter.retries = 3;
1226
1227         snprintf(priv->adapter.name, sizeof(priv->adapter.name),
1228                 "SMBus I801 adapter at %04lx", priv->smba);
1229         err = i2c_add_adapter(&priv->adapter);
1230         if (err) {
1231                 dev_err(&dev->dev, "Failed to add SMBus adapter\n");
1232                 goto exit_free_irq;
1233         }
1234
1235         i801_probe_optional_slaves(priv);
1236         /* We ignore errors - multiplexing is optional */
1237         i801_add_mux(priv);
1238
1239         pci_set_drvdata(dev, priv);
1240
1241         return 0;
1242
1243 exit_free_irq:
1244         if (priv->features & FEATURE_IRQ)
1245                 free_irq(dev->irq, priv);
1246 exit_release:
1247         pci_release_region(dev, SMBBAR);
1248 exit:
1249         kfree(priv);
1250         return err;
1251 }
1252
1253 static void i801_remove(struct pci_dev *dev)
1254 {
1255         struct i801_priv *priv = pci_get_drvdata(dev);
1256
1257         i801_del_mux(priv);
1258         i2c_del_adapter(&priv->adapter);
1259         pci_write_config_byte(dev, SMBHSTCFG, priv->original_hstcfg);
1260
1261         if (priv->features & FEATURE_IRQ)
1262                 free_irq(dev->irq, priv);
1263         pci_release_region(dev, SMBBAR);
1264
1265         kfree(priv);
1266         /*
1267          * do not call pci_disable_device(dev) since it can cause hard hangs on
1268          * some systems during power-off (eg. Fujitsu-Siemens Lifebook E8010)
1269          */
1270 }
1271
1272 #ifdef CONFIG_PM
1273 static int i801_suspend(struct pci_dev *dev, pm_message_t mesg)
1274 {
1275         struct i801_priv *priv = pci_get_drvdata(dev);
1276
1277         pci_save_state(dev);
1278         pci_write_config_byte(dev, SMBHSTCFG, priv->original_hstcfg);
1279         pci_set_power_state(dev, pci_choose_state(dev, mesg));
1280         return 0;
1281 }
1282
1283 static int i801_resume(struct pci_dev *dev)
1284 {
1285         pci_set_power_state(dev, PCI_D0);
1286         pci_restore_state(dev);
1287         return pci_enable_device(dev);
1288 }
1289 #else
1290 #define i801_suspend NULL
1291 #define i801_resume NULL
1292 #endif
1293
1294 static struct pci_driver i801_driver = {
1295         .name           = "i801_smbus",
1296         .id_table       = i801_ids,
1297         .probe          = i801_probe,
1298         .remove         = i801_remove,
1299         .suspend        = i801_suspend,
1300         .resume         = i801_resume,
1301 };
1302
1303 static int __init i2c_i801_init(void)
1304 {
1305         if (dmi_name_in_vendors("FUJITSU"))
1306                 input_apanel_init();
1307         return pci_register_driver(&i801_driver);
1308 }
1309
1310 static void __exit i2c_i801_exit(void)
1311 {
1312         pci_unregister_driver(&i801_driver);
1313 }
1314
1315 MODULE_AUTHOR("Mark D. Studebaker <mdsxyz123@yahoo.com>, "
1316               "Jean Delvare <khali@linux-fr.org>");
1317 MODULE_DESCRIPTION("I801 SMBus driver");
1318 MODULE_LICENSE("GPL");
1319
1320 module_init(i2c_i801_init);
1321 module_exit(i2c_i801_exit);