Re: [PATCH] Input: i8042 - Add PNP checking hook for Loongson

From: Huacai Chen
Date: Fri Sep 16 2022 - 05:54:06 EST

Next message: xmzyshypnc: "[PATCH] misc: sgi-gru: fix use-after-free error in gru_set_context_option, gru_fault and gru_handle_user_call_os"
Previous message: patchwork-bot+netdevbpf: "Re: [PATCH net-next 0/3] net: amd: Cleanup for clearing static warnings"
Next in thread: Arnd Bergmann: "Re: [PATCH] Input: i8042 - Add PNP checking hook for Loongson"
Messages sorted by: [ date ] [ thread ] [ subject ] [ author ]

Ping?

On Thu, Aug 18, 2022 at 12:04 PM Huacai Chen <chenhuacai@xxxxxxxxxxx> wrote:
>
> Add PNP checking related functions for Loongson, so that i8042 driver
> can work well under the ACPI firmware with PNP typed keyboard and mouse
> configured in DSDT.
>
> Signed-off-by: Jianmin Lv <lvjianmin@xxxxxxxxxxx>
> Signed-off-by: Huacai Chen <chenhuacai@xxxxxxxxxxx>
> ---
> drivers/input/serio/i8042-loongsonio.h | 330 +++++++++++++++++++++++++
> drivers/input/serio/i8042.h | 2 +
> 2 files changed, 332 insertions(+)
> create mode 100644 drivers/input/serio/i8042-loongsonio.h
>
> diff --git a/drivers/input/serio/i8042-loongsonio.h b/drivers/input/serio/i8042-loongsonio.h
> new file mode 100644
> index 000000000000..2ea83b14f13d
> --- /dev/null
> +++ b/drivers/input/serio/i8042-loongsonio.h
> @@ -0,0 +1,330 @@
> +/* SPDX-License-Identifier: GPL-2.0-only */
> +/*
> + * i8042-loongsonio.h
> + *
> + * Copyright (C) 2020 Loongson Technology Corporation Limited
> + * Author: Jianmin Lv <lvjianmin@xxxxxxxxxxx>
> + * Huacai Chen <chenhuacai@xxxxxxxxxxx>
> + */
> +
> +#ifndef _I8042_LOONGSONIO_H
> +#define _I8042_LOONGSONIO_H
> +
> +/*
> + * Names.
> + */
> +
> +#define I8042_KBD_PHYS_DESC "isa0060/serio0"
> +#define I8042_AUX_PHYS_DESC "isa0060/serio1"
> +#define I8042_MUX_PHYS_DESC "isa0060/serio%d"
> +
> +/*
> + * IRQs.
> + */
> +#define I8042_MAP_IRQ(x) (x)
> +
> +#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);
> +}
> +
> +#ifdef CONFIG_PNP
> +#include <linux/pnp.h>
> +
> +static bool i8042_pnp_kbd_registered;
> +static unsigned int i8042_pnp_kbd_devices;
> +static bool 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 void i8042_pnp_id_to_string(struct pnp_id *id, char *dst, int dst_size)
> +{
> + strlcpy(dst, "PNP:", dst_size);
> +
> + while (id) {
> + strlcat(dst, " ", dst_size);
> + strlcat(dst, id->id, dst_size);
> + id = id->next;
> + }
> +}
> +
> +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);
> +
> + strlcpy(i8042_pnp_kbd_name, did->id, sizeof(i8042_pnp_kbd_name));
> + if (strlen(pnp_dev_name(dev))) {
> + strlcat(i8042_pnp_kbd_name, ":", sizeof(i8042_pnp_kbd_name));
> + strlcat(i8042_pnp_kbd_name, pnp_dev_name(dev),
> + sizeof(i8042_pnp_kbd_name));
> + }
> + i8042_pnp_id_to_string(dev->id, i8042_kbd_firmware_id,
> + sizeof(i8042_kbd_firmware_id));
> +
> + /* Keyboard ports are always supposed to be wakeup-enabled */
> + device_set_wakeup_enable(&dev->dev, true);
> +
> + 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);
> +
> + strlcpy(i8042_pnp_aux_name, did->id, sizeof(i8042_pnp_aux_name));
> + if (strlen(pnp_dev_name(dev))) {
> + strlcat(i8042_pnp_aux_name, ":", sizeof(i8042_pnp_aux_name));
> + strlcat(i8042_pnp_aux_name, pnp_dev_name(dev),
> + sizeof(i8042_pnp_aux_name));
> + }
> + i8042_pnp_id_to_string(dev->id, i8042_aux_firmware_id,
> + sizeof(i8042_aux_firmware_id));
> +
> + i8042_pnp_aux_devices++;
> + return 0;
> +}
> +
> +static const struct pnp_device_id pnp_kbd_devids[] = {
> + { .id = "PNP0300", .driver_data = 0 },
> + { .id = "PNP0301", .driver_data = 0 },
> + { .id = "PNP0302", .driver_data = 0 },
> + { .id = "PNP0303", .driver_data = 0 },
> + { .id = "PNP0304", .driver_data = 0 },
> + { .id = "PNP0305", .driver_data = 0 },
> + { .id = "PNP0306", .driver_data = 0 },
> + { .id = "PNP0309", .driver_data = 0 },
> + { .id = "PNP030a", .driver_data = 0 },
> + { .id = "PNP030b", .driver_data = 0 },
> + { .id = "PNP0320", .driver_data = 0 },
> + { .id = "PNP0343", .driver_data = 0 },
> + { .id = "PNP0344", .driver_data = 0 },
> + { .id = "PNP0345", .driver_data = 0 },
> + { .id = "CPQA0D7", .driver_data = 0 },
> + { .id = "", },
> +};
> +MODULE_DEVICE_TABLE(pnp, pnp_kbd_devids);
> +
> +static struct pnp_driver i8042_pnp_kbd_driver = {
> + .name = "i8042 kbd",
> + .id_table = pnp_kbd_devids,
> + .probe = i8042_pnp_kbd_probe,
> + .driver = {
> + .probe_type = PROBE_FORCE_SYNCHRONOUS,
> + .suppress_bind_attrs = true,
> + },
> +};
> +
> +static const struct pnp_device_id pnp_aux_devids[] = {
> + { .id = "AUI0200", .driver_data = 0 },
> + { .id = "FJC6000", .driver_data = 0 },
> + { .id = "FJC6001", .driver_data = 0 },
> + { .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 = "", },
> +};
> +MODULE_DEVICE_TABLE(pnp, pnp_aux_devids);
> +
> +static struct pnp_driver i8042_pnp_aux_driver = {
> + .name = "i8042 aux",
> + .id_table = pnp_aux_devids,
> + .probe = i8042_pnp_aux_probe,
> + .driver = {
> + .probe_type = PROBE_FORCE_SYNCHRONOUS,
> + .suppress_bind_attrs = true,
> + },
> +};
> +
> +static void i8042_pnp_exit(void)
> +{
> + if (i8042_pnp_kbd_registered) {
> + i8042_pnp_kbd_registered = false;
> + pnp_unregister_driver(&i8042_pnp_kbd_driver);
> + }
> +
> + if (i8042_pnp_aux_registered) {
> + i8042_pnp_aux_registered = false;
> + pnp_unregister_driver(&i8042_pnp_aux_driver);
> + }
> +}
> +#ifdef CONFIG_ACPI
> +#include <linux/acpi.h>
> +#endif
> +static int __init i8042_pnp_init(void)
> +{
> + char kbd_irq_str[4] = { 0 }, aux_irq_str[4] = { 0 };
> + bool pnp_data_busted = false;
> + int err;
> +
> + if (i8042_nopnp) {
> + pr_info("PNP detection disabled\n");
> + return 0;
> + }
> +
> + err = pnp_register_driver(&i8042_pnp_kbd_driver);
> + if (!err)
> + i8042_pnp_kbd_registered = true;
> +
> + err = pnp_register_driver(&i8042_pnp_aux_driver);
> + if (!err)
> + i8042_pnp_aux_registered = true;
> +
> + if (!i8042_pnp_kbd_devices && !i8042_pnp_aux_devices) {
> + i8042_pnp_exit();
> + pr_info("PNP: No PS/2 controller found.\n");
> +#ifdef CONFIG_ACPI
> + if (acpi_disabled == 0)
> + return -ENODEV;
> +#endif
> + pr_info("Probing ports directly.\n");
> + return 0;
> + }
> +
> + 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);
> +
> + pr_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 (((i8042_pnp_data_reg & ~0xf) == (i8042_data_reg & ~0xf) &&
> + i8042_pnp_data_reg != i8042_data_reg) ||
> + !i8042_pnp_data_reg) {
> + pr_warn("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;
> + pnp_data_busted = true;
> + }
> +
> + if (((i8042_pnp_command_reg & ~0xf) == (i8042_command_reg & ~0xf) &&
> + i8042_pnp_command_reg != i8042_command_reg) ||
> + !i8042_pnp_command_reg) {
> + pr_warn("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;
> + pnp_data_busted = true;
> + }
> +
> + if (!i8042_nokbd && !i8042_pnp_kbd_irq) {
> + pr_warn("PNP: PS/2 controller doesn't have KBD irq; using default %d\n",
> + i8042_kbd_irq);
> + i8042_pnp_kbd_irq = i8042_kbd_irq;
> + pnp_data_busted = true;
> + }
> +
> + if (!i8042_noaux && !i8042_pnp_aux_irq) {
> + if (!pnp_data_busted && i8042_pnp_kbd_irq) {
> + pr_warn("PNP: PS/2 appears to have AUX port disabled, "
> + "if this is incorrect please boot with i8042.nopnp\n");
> + i8042_noaux = true;
> + } else {
> + pr_warn("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 /* !CONFIG_PNP */
> +static inline int i8042_pnp_init(void) { return 0; }
> +static inline void i8042_pnp_exit(void) { }
> +#endif /* CONFIG_PNP */
> +
> +static int __init i8042_platform_init(void)
> +{
> + int retval;
> +
> + i8042_kbd_irq = I8042_MAP_IRQ(1);
> + i8042_aux_irq = I8042_MAP_IRQ(12);
> +
> + retval = i8042_pnp_init();
> + if (retval)
> + return retval;
> +
> + return retval;
> +}
> +
> +static inline void i8042_platform_exit(void)
> +{
> + i8042_pnp_exit();
> +}
> +
> +#endif /* _I8042_LOONGSONIO_H */
> diff --git a/drivers/input/serio/i8042.h b/drivers/input/serio/i8042.h
> index 55381783dc82..166bd69841cf 100644
> --- a/drivers/input/serio/i8042.h
> +++ b/drivers/input/serio/i8042.h
> @@ -19,6 +19,8 @@
> #include "i8042-snirm.h"
> #elif defined(CONFIG_SPARC)
> #include "i8042-sparcio.h"
> +#elif defined(CONFIG_MACH_LOONGSON64)
> +#include "i8042-loongsonio.h"
> #elif defined(CONFIG_X86) || defined(CONFIG_IA64)
> #include "i8042-x86ia64io.h"
> #else
> --
> 2.31.1
>
>

Next message: xmzyshypnc: "[PATCH] misc: sgi-gru: fix use-after-free error in gru_set_context_option, gru_fault and gru_handle_user_call_os"
Previous message: patchwork-bot+netdevbpf: "Re: [PATCH net-next 0/3] net: amd: Cleanup for clearing static warnings"
Next in thread: Arnd Bergmann: "Re: [PATCH] Input: i8042 - Add PNP checking hook for Loongson"
Messages sorted by: [ date ] [ thread ] [ subject ] [ author ]