mirror of
https://github.com/FEX-Emu/linux.git
synced 2024-12-24 18:38:38 +00:00
2bfc3c6e95
Do not assume that pnp_register_driver() returns the number of devices claimed. Signed-off-by: Bjorn Helgaas <bjorn.helgaas@hp.com> Signed-off-by: Dmitry Torokhov <dtor@mail.ru>
418 lines
9.9 KiB
C
418 lines
9.9 KiB
C
#ifndef _I8042_X86IA64IO_H
|
|
#define _I8042_X86IA64IO_H
|
|
|
|
/*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License version 2 as published by
|
|
* the Free Software Foundation.
|
|
*/
|
|
|
|
/*
|
|
* Names.
|
|
*/
|
|
|
|
#define I8042_KBD_PHYS_DESC "isa0060/serio0"
|
|
#define I8042_AUX_PHYS_DESC "isa0060/serio1"
|
|
#define I8042_MUX_PHYS_DESC "isa0060/serio%d"
|
|
|
|
/*
|
|
* IRQs.
|
|
*/
|
|
|
|
#if defined(__ia64__)
|
|
# define I8042_MAP_IRQ(x) isa_irq_to_vector((x))
|
|
#else
|
|
# define I8042_MAP_IRQ(x) (x)
|
|
#endif
|
|
|
|
#define I8042_KBD_IRQ i8042_kbd_irq
|
|
#define I8042_AUX_IRQ i8042_aux_irq
|
|
|
|
static int i8042_kbd_irq;
|
|
static int i8042_aux_irq;
|
|
|
|
/*
|
|
* Register numbers.
|
|
*/
|
|
|
|
#define I8042_COMMAND_REG i8042_command_reg
|
|
#define I8042_STATUS_REG i8042_command_reg
|
|
#define I8042_DATA_REG i8042_data_reg
|
|
|
|
static int i8042_command_reg = 0x64;
|
|
static int i8042_data_reg = 0x60;
|
|
|
|
|
|
static inline int i8042_read_data(void)
|
|
{
|
|
return inb(I8042_DATA_REG);
|
|
}
|
|
|
|
static inline int i8042_read_status(void)
|
|
{
|
|
return inb(I8042_STATUS_REG);
|
|
}
|
|
|
|
static inline void i8042_write_data(int val)
|
|
{
|
|
outb(val, I8042_DATA_REG);
|
|
}
|
|
|
|
static inline void i8042_write_command(int val)
|
|
{
|
|
outb(val, I8042_COMMAND_REG);
|
|
}
|
|
|
|
#if defined(__i386__)
|
|
|
|
#include <linux/dmi.h>
|
|
|
|
static struct dmi_system_id __initdata i8042_dmi_noloop_table[] = {
|
|
{
|
|
.ident = "Compaq Proliant 8500",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Compaq"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME , "ProLiant"),
|
|
DMI_MATCH(DMI_PRODUCT_VERSION, "8500"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Compaq Proliant DL760",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Compaq"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME , "ProLiant"),
|
|
DMI_MATCH(DMI_PRODUCT_VERSION, "DL760"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "OQO Model 01",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "OQO"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "ZEPTO"),
|
|
DMI_MATCH(DMI_PRODUCT_VERSION, "00"),
|
|
},
|
|
},
|
|
{ }
|
|
};
|
|
|
|
/*
|
|
* Some Fujitsu notebooks are having trouble with touchpads if
|
|
* active multiplexing mode is activated. Luckily they don't have
|
|
* external PS/2 ports so we can safely disable it.
|
|
* ... apparently some Toshibas don't like MUX mode either and
|
|
* die horrible death on reboot.
|
|
*/
|
|
static struct dmi_system_id __initdata i8042_dmi_nomux_table[] = {
|
|
{
|
|
.ident = "Fujitsu Lifebook P7010/P7010D",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "P7010"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Fujitsu Lifebook P5020D",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P Series"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Fujitsu Lifebook S2000",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook S Series"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Fujitsu Lifebook S6230",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook S6230"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Fujitsu T70H",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "FMVLT70H"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Fujitsu-Siemens Lifebook T3010",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK T3010"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Fujitsu-Siemens Lifebook E4010",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK E4010"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Toshiba P10",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "Satellite P10"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Alienware Sentia",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "ALIENWARE"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "Sentia"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Sharp Actius MM20",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "SHARP"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "PC-MM20 Series"),
|
|
},
|
|
},
|
|
{
|
|
.ident = "Sony Vaio FS-115b",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "VGN-FS115B"),
|
|
},
|
|
},
|
|
{ }
|
|
};
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
#ifdef CONFIG_PNP
|
|
#include <linux/pnp.h>
|
|
|
|
static int i8042_pnp_kbd_registered;
|
|
static unsigned int i8042_pnp_kbd_devices;
|
|
static int i8042_pnp_aux_registered;
|
|
static unsigned int i8042_pnp_aux_devices;
|
|
|
|
static int i8042_pnp_command_reg;
|
|
static int i8042_pnp_data_reg;
|
|
static int i8042_pnp_kbd_irq;
|
|
static int i8042_pnp_aux_irq;
|
|
|
|
static char i8042_pnp_kbd_name[32];
|
|
static char i8042_pnp_aux_name[32];
|
|
|
|
static int i8042_pnp_kbd_probe(struct pnp_dev *dev, const struct pnp_device_id *did)
|
|
{
|
|
if (pnp_port_valid(dev, 0) && pnp_port_len(dev, 0) == 1)
|
|
i8042_pnp_data_reg = pnp_port_start(dev,0);
|
|
|
|
if (pnp_port_valid(dev, 1) && pnp_port_len(dev, 1) == 1)
|
|
i8042_pnp_command_reg = pnp_port_start(dev, 1);
|
|
|
|
if (pnp_irq_valid(dev,0))
|
|
i8042_pnp_kbd_irq = pnp_irq(dev, 0);
|
|
|
|
strncpy(i8042_pnp_kbd_name, did->id, sizeof(i8042_pnp_kbd_name));
|
|
if (strlen(pnp_dev_name(dev))) {
|
|
strncat(i8042_pnp_kbd_name, ":", sizeof(i8042_pnp_kbd_name));
|
|
strncat(i8042_pnp_kbd_name, pnp_dev_name(dev), sizeof(i8042_pnp_kbd_name));
|
|
}
|
|
|
|
i8042_pnp_kbd_devices++;
|
|
return 0;
|
|
}
|
|
|
|
static int i8042_pnp_aux_probe(struct pnp_dev *dev, const struct pnp_device_id *did)
|
|
{
|
|
if (pnp_port_valid(dev, 0) && pnp_port_len(dev, 0) == 1)
|
|
i8042_pnp_data_reg = pnp_port_start(dev,0);
|
|
|
|
if (pnp_port_valid(dev, 1) && pnp_port_len(dev, 1) == 1)
|
|
i8042_pnp_command_reg = pnp_port_start(dev, 1);
|
|
|
|
if (pnp_irq_valid(dev, 0))
|
|
i8042_pnp_aux_irq = pnp_irq(dev, 0);
|
|
|
|
strncpy(i8042_pnp_aux_name, did->id, sizeof(i8042_pnp_aux_name));
|
|
if (strlen(pnp_dev_name(dev))) {
|
|
strncat(i8042_pnp_aux_name, ":", sizeof(i8042_pnp_aux_name));
|
|
strncat(i8042_pnp_aux_name, pnp_dev_name(dev), sizeof(i8042_pnp_aux_name));
|
|
}
|
|
|
|
i8042_pnp_aux_devices++;
|
|
return 0;
|
|
}
|
|
|
|
static struct pnp_device_id pnp_kbd_devids[] = {
|
|
{ .id = "PNP0303", .driver_data = 0 },
|
|
{ .id = "PNP030b", .driver_data = 0 },
|
|
{ .id = "", },
|
|
};
|
|
|
|
static struct pnp_driver i8042_pnp_kbd_driver = {
|
|
.name = "i8042 kbd",
|
|
.id_table = pnp_kbd_devids,
|
|
.probe = i8042_pnp_kbd_probe,
|
|
};
|
|
|
|
static struct pnp_device_id pnp_aux_devids[] = {
|
|
{ .id = "PNP0f03", .driver_data = 0 },
|
|
{ .id = "PNP0f0b", .driver_data = 0 },
|
|
{ .id = "PNP0f0e", .driver_data = 0 },
|
|
{ .id = "PNP0f12", .driver_data = 0 },
|
|
{ .id = "PNP0f13", .driver_data = 0 },
|
|
{ .id = "PNP0f19", .driver_data = 0 },
|
|
{ .id = "PNP0f1c", .driver_data = 0 },
|
|
{ .id = "SYN0801", .driver_data = 0 },
|
|
{ .id = "", },
|
|
};
|
|
|
|
static struct pnp_driver i8042_pnp_aux_driver = {
|
|
.name = "i8042 aux",
|
|
.id_table = pnp_aux_devids,
|
|
.probe = i8042_pnp_aux_probe,
|
|
};
|
|
|
|
static void i8042_pnp_exit(void)
|
|
{
|
|
if (i8042_pnp_kbd_registered) {
|
|
i8042_pnp_kbd_registered = 0;
|
|
pnp_unregister_driver(&i8042_pnp_kbd_driver);
|
|
}
|
|
|
|
if (i8042_pnp_aux_registered) {
|
|
i8042_pnp_aux_registered = 0;
|
|
pnp_unregister_driver(&i8042_pnp_aux_driver);
|
|
}
|
|
}
|
|
|
|
static int __init i8042_pnp_init(void)
|
|
{
|
|
char kbd_irq_str[4] = { 0 }, aux_irq_str[4] = { 0 };
|
|
int err;
|
|
|
|
if (i8042_nopnp) {
|
|
printk(KERN_INFO "i8042: PNP detection disabled\n");
|
|
return 0;
|
|
}
|
|
|
|
err = pnp_register_driver(&i8042_pnp_kbd_driver);
|
|
if (!err)
|
|
i8042_pnp_kbd_registered = 1;
|
|
|
|
err = pnp_register_driver(&i8042_pnp_aux_driver);
|
|
if (!err)
|
|
i8042_pnp_aux_registered = 1;
|
|
|
|
if (!i8042_pnp_kbd_devices && !i8042_pnp_aux_devices) {
|
|
i8042_pnp_exit();
|
|
#if defined(__ia64__)
|
|
return -ENODEV;
|
|
#else
|
|
printk(KERN_INFO "PNP: No PS/2 controller found. Probing ports directly.\n");
|
|
return 0;
|
|
#endif
|
|
}
|
|
|
|
if (i8042_pnp_kbd_devices)
|
|
snprintf(kbd_irq_str, sizeof(kbd_irq_str),
|
|
"%d", i8042_pnp_kbd_irq);
|
|
if (i8042_pnp_aux_devices)
|
|
snprintf(aux_irq_str, sizeof(aux_irq_str),
|
|
"%d", i8042_pnp_aux_irq);
|
|
|
|
printk(KERN_INFO "PNP: PS/2 Controller [%s%s%s] at %#x,%#x irq %s%s%s\n",
|
|
i8042_pnp_kbd_name, (i8042_pnp_kbd_devices && i8042_pnp_aux_devices) ? "," : "",
|
|
i8042_pnp_aux_name,
|
|
i8042_pnp_data_reg, i8042_pnp_command_reg,
|
|
kbd_irq_str, (i8042_pnp_kbd_devices && i8042_pnp_aux_devices) ? "," : "",
|
|
aux_irq_str);
|
|
|
|
#if defined(__ia64__)
|
|
if (!i8042_pnp_kbd_devices)
|
|
i8042_nokbd = 1;
|
|
if (!i8042_pnp_aux_devices)
|
|
i8042_noaux = 1;
|
|
#endif
|
|
|
|
if (((i8042_pnp_data_reg & ~0xf) == (i8042_data_reg & ~0xf) &&
|
|
i8042_pnp_data_reg != i8042_data_reg) || !i8042_pnp_data_reg) {
|
|
printk(KERN_WARNING "PNP: PS/2 controller has invalid data port %#x; using default %#x\n",
|
|
i8042_pnp_data_reg, i8042_data_reg);
|
|
i8042_pnp_data_reg = i8042_data_reg;
|
|
}
|
|
|
|
if (((i8042_pnp_command_reg & ~0xf) == (i8042_command_reg & ~0xf) &&
|
|
i8042_pnp_command_reg != i8042_command_reg) || !i8042_pnp_command_reg) {
|
|
printk(KERN_WARNING "PNP: PS/2 controller has invalid command port %#x; using default %#x\n",
|
|
i8042_pnp_command_reg, i8042_command_reg);
|
|
i8042_pnp_command_reg = i8042_command_reg;
|
|
}
|
|
|
|
if (!i8042_nokbd && !i8042_pnp_kbd_irq) {
|
|
printk(KERN_WARNING "PNP: PS/2 controller doesn't have KBD irq; using default %d\n", i8042_kbd_irq);
|
|
i8042_pnp_kbd_irq = i8042_kbd_irq;
|
|
}
|
|
|
|
if (!i8042_noaux && !i8042_pnp_aux_irq) {
|
|
printk(KERN_WARNING "PNP: PS/2 controller doesn't have AUX irq; using default %d\n", i8042_aux_irq);
|
|
i8042_pnp_aux_irq = i8042_aux_irq;
|
|
}
|
|
|
|
i8042_data_reg = i8042_pnp_data_reg;
|
|
i8042_command_reg = i8042_pnp_command_reg;
|
|
i8042_kbd_irq = i8042_pnp_kbd_irq;
|
|
i8042_aux_irq = i8042_pnp_aux_irq;
|
|
|
|
return 0;
|
|
}
|
|
|
|
#else
|
|
static inline int i8042_pnp_init(void) { return 0; }
|
|
static inline void i8042_pnp_exit(void) { }
|
|
#endif
|
|
|
|
static int __init i8042_platform_init(void)
|
|
{
|
|
int retval;
|
|
|
|
/*
|
|
* On ix86 platforms touching the i8042 data register region can do really
|
|
* bad things. Because of this the region is always reserved on ix86 boxes.
|
|
*
|
|
* if (!request_region(I8042_DATA_REG, 16, "i8042"))
|
|
* return -EBUSY;
|
|
*/
|
|
|
|
i8042_kbd_irq = I8042_MAP_IRQ(1);
|
|
i8042_aux_irq = I8042_MAP_IRQ(12);
|
|
|
|
retval = i8042_pnp_init();
|
|
if (retval)
|
|
return retval;
|
|
|
|
#if defined(__ia64__)
|
|
i8042_reset = 1;
|
|
#endif
|
|
|
|
#if defined(__i386__)
|
|
if (dmi_check_system(i8042_dmi_noloop_table))
|
|
i8042_noloop = 1;
|
|
|
|
if (dmi_check_system(i8042_dmi_nomux_table))
|
|
i8042_nomux = 1;
|
|
#endif
|
|
|
|
return retval;
|
|
}
|
|
|
|
static inline void i8042_platform_exit(void)
|
|
{
|
|
i8042_pnp_exit();
|
|
}
|
|
|
|
#endif /* _I8042_X86IA64IO_H */
|