Merge branch 'linux-linaro-lsk-v4.4-android' of git://git.linaro.org/kernel/linux...
[firefly-linux-kernel-4.4.55.git] / drivers / input / serio / i8042.c
1 /*
2  *  i8042 keyboard and mouse controller driver for Linux
3  *
4  *  Copyright (c) 1999-2004 Vojtech Pavlik
5  */
6
7 /*
8  * This program is free software; you can redistribute it and/or modify it
9  * under the terms of the GNU General Public License version 2 as published by
10  * the Free Software Foundation.
11  */
12
13 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
14
15 #include <linux/types.h>
16 #include <linux/delay.h>
17 #include <linux/module.h>
18 #include <linux/interrupt.h>
19 #include <linux/ioport.h>
20 #include <linux/init.h>
21 #include <linux/serio.h>
22 #include <linux/err.h>
23 #include <linux/rcupdate.h>
24 #include <linux/platform_device.h>
25 #include <linux/i8042.h>
26 #include <linux/slab.h>
27 #include <linux/suspend.h>
28
29 #include <asm/io.h>
30
31 MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>");
32 MODULE_DESCRIPTION("i8042 keyboard and mouse controller driver");
33 MODULE_LICENSE("GPL");
34
35 static bool i8042_nokbd;
36 module_param_named(nokbd, i8042_nokbd, bool, 0);
37 MODULE_PARM_DESC(nokbd, "Do not probe or use KBD port.");
38
39 static bool i8042_noaux;
40 module_param_named(noaux, i8042_noaux, bool, 0);
41 MODULE_PARM_DESC(noaux, "Do not probe or use AUX (mouse) port.");
42
43 static bool i8042_nomux;
44 module_param_named(nomux, i8042_nomux, bool, 0);
45 MODULE_PARM_DESC(nomux, "Do not check whether an active multiplexing controller is present.");
46
47 static bool i8042_unlock;
48 module_param_named(unlock, i8042_unlock, bool, 0);
49 MODULE_PARM_DESC(unlock, "Ignore keyboard lock.");
50
51 enum i8042_controller_reset_mode {
52         I8042_RESET_NEVER,
53         I8042_RESET_ALWAYS,
54         I8042_RESET_ON_S2RAM,
55 #define I8042_RESET_DEFAULT     I8042_RESET_ON_S2RAM
56 };
57 static enum i8042_controller_reset_mode i8042_reset = I8042_RESET_DEFAULT;
58 static int i8042_set_reset(const char *val, const struct kernel_param *kp)
59 {
60         enum i8042_controller_reset_mode *arg = kp->arg;
61         int error;
62         bool reset;
63
64         if (val) {
65                 error = kstrtobool(val, &reset);
66                 if (error)
67                         return error;
68         } else {
69                 reset = true;
70         }
71
72         *arg = reset ? I8042_RESET_ALWAYS : I8042_RESET_NEVER;
73         return 0;
74 }
75
76 static const struct kernel_param_ops param_ops_reset_param = {
77         .flags = KERNEL_PARAM_OPS_FL_NOARG,
78         .set = i8042_set_reset,
79 };
80 #define param_check_reset_param(name, p)        \
81         __param_check(name, p, enum i8042_controller_reset_mode)
82 module_param_named(reset, i8042_reset, reset_param, 0);
83 MODULE_PARM_DESC(reset, "Reset controller on resume, cleanup or both");
84
85 static bool i8042_direct;
86 module_param_named(direct, i8042_direct, bool, 0);
87 MODULE_PARM_DESC(direct, "Put keyboard port into non-translated mode.");
88
89 static bool i8042_dumbkbd;
90 module_param_named(dumbkbd, i8042_dumbkbd, bool, 0);
91 MODULE_PARM_DESC(dumbkbd, "Pretend that controller can only read data from keyboard");
92
93 static bool i8042_noloop;
94 module_param_named(noloop, i8042_noloop, bool, 0);
95 MODULE_PARM_DESC(noloop, "Disable the AUX Loopback command while probing for the AUX port");
96
97 static bool i8042_notimeout;
98 module_param_named(notimeout, i8042_notimeout, bool, 0);
99 MODULE_PARM_DESC(notimeout, "Ignore timeouts signalled by i8042");
100
101 static bool i8042_kbdreset;
102 module_param_named(kbdreset, i8042_kbdreset, bool, 0);
103 MODULE_PARM_DESC(kbdreset, "Reset device connected to KBD port");
104
105 #ifdef CONFIG_X86
106 static bool i8042_dritek;
107 module_param_named(dritek, i8042_dritek, bool, 0);
108 MODULE_PARM_DESC(dritek, "Force enable the Dritek keyboard extension");
109 #endif
110
111 #ifdef CONFIG_PNP
112 static bool i8042_nopnp;
113 module_param_named(nopnp, i8042_nopnp, bool, 0);
114 MODULE_PARM_DESC(nopnp, "Do not use PNP to detect controller settings");
115 #endif
116
117 #define DEBUG
118 #ifdef DEBUG
119 static bool i8042_debug;
120 module_param_named(debug, i8042_debug, bool, 0600);
121 MODULE_PARM_DESC(debug, "Turn i8042 debugging mode on and off");
122
123 static bool i8042_unmask_kbd_data;
124 module_param_named(unmask_kbd_data, i8042_unmask_kbd_data, bool, 0600);
125 MODULE_PARM_DESC(unmask_kbd_data, "Unconditional enable (may reveal sensitive data) of normally sanitize-filtered kbd data traffic debug log [pre-condition: i8042.debug=1 enabled]");
126 #endif
127
128 static bool i8042_bypass_aux_irq_test;
129 static char i8042_kbd_firmware_id[128];
130 static char i8042_aux_firmware_id[128];
131
132 #include "i8042.h"
133
134 /*
135  * i8042_lock protects serialization between i8042_command and
136  * the interrupt handler.
137  */
138 static DEFINE_SPINLOCK(i8042_lock);
139
140 /*
141  * Writers to AUX and KBD ports as well as users issuing i8042_command
142  * directly should acquire i8042_mutex (by means of calling
143  * i8042_lock_chip() and i8042_unlock_ship() helpers) to ensure that
144  * they do not disturb each other (unfortunately in many i8042
145  * implementations write to one of the ports will immediately abort
146  * command that is being processed by another port).
147  */
148 static DEFINE_MUTEX(i8042_mutex);
149
150 struct i8042_port {
151         struct serio *serio;
152         int irq;
153         bool exists;
154         bool driver_bound;
155         signed char mux;
156 };
157
158 #define I8042_KBD_PORT_NO       0
159 #define I8042_AUX_PORT_NO       1
160 #define I8042_MUX_PORT_NO       2
161 #define I8042_NUM_PORTS         (I8042_NUM_MUX_PORTS + 2)
162
163 static struct i8042_port i8042_ports[I8042_NUM_PORTS];
164
165 static unsigned char i8042_initial_ctr;
166 static unsigned char i8042_ctr;
167 static bool i8042_mux_present;
168 static bool i8042_kbd_irq_registered;
169 static bool i8042_aux_irq_registered;
170 static unsigned char i8042_suppress_kbd_ack;
171 static struct platform_device *i8042_platform_device;
172 static struct notifier_block i8042_kbd_bind_notifier_block;
173
174 static irqreturn_t i8042_interrupt(int irq, void *dev_id);
175 static bool (*i8042_platform_filter)(unsigned char data, unsigned char str,
176                                      struct serio *serio);
177
178 void i8042_lock_chip(void)
179 {
180         mutex_lock(&i8042_mutex);
181 }
182 EXPORT_SYMBOL(i8042_lock_chip);
183
184 void i8042_unlock_chip(void)
185 {
186         mutex_unlock(&i8042_mutex);
187 }
188 EXPORT_SYMBOL(i8042_unlock_chip);
189
190 int i8042_install_filter(bool (*filter)(unsigned char data, unsigned char str,
191                                         struct serio *serio))
192 {
193         unsigned long flags;
194         int ret = 0;
195
196         spin_lock_irqsave(&i8042_lock, flags);
197
198         if (i8042_platform_filter) {
199                 ret = -EBUSY;
200                 goto out;
201         }
202
203         i8042_platform_filter = filter;
204
205 out:
206         spin_unlock_irqrestore(&i8042_lock, flags);
207         return ret;
208 }
209 EXPORT_SYMBOL(i8042_install_filter);
210
211 int i8042_remove_filter(bool (*filter)(unsigned char data, unsigned char str,
212                                        struct serio *port))
213 {
214         unsigned long flags;
215         int ret = 0;
216
217         spin_lock_irqsave(&i8042_lock, flags);
218
219         if (i8042_platform_filter != filter) {
220                 ret = -EINVAL;
221                 goto out;
222         }
223
224         i8042_platform_filter = NULL;
225
226 out:
227         spin_unlock_irqrestore(&i8042_lock, flags);
228         return ret;
229 }
230 EXPORT_SYMBOL(i8042_remove_filter);
231
232 /*
233  * The i8042_wait_read() and i8042_wait_write functions wait for the i8042 to
234  * be ready for reading values from it / writing values to it.
235  * Called always with i8042_lock held.
236  */
237
238 static int i8042_wait_read(void)
239 {
240         int i = 0;
241
242         while ((~i8042_read_status() & I8042_STR_OBF) && (i < I8042_CTL_TIMEOUT)) {
243                 udelay(50);
244                 i++;
245         }
246         return -(i == I8042_CTL_TIMEOUT);
247 }
248
249 static int i8042_wait_write(void)
250 {
251         int i = 0;
252
253         while ((i8042_read_status() & I8042_STR_IBF) && (i < I8042_CTL_TIMEOUT)) {
254                 udelay(50);
255                 i++;
256         }
257         return -(i == I8042_CTL_TIMEOUT);
258 }
259
260 /*
261  * i8042_flush() flushes all data that may be in the keyboard and mouse buffers
262  * of the i8042 down the toilet.
263  */
264
265 static int i8042_flush(void)
266 {
267         unsigned long flags;
268         unsigned char data, str;
269         int count = 0;
270         int retval = 0;
271
272         spin_lock_irqsave(&i8042_lock, flags);
273
274         while ((str = i8042_read_status()) & I8042_STR_OBF) {
275                 if (count++ < I8042_BUFFER_SIZE) {
276                         udelay(50);
277                         data = i8042_read_data();
278                         dbg("%02x <- i8042 (flush, %s)\n",
279                             data, str & I8042_STR_AUXDATA ? "aux" : "kbd");
280                 } else {
281                         retval = -EIO;
282                         break;
283                 }
284         }
285
286         spin_unlock_irqrestore(&i8042_lock, flags);
287
288         return retval;
289 }
290
291 /*
292  * i8042_command() executes a command on the i8042. It also sends the input
293  * parameter(s) of the commands to it, and receives the output value(s). The
294  * parameters are to be stored in the param array, and the output is placed
295  * into the same array. The number of the parameters and output values is
296  * encoded in bits 8-11 of the command number.
297  */
298
299 static int __i8042_command(unsigned char *param, int command)
300 {
301         int i, error;
302
303         if (i8042_noloop && command == I8042_CMD_AUX_LOOP)
304                 return -1;
305
306         error = i8042_wait_write();
307         if (error)
308                 return error;
309
310         dbg("%02x -> i8042 (command)\n", command & 0xff);
311         i8042_write_command(command & 0xff);
312
313         for (i = 0; i < ((command >> 12) & 0xf); i++) {
314                 error = i8042_wait_write();
315                 if (error)
316                         return error;
317                 dbg("%02x -> i8042 (parameter)\n", param[i]);
318                 i8042_write_data(param[i]);
319         }
320
321         for (i = 0; i < ((command >> 8) & 0xf); i++) {
322                 error = i8042_wait_read();
323                 if (error) {
324                         dbg("     -- i8042 (timeout)\n");
325                         return error;
326                 }
327
328                 if (command == I8042_CMD_AUX_LOOP &&
329                     !(i8042_read_status() & I8042_STR_AUXDATA)) {
330                         dbg("     -- i8042 (auxerr)\n");
331                         return -1;
332                 }
333
334                 param[i] = i8042_read_data();
335                 dbg("%02x <- i8042 (return)\n", param[i]);
336         }
337
338         return 0;
339 }
340
341 int i8042_command(unsigned char *param, int command)
342 {
343         unsigned long flags;
344         int retval;
345
346         spin_lock_irqsave(&i8042_lock, flags);
347         retval = __i8042_command(param, command);
348         spin_unlock_irqrestore(&i8042_lock, flags);
349
350         return retval;
351 }
352 EXPORT_SYMBOL(i8042_command);
353
354 /*
355  * i8042_kbd_write() sends a byte out through the keyboard interface.
356  */
357
358 static int i8042_kbd_write(struct serio *port, unsigned char c)
359 {
360         unsigned long flags;
361         int retval = 0;
362
363         spin_lock_irqsave(&i8042_lock, flags);
364
365         if (!(retval = i8042_wait_write())) {
366                 dbg("%02x -> i8042 (kbd-data)\n", c);
367                 i8042_write_data(c);
368         }
369
370         spin_unlock_irqrestore(&i8042_lock, flags);
371
372         return retval;
373 }
374
375 /*
376  * i8042_aux_write() sends a byte out through the aux interface.
377  */
378
379 static int i8042_aux_write(struct serio *serio, unsigned char c)
380 {
381         struct i8042_port *port = serio->port_data;
382
383         return i8042_command(&c, port->mux == -1 ?
384                                         I8042_CMD_AUX_SEND :
385                                         I8042_CMD_MUX_SEND + port->mux);
386 }
387
388
389 /*
390  * i8042_aux_close attempts to clear AUX or KBD port state by disabling
391  * and then re-enabling it.
392  */
393
394 static void i8042_port_close(struct serio *serio)
395 {
396         int irq_bit;
397         int disable_bit;
398         const char *port_name;
399
400         if (serio == i8042_ports[I8042_AUX_PORT_NO].serio) {
401                 irq_bit = I8042_CTR_AUXINT;
402                 disable_bit = I8042_CTR_AUXDIS;
403                 port_name = "AUX";
404         } else {
405                 irq_bit = I8042_CTR_KBDINT;
406                 disable_bit = I8042_CTR_KBDDIS;
407                 port_name = "KBD";
408         }
409
410         i8042_ctr &= ~irq_bit;
411         if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR))
412                 pr_warn("Can't write CTR while closing %s port\n", port_name);
413
414         udelay(50);
415
416         i8042_ctr &= ~disable_bit;
417         i8042_ctr |= irq_bit;
418         if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR))
419                 pr_err("Can't reactivate %s port\n", port_name);
420
421         /*
422          * See if there is any data appeared while we were messing with
423          * port state.
424          */
425         i8042_interrupt(0, NULL);
426 }
427
428 /*
429  * i8042_start() is called by serio core when port is about to finish
430  * registering. It will mark port as existing so i8042_interrupt can
431  * start sending data through it.
432  */
433 static int i8042_start(struct serio *serio)
434 {
435         struct i8042_port *port = serio->port_data;
436
437         port->exists = true;
438         mb();
439         return 0;
440 }
441
442 /*
443  * i8042_stop() marks serio port as non-existing so i8042_interrupt
444  * will not try to send data to the port that is about to go away.
445  * The function is called by serio core as part of unregister procedure.
446  */
447 static void i8042_stop(struct serio *serio)
448 {
449         struct i8042_port *port = serio->port_data;
450
451         port->exists = false;
452
453         /*
454          * We synchronize with both AUX and KBD IRQs because there is
455          * a (very unlikely) chance that AUX IRQ is raised for KBD port
456          * and vice versa.
457          */
458         synchronize_irq(I8042_AUX_IRQ);
459         synchronize_irq(I8042_KBD_IRQ);
460         port->serio = NULL;
461 }
462
463 /*
464  * i8042_filter() filters out unwanted bytes from the input data stream.
465  * It is called from i8042_interrupt and thus is running with interrupts
466  * off and i8042_lock held.
467  */
468 static bool i8042_filter(unsigned char data, unsigned char str,
469                          struct serio *serio)
470 {
471         if (unlikely(i8042_suppress_kbd_ack)) {
472                 if ((~str & I8042_STR_AUXDATA) &&
473                     (data == 0xfa || data == 0xfe)) {
474                         i8042_suppress_kbd_ack--;
475                         dbg("Extra keyboard ACK - filtered out\n");
476                         return true;
477                 }
478         }
479
480         if (i8042_platform_filter && i8042_platform_filter(data, str, serio)) {
481                 dbg("Filtered out by platform filter\n");
482                 return true;
483         }
484
485         return false;
486 }
487
488 /*
489  * i8042_interrupt() is the most important function in this driver -
490  * it handles the interrupts from the i8042, and sends incoming bytes
491  * to the upper layers.
492  */
493
494 static irqreturn_t i8042_interrupt(int irq, void *dev_id)
495 {
496         struct i8042_port *port;
497         struct serio *serio;
498         unsigned long flags;
499         unsigned char str, data;
500         unsigned int dfl;
501         unsigned int port_no;
502         bool filtered;
503         int ret = 1;
504
505         spin_lock_irqsave(&i8042_lock, flags);
506
507         str = i8042_read_status();
508         if (unlikely(~str & I8042_STR_OBF)) {
509                 spin_unlock_irqrestore(&i8042_lock, flags);
510                 if (irq)
511                         dbg("Interrupt %d, without any data\n", irq);
512                 ret = 0;
513                 goto out;
514         }
515
516         data = i8042_read_data();
517
518         if (i8042_mux_present && (str & I8042_STR_AUXDATA)) {
519                 static unsigned long last_transmit;
520                 static unsigned char last_str;
521
522                 dfl = 0;
523                 if (str & I8042_STR_MUXERR) {
524                         dbg("MUX error, status is %02x, data is %02x\n",
525                             str, data);
526 /*
527  * When MUXERR condition is signalled the data register can only contain
528  * 0xfd, 0xfe or 0xff if implementation follows the spec. Unfortunately
529  * it is not always the case. Some KBCs also report 0xfc when there is
530  * nothing connected to the port while others sometimes get confused which
531  * port the data came from and signal error leaving the data intact. They
532  * _do not_ revert to legacy mode (actually I've never seen KBC reverting
533  * to legacy mode yet, when we see one we'll add proper handling).
534  * Anyway, we process 0xfc, 0xfd, 0xfe and 0xff as timeouts, and for the
535  * rest assume that the data came from the same serio last byte
536  * was transmitted (if transmission happened not too long ago).
537  */
538
539                         switch (data) {
540                                 default:
541                                         if (time_before(jiffies, last_transmit + HZ/10)) {
542                                                 str = last_str;
543                                                 break;
544                                         }
545                                         /* fall through - report timeout */
546                                 case 0xfc:
547                                 case 0xfd:
548                                 case 0xfe: dfl = SERIO_TIMEOUT; data = 0xfe; break;
549                                 case 0xff: dfl = SERIO_PARITY;  data = 0xfe; break;
550                         }
551                 }
552
553                 port_no = I8042_MUX_PORT_NO + ((str >> 6) & 3);
554                 last_str = str;
555                 last_transmit = jiffies;
556         } else {
557
558                 dfl = ((str & I8042_STR_PARITY) ? SERIO_PARITY : 0) |
559                       ((str & I8042_STR_TIMEOUT && !i8042_notimeout) ? SERIO_TIMEOUT : 0);
560
561                 port_no = (str & I8042_STR_AUXDATA) ?
562                                 I8042_AUX_PORT_NO : I8042_KBD_PORT_NO;
563         }
564
565         port = &i8042_ports[port_no];
566         serio = port->exists ? port->serio : NULL;
567
568         filter_dbg(port->driver_bound, data, "<- i8042 (interrupt, %d, %d%s%s)\n",
569                    port_no, irq,
570                    dfl & SERIO_PARITY ? ", bad parity" : "",
571                    dfl & SERIO_TIMEOUT ? ", timeout" : "");
572
573         filtered = i8042_filter(data, str, serio);
574
575         spin_unlock_irqrestore(&i8042_lock, flags);
576
577         if (likely(port->exists && !filtered))
578                 serio_interrupt(serio, data, dfl);
579
580  out:
581         return IRQ_RETVAL(ret);
582 }
583
584 /*
585  * i8042_enable_kbd_port enables keyboard port on chip
586  */
587
588 static int i8042_enable_kbd_port(void)
589 {
590         i8042_ctr &= ~I8042_CTR_KBDDIS;
591         i8042_ctr |= I8042_CTR_KBDINT;
592
593         if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR)) {
594                 i8042_ctr &= ~I8042_CTR_KBDINT;
595                 i8042_ctr |= I8042_CTR_KBDDIS;
596                 pr_err("Failed to enable KBD port\n");
597                 return -EIO;
598         }
599
600         return 0;
601 }
602
603 /*
604  * i8042_enable_aux_port enables AUX (mouse) port on chip
605  */
606
607 static int i8042_enable_aux_port(void)
608 {
609         i8042_ctr &= ~I8042_CTR_AUXDIS;
610         i8042_ctr |= I8042_CTR_AUXINT;
611
612         if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR)) {
613                 i8042_ctr &= ~I8042_CTR_AUXINT;
614                 i8042_ctr |= I8042_CTR_AUXDIS;
615                 pr_err("Failed to enable AUX port\n");
616                 return -EIO;
617         }
618
619         return 0;
620 }
621
622 /*
623  * i8042_enable_mux_ports enables 4 individual AUX ports after
624  * the controller has been switched into Multiplexed mode
625  */
626
627 static int i8042_enable_mux_ports(void)
628 {
629         unsigned char param;
630         int i;
631
632         for (i = 0; i < I8042_NUM_MUX_PORTS; i++) {
633                 i8042_command(&param, I8042_CMD_MUX_PFX + i);
634                 i8042_command(&param, I8042_CMD_AUX_ENABLE);
635         }
636
637         return i8042_enable_aux_port();
638 }
639
640 /*
641  * i8042_set_mux_mode checks whether the controller has an
642  * active multiplexor and puts the chip into Multiplexed (true)
643  * or Legacy (false) mode.
644  */
645
646 static int i8042_set_mux_mode(bool multiplex, unsigned char *mux_version)
647 {
648
649         unsigned char param, val;
650 /*
651  * Get rid of bytes in the queue.
652  */
653
654         i8042_flush();
655
656 /*
657  * Internal loopback test - send three bytes, they should come back from the
658  * mouse interface, the last should be version.
659  */
660
661         param = val = 0xf0;
662         if (i8042_command(&param, I8042_CMD_AUX_LOOP) || param != val)
663                 return -1;
664         param = val = multiplex ? 0x56 : 0xf6;
665         if (i8042_command(&param, I8042_CMD_AUX_LOOP) || param != val)
666                 return -1;
667         param = val = multiplex ? 0xa4 : 0xa5;
668         if (i8042_command(&param, I8042_CMD_AUX_LOOP) || param == val)
669                 return -1;
670
671 /*
672  * Workaround for interference with USB Legacy emulation
673  * that causes a v10.12 MUX to be found.
674  */
675         if (param == 0xac)
676                 return -1;
677
678         if (mux_version)
679                 *mux_version = param;
680
681         return 0;
682 }
683
684 /*
685  * i8042_check_mux() checks whether the controller supports the PS/2 Active
686  * Multiplexing specification by Synaptics, Phoenix, Insyde and
687  * LCS/Telegraphics.
688  */
689
690 static int __init i8042_check_mux(void)
691 {
692         unsigned char mux_version;
693
694         if (i8042_set_mux_mode(true, &mux_version))
695                 return -1;
696
697         pr_info("Detected active multiplexing controller, rev %d.%d\n",
698                 (mux_version >> 4) & 0xf, mux_version & 0xf);
699
700 /*
701  * Disable all muxed ports by disabling AUX.
702  */
703         i8042_ctr |= I8042_CTR_AUXDIS;
704         i8042_ctr &= ~I8042_CTR_AUXINT;
705
706         if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR)) {
707                 pr_err("Failed to disable AUX port, can't use MUX\n");
708                 return -EIO;
709         }
710
711         i8042_mux_present = true;
712
713         return 0;
714 }
715
716 /*
717  * The following is used to test AUX IRQ delivery.
718  */
719 static struct completion i8042_aux_irq_delivered __initdata;
720 static bool i8042_irq_being_tested __initdata;
721
722 static irqreturn_t __init i8042_aux_test_irq(int irq, void *dev_id)
723 {
724         unsigned long flags;
725         unsigned char str, data;
726         int ret = 0;
727
728         spin_lock_irqsave(&i8042_lock, flags);
729         str = i8042_read_status();
730         if (str & I8042_STR_OBF) {
731                 data = i8042_read_data();
732                 dbg("%02x <- i8042 (aux_test_irq, %s)\n",
733                     data, str & I8042_STR_AUXDATA ? "aux" : "kbd");
734                 if (i8042_irq_being_tested &&
735                     data == 0xa5 && (str & I8042_STR_AUXDATA))
736                         complete(&i8042_aux_irq_delivered);
737                 ret = 1;
738         }
739         spin_unlock_irqrestore(&i8042_lock, flags);
740
741         return IRQ_RETVAL(ret);
742 }
743
744 /*
745  * i8042_toggle_aux - enables or disables AUX port on i8042 via command and
746  * verifies success by readinng CTR. Used when testing for presence of AUX
747  * port.
748  */
749 static int __init i8042_toggle_aux(bool on)
750 {
751         unsigned char param;
752         int i;
753
754         if (i8042_command(&param,
755                         on ? I8042_CMD_AUX_ENABLE : I8042_CMD_AUX_DISABLE))
756                 return -1;
757
758         /* some chips need some time to set the I8042_CTR_AUXDIS bit */
759         for (i = 0; i < 100; i++) {
760                 udelay(50);
761
762                 if (i8042_command(&param, I8042_CMD_CTL_RCTR))
763                         return -1;
764
765                 if (!(param & I8042_CTR_AUXDIS) == on)
766                         return 0;
767         }
768
769         return -1;
770 }
771
772 /*
773  * i8042_check_aux() applies as much paranoia as it can at detecting
774  * the presence of an AUX interface.
775  */
776
777 static int __init i8042_check_aux(void)
778 {
779         int retval = -1;
780         bool irq_registered = false;
781         bool aux_loop_broken = false;
782         unsigned long flags;
783         unsigned char param;
784
785 /*
786  * Get rid of bytes in the queue.
787  */
788
789         i8042_flush();
790
791 /*
792  * Internal loopback test - filters out AT-type i8042's. Unfortunately
793  * SiS screwed up and their 5597 doesn't support the LOOP command even
794  * though it has an AUX port.
795  */
796
797         param = 0x5a;
798         retval = i8042_command(&param, I8042_CMD_AUX_LOOP);
799         if (retval || param != 0x5a) {
800
801 /*
802  * External connection test - filters out AT-soldered PS/2 i8042's
803  * 0x00 - no error, 0x01-0x03 - clock/data stuck, 0xff - general error
804  * 0xfa - no error on some notebooks which ignore the spec
805  * Because it's common for chipsets to return error on perfectly functioning
806  * AUX ports, we test for this only when the LOOP command failed.
807  */
808
809                 if (i8042_command(&param, I8042_CMD_AUX_TEST) ||
810                     (param && param != 0xfa && param != 0xff))
811                         return -1;
812
813 /*
814  * If AUX_LOOP completed without error but returned unexpected data
815  * mark it as broken
816  */
817                 if (!retval)
818                         aux_loop_broken = true;
819         }
820
821 /*
822  * Bit assignment test - filters out PS/2 i8042's in AT mode
823  */
824
825         if (i8042_toggle_aux(false)) {
826                 pr_warn("Failed to disable AUX port, but continuing anyway... Is this a SiS?\n");
827                 pr_warn("If AUX port is really absent please use the 'i8042.noaux' option\n");
828         }
829
830         if (i8042_toggle_aux(true))
831                 return -1;
832
833 /*
834  * Reset keyboard (needed on some laptops to successfully detect
835  * touchpad, e.g., some Gigabyte laptop models with Elantech
836  * touchpads).
837  */
838         if (i8042_kbdreset) {
839                 pr_warn("Attempting to reset device connected to KBD port\n");
840                 i8042_kbd_write(NULL, (unsigned char) 0xff);
841         }
842
843 /*
844  * Test AUX IRQ delivery to make sure BIOS did not grab the IRQ and
845  * used it for a PCI card or somethig else.
846  */
847
848         if (i8042_noloop || i8042_bypass_aux_irq_test || aux_loop_broken) {
849 /*
850  * Without LOOP command we can't test AUX IRQ delivery. Assume the port
851  * is working and hope we are right.
852  */
853                 retval = 0;
854                 goto out;
855         }
856
857         if (request_irq(I8042_AUX_IRQ, i8042_aux_test_irq, IRQF_SHARED,
858                         "i8042", i8042_platform_device))
859                 goto out;
860
861         irq_registered = true;
862
863         if (i8042_enable_aux_port())
864                 goto out;
865
866         spin_lock_irqsave(&i8042_lock, flags);
867
868         init_completion(&i8042_aux_irq_delivered);
869         i8042_irq_being_tested = true;
870
871         param = 0xa5;
872         retval = __i8042_command(&param, I8042_CMD_AUX_LOOP & 0xf0ff);
873
874         spin_unlock_irqrestore(&i8042_lock, flags);
875
876         if (retval)
877                 goto out;
878
879         if (wait_for_completion_timeout(&i8042_aux_irq_delivered,
880                                         msecs_to_jiffies(250)) == 0) {
881 /*
882  * AUX IRQ was never delivered so we need to flush the controller to
883  * get rid of the byte we put there; otherwise keyboard may not work.
884  */
885                 dbg("     -- i8042 (aux irq test timeout)\n");
886                 i8042_flush();
887                 retval = -1;
888         }
889
890  out:
891
892 /*
893  * Disable the interface.
894  */
895
896         i8042_ctr |= I8042_CTR_AUXDIS;
897         i8042_ctr &= ~I8042_CTR_AUXINT;
898
899         if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR))
900                 retval = -1;
901
902         if (irq_registered)
903                 free_irq(I8042_AUX_IRQ, i8042_platform_device);
904
905         return retval;
906 }
907
908 static int i8042_controller_check(void)
909 {
910         if (i8042_flush()) {
911                 pr_info("No controller found\n");
912                 return -ENODEV;
913         }
914
915         return 0;
916 }
917
918 static int i8042_controller_selftest(void)
919 {
920         unsigned char param;
921         int i = 0;
922
923         /*
924          * We try this 5 times; on some really fragile systems this does not
925          * take the first time...
926          */
927         do {
928
929                 if (i8042_command(&param, I8042_CMD_CTL_TEST)) {
930                         pr_err("i8042 controller selftest timeout\n");
931                         return -ENODEV;
932                 }
933
934                 if (param == I8042_RET_CTL_TEST)
935                         return 0;
936
937                 dbg("i8042 controller selftest: %#x != %#x\n",
938                     param, I8042_RET_CTL_TEST);
939                 msleep(50);
940         } while (i++ < 5);
941
942 #ifdef CONFIG_X86
943         /*
944          * On x86, we don't fail entire i8042 initialization if controller
945          * reset fails in hopes that keyboard port will still be functional
946          * and user will still get a working keyboard. This is especially
947          * important on netbooks. On other arches we trust hardware more.
948          */
949         pr_info("giving up on controller selftest, continuing anyway...\n");
950         return 0;
951 #else
952         pr_err("i8042 controller selftest failed\n");
953         return -EIO;
954 #endif
955 }
956
957 /*
958  * i8042_controller init initializes the i8042 controller, and,
959  * most importantly, sets it into non-xlated mode if that's
960  * desired.
961  */
962
963 static int i8042_controller_init(void)
964 {
965         unsigned long flags;
966         int n = 0;
967         unsigned char ctr[2];
968
969 /*
970  * Save the CTR for restore on unload / reboot.
971  */
972
973         do {
974                 if (n >= 10) {
975                         pr_err("Unable to get stable CTR read\n");
976                         return -EIO;
977                 }
978
979                 if (n != 0)
980                         udelay(50);
981
982                 if (i8042_command(&ctr[n++ % 2], I8042_CMD_CTL_RCTR)) {
983                         pr_err("Can't read CTR while initializing i8042\n");
984                         return -EIO;
985                 }
986
987         } while (n < 2 || ctr[0] != ctr[1]);
988
989         i8042_initial_ctr = i8042_ctr = ctr[0];
990
991 /*
992  * Disable the keyboard interface and interrupt.
993  */
994
995         i8042_ctr |= I8042_CTR_KBDDIS;
996         i8042_ctr &= ~I8042_CTR_KBDINT;
997
998 /*
999  * Handle keylock.
1000  */
1001
1002         spin_lock_irqsave(&i8042_lock, flags);
1003         if (~i8042_read_status() & I8042_STR_KEYLOCK) {
1004                 if (i8042_unlock)
1005                         i8042_ctr |= I8042_CTR_IGNKEYLOCK;
1006                 else
1007                         pr_warn("Warning: Keylock active\n");
1008         }
1009         spin_unlock_irqrestore(&i8042_lock, flags);
1010
1011 /*
1012  * If the chip is configured into nontranslated mode by the BIOS, don't
1013  * bother enabling translating and be happy.
1014  */
1015
1016         if (~i8042_ctr & I8042_CTR_XLATE)
1017                 i8042_direct = true;
1018
1019 /*
1020  * Set nontranslated mode for the kbd interface if requested by an option.
1021  * After this the kbd interface becomes a simple serial in/out, like the aux
1022  * interface is. We don't do this by default, since it can confuse notebook
1023  * BIOSes.
1024  */
1025
1026         if (i8042_direct)
1027                 i8042_ctr &= ~I8042_CTR_XLATE;
1028
1029 /*
1030  * Write CTR back.
1031  */
1032
1033         if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR)) {
1034                 pr_err("Can't write CTR while initializing i8042\n");
1035                 return -EIO;
1036         }
1037
1038 /*
1039  * Flush whatever accumulated while we were disabling keyboard port.
1040  */
1041
1042         i8042_flush();
1043
1044         return 0;
1045 }
1046
1047
1048 /*
1049  * Reset the controller and reset CRT to the original value set by BIOS.
1050  */
1051
1052 static void i8042_controller_reset(bool s2r_wants_reset)
1053 {
1054         i8042_flush();
1055
1056 /*
1057  * Disable both KBD and AUX interfaces so they don't get in the way
1058  */
1059
1060         i8042_ctr |= I8042_CTR_KBDDIS | I8042_CTR_AUXDIS;
1061         i8042_ctr &= ~(I8042_CTR_KBDINT | I8042_CTR_AUXINT);
1062
1063         if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR))
1064                 pr_warn("Can't write CTR while resetting\n");
1065
1066 /*
1067  * Disable MUX mode if present.
1068  */
1069
1070         if (i8042_mux_present)
1071                 i8042_set_mux_mode(false, NULL);
1072
1073 /*
1074  * Reset the controller if requested.
1075  */
1076
1077         if (i8042_reset == I8042_RESET_ALWAYS ||
1078             (i8042_reset == I8042_RESET_ON_S2RAM && s2r_wants_reset)) {
1079                 i8042_controller_selftest();
1080         }
1081
1082 /*
1083  * Restore the original control register setting.
1084  */
1085
1086         if (i8042_command(&i8042_initial_ctr, I8042_CMD_CTL_WCTR))
1087                 pr_warn("Can't restore CTR\n");
1088 }
1089
1090
1091 /*
1092  * i8042_panic_blink() will turn the keyboard LEDs on or off and is called
1093  * when kernel panics. Flashing LEDs is useful for users running X who may
1094  * not see the console and will help distinguishing panics from "real"
1095  * lockups.
1096  *
1097  * Note that DELAY has a limit of 10ms so we will not get stuck here
1098  * waiting for KBC to free up even if KBD interrupt is off
1099  */
1100
1101 #define DELAY do { mdelay(1); if (++delay > 10) return delay; } while(0)
1102
1103 static long i8042_panic_blink(int state)
1104 {
1105         long delay = 0;
1106         char led;
1107
1108         led = (state) ? 0x01 | 0x04 : 0;
1109         while (i8042_read_status() & I8042_STR_IBF)
1110                 DELAY;
1111         dbg("%02x -> i8042 (panic blink)\n", 0xed);
1112         i8042_suppress_kbd_ack = 2;
1113         i8042_write_data(0xed); /* set leds */
1114         DELAY;
1115         while (i8042_read_status() & I8042_STR_IBF)
1116                 DELAY;
1117         DELAY;
1118         dbg("%02x -> i8042 (panic blink)\n", led);
1119         i8042_write_data(led);
1120         DELAY;
1121         return delay;
1122 }
1123
1124 #undef DELAY
1125
1126 #ifdef CONFIG_X86
1127 static void i8042_dritek_enable(void)
1128 {
1129         unsigned char param = 0x90;
1130         int error;
1131
1132         error = i8042_command(&param, 0x1059);
1133         if (error)
1134                 pr_warn("Failed to enable DRITEK extension: %d\n", error);
1135 }
1136 #endif
1137
1138 #ifdef CONFIG_PM
1139
1140 /*
1141  * Here we try to reset everything back to a state we had
1142  * before suspending.
1143  */
1144
1145 static int i8042_controller_resume(bool s2r_wants_reset)
1146 {
1147         int error;
1148
1149         error = i8042_controller_check();
1150         if (error)
1151                 return error;
1152
1153         if (i8042_reset == I8042_RESET_ALWAYS ||
1154             (i8042_reset == I8042_RESET_ON_S2RAM && s2r_wants_reset)) {
1155                 error = i8042_controller_selftest();
1156                 if (error)
1157                         return error;
1158         }
1159
1160 /*
1161  * Restore original CTR value and disable all ports
1162  */
1163
1164         i8042_ctr = i8042_initial_ctr;
1165         if (i8042_direct)
1166                 i8042_ctr &= ~I8042_CTR_XLATE;
1167         i8042_ctr |= I8042_CTR_AUXDIS | I8042_CTR_KBDDIS;
1168         i8042_ctr &= ~(I8042_CTR_AUXINT | I8042_CTR_KBDINT);
1169         if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR)) {
1170                 pr_warn("Can't write CTR to resume, retrying...\n");
1171                 msleep(50);
1172                 if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR)) {
1173                         pr_err("CTR write retry failed\n");
1174                         return -EIO;
1175                 }
1176         }
1177
1178
1179 #ifdef CONFIG_X86
1180         if (i8042_dritek)
1181                 i8042_dritek_enable();
1182 #endif
1183
1184         if (i8042_mux_present) {
1185                 if (i8042_set_mux_mode(true, NULL) || i8042_enable_mux_ports())
1186                         pr_warn("failed to resume active multiplexor, mouse won't work\n");
1187         } else if (i8042_ports[I8042_AUX_PORT_NO].serio)
1188                 i8042_enable_aux_port();
1189
1190         if (i8042_ports[I8042_KBD_PORT_NO].serio)
1191                 i8042_enable_kbd_port();
1192
1193         i8042_interrupt(0, NULL);
1194
1195         return 0;
1196 }
1197
1198 /*
1199  * Here we try to restore the original BIOS settings to avoid
1200  * upsetting it.
1201  */
1202
1203 static int i8042_pm_suspend(struct device *dev)
1204 {
1205         int i;
1206
1207         if (pm_suspend_via_firmware())
1208                 i8042_controller_reset(true);
1209
1210         /* Set up serio interrupts for system wakeup. */
1211         for (i = 0; i < I8042_NUM_PORTS; i++) {
1212                 struct serio *serio = i8042_ports[i].serio;
1213
1214                 if (serio && device_may_wakeup(&serio->dev))
1215                         enable_irq_wake(i8042_ports[i].irq);
1216         }
1217
1218         return 0;
1219 }
1220
1221 static int i8042_pm_resume_noirq(struct device *dev)
1222 {
1223         if (!pm_resume_via_firmware())
1224                 i8042_interrupt(0, NULL);
1225
1226         return 0;
1227 }
1228
1229 static int i8042_pm_resume(struct device *dev)
1230 {
1231         bool want_reset;
1232         int i;
1233
1234         for (i = 0; i < I8042_NUM_PORTS; i++) {
1235                 struct serio *serio = i8042_ports[i].serio;
1236
1237                 if (serio && device_may_wakeup(&serio->dev))
1238                         disable_irq_wake(i8042_ports[i].irq);
1239         }
1240
1241         /*
1242          * If platform firmware was not going to be involved in suspend, we did
1243          * not restore the controller state to whatever it had been at boot
1244          * time, so we do not need to do anything.
1245          */
1246         if (!pm_suspend_via_firmware())
1247                 return 0;
1248
1249         /*
1250          * We only need to reset the controller if we are resuming after handing
1251          * off control to the platform firmware, otherwise we can simply restore
1252          * the mode.
1253          */
1254         want_reset = pm_resume_via_firmware();
1255
1256         return i8042_controller_resume(want_reset);
1257 }
1258
1259 static int i8042_pm_thaw(struct device *dev)
1260 {
1261         i8042_interrupt(0, NULL);
1262
1263         return 0;
1264 }
1265
1266 static int i8042_pm_reset(struct device *dev)
1267 {
1268         i8042_controller_reset(false);
1269
1270         return 0;
1271 }
1272
1273 static int i8042_pm_restore(struct device *dev)
1274 {
1275         return i8042_controller_resume(false);
1276 }
1277
1278 static const struct dev_pm_ops i8042_pm_ops = {
1279         .suspend        = i8042_pm_suspend,
1280         .resume_noirq   = i8042_pm_resume_noirq,
1281         .resume         = i8042_pm_resume,
1282         .thaw           = i8042_pm_thaw,
1283         .poweroff       = i8042_pm_reset,
1284         .restore        = i8042_pm_restore,
1285 };
1286
1287 #endif /* CONFIG_PM */
1288
1289 /*
1290  * We need to reset the 8042 back to original mode on system shutdown,
1291  * because otherwise BIOSes will be confused.
1292  */
1293
1294 static void i8042_shutdown(struct platform_device *dev)
1295 {
1296         i8042_controller_reset(false);
1297 }
1298
1299 static int __init i8042_create_kbd_port(void)
1300 {
1301         struct serio *serio;
1302         struct i8042_port *port = &i8042_ports[I8042_KBD_PORT_NO];
1303
1304         serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
1305         if (!serio)
1306                 return -ENOMEM;
1307
1308         serio->id.type          = i8042_direct ? SERIO_8042 : SERIO_8042_XL;
1309         serio->write            = i8042_dumbkbd ? NULL : i8042_kbd_write;
1310         serio->start            = i8042_start;
1311         serio->stop             = i8042_stop;
1312         serio->close            = i8042_port_close;
1313         serio->ps2_cmd_mutex    = &i8042_mutex;
1314         serio->port_data        = port;
1315         serio->dev.parent       = &i8042_platform_device->dev;
1316         strlcpy(serio->name, "i8042 KBD port", sizeof(serio->name));
1317         strlcpy(serio->phys, I8042_KBD_PHYS_DESC, sizeof(serio->phys));
1318         strlcpy(serio->firmware_id, i8042_kbd_firmware_id,
1319                 sizeof(serio->firmware_id));
1320
1321         port->serio = serio;
1322         port->irq = I8042_KBD_IRQ;
1323
1324         return 0;
1325 }
1326
1327 static int __init i8042_create_aux_port(int idx)
1328 {
1329         struct serio *serio;
1330         int port_no = idx < 0 ? I8042_AUX_PORT_NO : I8042_MUX_PORT_NO + idx;
1331         struct i8042_port *port = &i8042_ports[port_no];
1332
1333         serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
1334         if (!serio)
1335                 return -ENOMEM;
1336
1337         serio->id.type          = SERIO_8042;
1338         serio->write            = i8042_aux_write;
1339         serio->start            = i8042_start;
1340         serio->stop             = i8042_stop;
1341         serio->ps2_cmd_mutex    = &i8042_mutex;
1342         serio->port_data        = port;
1343         serio->dev.parent       = &i8042_platform_device->dev;
1344         if (idx < 0) {
1345                 strlcpy(serio->name, "i8042 AUX port", sizeof(serio->name));
1346                 strlcpy(serio->phys, I8042_AUX_PHYS_DESC, sizeof(serio->phys));
1347                 strlcpy(serio->firmware_id, i8042_aux_firmware_id,
1348                         sizeof(serio->firmware_id));
1349                 serio->close = i8042_port_close;
1350         } else {
1351                 snprintf(serio->name, sizeof(serio->name), "i8042 AUX%d port", idx);
1352                 snprintf(serio->phys, sizeof(serio->phys), I8042_MUX_PHYS_DESC, idx + 1);
1353                 strlcpy(serio->firmware_id, i8042_aux_firmware_id,
1354                         sizeof(serio->firmware_id));
1355         }
1356
1357         port->serio = serio;
1358         port->mux = idx;
1359         port->irq = I8042_AUX_IRQ;
1360
1361         return 0;
1362 }
1363
1364 static void __init i8042_free_kbd_port(void)
1365 {
1366         kfree(i8042_ports[I8042_KBD_PORT_NO].serio);
1367         i8042_ports[I8042_KBD_PORT_NO].serio = NULL;
1368 }
1369
1370 static void __init i8042_free_aux_ports(void)
1371 {
1372         int i;
1373
1374         for (i = I8042_AUX_PORT_NO; i < I8042_NUM_PORTS; i++) {
1375                 kfree(i8042_ports[i].serio);
1376                 i8042_ports[i].serio = NULL;
1377         }
1378 }
1379
1380 static void __init i8042_register_ports(void)
1381 {
1382         int i;
1383
1384         for (i = 0; i < I8042_NUM_PORTS; i++) {
1385                 struct serio *serio = i8042_ports[i].serio;
1386
1387                 if (serio) {
1388                         printk(KERN_INFO "serio: %s at %#lx,%#lx irq %d\n",
1389                                 serio->name,
1390                                 (unsigned long) I8042_DATA_REG,
1391                                 (unsigned long) I8042_COMMAND_REG,
1392                                 i8042_ports[i].irq);
1393                         serio_register_port(serio);
1394                         device_set_wakeup_capable(&serio->dev, true);
1395                 }
1396         }
1397 }
1398
1399 static void i8042_unregister_ports(void)
1400 {
1401         int i;
1402
1403         for (i = 0; i < I8042_NUM_PORTS; i++) {
1404                 if (i8042_ports[i].serio) {
1405                         serio_unregister_port(i8042_ports[i].serio);
1406                         i8042_ports[i].serio = NULL;
1407                 }
1408         }
1409 }
1410
1411 static void i8042_free_irqs(void)
1412 {
1413         if (i8042_aux_irq_registered)
1414                 free_irq(I8042_AUX_IRQ, i8042_platform_device);
1415         if (i8042_kbd_irq_registered)
1416                 free_irq(I8042_KBD_IRQ, i8042_platform_device);
1417
1418         i8042_aux_irq_registered = i8042_kbd_irq_registered = false;
1419 }
1420
1421 static int __init i8042_setup_aux(void)
1422 {
1423         int (*aux_enable)(void);
1424         int error;
1425         int i;
1426
1427         if (i8042_check_aux())
1428                 return -ENODEV;
1429
1430         if (i8042_nomux || i8042_check_mux()) {
1431                 error = i8042_create_aux_port(-1);
1432                 if (error)
1433                         goto err_free_ports;
1434                 aux_enable = i8042_enable_aux_port;
1435         } else {
1436                 for (i = 0; i < I8042_NUM_MUX_PORTS; i++) {
1437                         error = i8042_create_aux_port(i);
1438                         if (error)
1439                                 goto err_free_ports;
1440                 }
1441                 aux_enable = i8042_enable_mux_ports;
1442         }
1443
1444         error = request_irq(I8042_AUX_IRQ, i8042_interrupt, IRQF_SHARED,
1445                             "i8042", i8042_platform_device);
1446         if (error)
1447                 goto err_free_ports;
1448
1449         if (aux_enable())
1450                 goto err_free_irq;
1451
1452         i8042_aux_irq_registered = true;
1453         return 0;
1454
1455  err_free_irq:
1456         free_irq(I8042_AUX_IRQ, i8042_platform_device);
1457  err_free_ports:
1458         i8042_free_aux_ports();
1459         return error;
1460 }
1461
1462 static int __init i8042_setup_kbd(void)
1463 {
1464         int error;
1465
1466         error = i8042_create_kbd_port();
1467         if (error)
1468                 return error;
1469
1470         error = request_irq(I8042_KBD_IRQ, i8042_interrupt, IRQF_SHARED,
1471                             "i8042", i8042_platform_device);
1472         if (error)
1473                 goto err_free_port;
1474
1475         error = i8042_enable_kbd_port();
1476         if (error)
1477                 goto err_free_irq;
1478
1479         i8042_kbd_irq_registered = true;
1480         return 0;
1481
1482  err_free_irq:
1483         free_irq(I8042_KBD_IRQ, i8042_platform_device);
1484  err_free_port:
1485         i8042_free_kbd_port();
1486         return error;
1487 }
1488
1489 static int i8042_kbd_bind_notifier(struct notifier_block *nb,
1490                                    unsigned long action, void *data)
1491 {
1492         struct device *dev = data;
1493         struct serio *serio = to_serio_port(dev);
1494         struct i8042_port *port = serio->port_data;
1495
1496         if (serio != i8042_ports[I8042_KBD_PORT_NO].serio)
1497                 return 0;
1498
1499         switch (action) {
1500         case BUS_NOTIFY_BOUND_DRIVER:
1501                 port->driver_bound = true;
1502                 break;
1503
1504         case BUS_NOTIFY_UNBIND_DRIVER:
1505                 port->driver_bound = false;
1506                 break;
1507         }
1508
1509         return 0;
1510 }
1511
1512 static int __init i8042_probe(struct platform_device *dev)
1513 {
1514         int error;
1515
1516         i8042_platform_device = dev;
1517
1518         if (i8042_reset == I8042_RESET_ALWAYS) {
1519                 error = i8042_controller_selftest();
1520                 if (error)
1521                         return error;
1522         }
1523
1524         error = i8042_controller_init();
1525         if (error)
1526                 return error;
1527
1528 #ifdef CONFIG_X86
1529         if (i8042_dritek)
1530                 i8042_dritek_enable();
1531 #endif
1532
1533         if (!i8042_noaux) {
1534                 error = i8042_setup_aux();
1535                 if (error && error != -ENODEV && error != -EBUSY)
1536                         goto out_fail;
1537         }
1538
1539         if (!i8042_nokbd) {
1540                 error = i8042_setup_kbd();
1541                 if (error)
1542                         goto out_fail;
1543         }
1544 /*
1545  * Ok, everything is ready, let's register all serio ports
1546  */
1547         i8042_register_ports();
1548
1549         return 0;
1550
1551  out_fail:
1552         i8042_free_aux_ports(); /* in case KBD failed but AUX not */
1553         i8042_free_irqs();
1554         i8042_controller_reset(false);
1555         i8042_platform_device = NULL;
1556
1557         return error;
1558 }
1559
1560 static int i8042_remove(struct platform_device *dev)
1561 {
1562         i8042_unregister_ports();
1563         i8042_free_irqs();
1564         i8042_controller_reset(false);
1565         i8042_platform_device = NULL;
1566
1567         return 0;
1568 }
1569
1570 static struct platform_driver i8042_driver = {
1571         .driver         = {
1572                 .name   = "i8042",
1573 #ifdef CONFIG_PM
1574                 .pm     = &i8042_pm_ops,
1575 #endif
1576         },
1577         .remove         = i8042_remove,
1578         .shutdown       = i8042_shutdown,
1579 };
1580
1581 static struct notifier_block i8042_kbd_bind_notifier_block = {
1582         .notifier_call = i8042_kbd_bind_notifier,
1583 };
1584
1585 static int __init i8042_init(void)
1586 {
1587         struct platform_device *pdev;
1588         int err;
1589
1590         dbg_init();
1591
1592         err = i8042_platform_init();
1593         if (err)
1594                 return err;
1595
1596         err = i8042_controller_check();
1597         if (err)
1598                 goto err_platform_exit;
1599
1600         pdev = platform_create_bundle(&i8042_driver, i8042_probe, NULL, 0, NULL, 0);
1601         if (IS_ERR(pdev)) {
1602                 err = PTR_ERR(pdev);
1603                 goto err_platform_exit;
1604         }
1605
1606         bus_register_notifier(&serio_bus, &i8042_kbd_bind_notifier_block);
1607         panic_blink = i8042_panic_blink;
1608
1609         return 0;
1610
1611  err_platform_exit:
1612         i8042_platform_exit();
1613         return err;
1614 }
1615
1616 static void __exit i8042_exit(void)
1617 {
1618         platform_device_unregister(i8042_platform_device);
1619         platform_driver_unregister(&i8042_driver);
1620         i8042_platform_exit();
1621
1622         bus_unregister_notifier(&serio_bus, &i8042_kbd_bind_notifier_block);
1623         panic_blink = NULL;
1624 }
1625
1626 module_init(i8042_init);
1627 module_exit(i8042_exit);