123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * nvec_kbd: keyboard driver for a NVIDIA compliant embedded controller
- *
- * Copyright (C) 2011 The AC100 Kernel Team <ac100@lists.launchpad.net>
- *
- * Authors: Pierre-Hugues Husson <phhusson@free.fr>
- * Marc Dietrich <marvin24@gmx.de>
- */
- #include <linux/module.h>
- #include <linux/slab.h>
- #include <linux/input.h>
- #include <linux/delay.h>
- #include <linux/platform_device.h>
- #include "nvec-keytable.h"
- #include "nvec.h"
- enum kbd_subcmds {
- CNFG_WAKE = 3,
- CNFG_WAKE_KEY_REPORTING,
- SET_LEDS = 0xed,
- ENABLE_KBD = 0xf4,
- DISABLE_KBD,
- };
- static unsigned char keycodes[ARRAY_SIZE(code_tab_102us)
- + ARRAY_SIZE(extcode_tab_us102)];
- struct nvec_keys {
- struct input_dev *input;
- struct notifier_block notifier;
- struct nvec_chip *nvec;
- bool caps_lock;
- };
- static struct nvec_keys keys_dev;
- static void nvec_kbd_toggle_led(void)
- {
- char buf[] = { NVEC_KBD, SET_LEDS, 0 };
- keys_dev.caps_lock = !keys_dev.caps_lock;
- if (keys_dev.caps_lock)
- /* should be BIT(0) only, firmware bug? */
- buf[2] = BIT(0) | BIT(1) | BIT(2);
- nvec_write_async(keys_dev.nvec, buf, sizeof(buf));
- }
- static int nvec_keys_notifier(struct notifier_block *nb,
- unsigned long event_type, void *data)
- {
- int code, state;
- unsigned char *msg = data;
- if (event_type == NVEC_KB_EVT) {
- int _size = (msg[0] & (3 << 5)) >> 5;
- /* power on/off button */
- if (_size == NVEC_VAR_SIZE)
- return NOTIFY_STOP;
- if (_size == NVEC_3BYTES)
- msg++;
- code = msg[1] & 0x7f;
- state = msg[1] & 0x80;
- if (code_tabs[_size][code] == KEY_CAPSLOCK && state)
- nvec_kbd_toggle_led();
- input_report_key(keys_dev.input, code_tabs[_size][code],
- !state);
- input_sync(keys_dev.input);
- return NOTIFY_STOP;
- }
- return NOTIFY_DONE;
- }
- static int nvec_kbd_event(struct input_dev *dev, unsigned int type,
- unsigned int code, int value)
- {
- struct nvec_chip *nvec = keys_dev.nvec;
- char buf[] = { NVEC_KBD, SET_LEDS, 0 };
- if (type == EV_REP)
- return 0;
- if (type != EV_LED)
- return -1;
- if (code != LED_CAPSL)
- return -1;
- buf[2] = !!value;
- nvec_write_async(nvec, buf, sizeof(buf));
- return 0;
- }
- static int nvec_kbd_probe(struct platform_device *pdev)
- {
- struct nvec_chip *nvec = dev_get_drvdata(pdev->dev.parent);
- int i, j, err;
- struct input_dev *idev;
- char clear_leds[] = { NVEC_KBD, SET_LEDS, 0 },
- enable_kbd[] = { NVEC_KBD, ENABLE_KBD },
- cnfg_wake[] = { NVEC_KBD, CNFG_WAKE, true, true },
- cnfg_wake_key_reporting[] = { NVEC_KBD, CNFG_WAKE_KEY_REPORTING,
- true };
- j = 0;
- for (i = 0; i < ARRAY_SIZE(code_tab_102us); ++i)
- keycodes[j++] = code_tab_102us[i];
- for (i = 0; i < ARRAY_SIZE(extcode_tab_us102); ++i)
- keycodes[j++] = extcode_tab_us102[i];
- idev = devm_input_allocate_device(&pdev->dev);
- if (!idev)
- return -ENOMEM;
- idev->name = "nvec keyboard";
- idev->phys = "nvec";
- idev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP) | BIT_MASK(EV_LED);
- idev->ledbit[0] = BIT_MASK(LED_CAPSL);
- idev->event = nvec_kbd_event;
- idev->keycode = keycodes;
- idev->keycodesize = sizeof(unsigned char);
- idev->keycodemax = ARRAY_SIZE(keycodes);
- for (i = 0; i < ARRAY_SIZE(keycodes); ++i)
- set_bit(keycodes[i], idev->keybit);
- clear_bit(0, idev->keybit);
- err = input_register_device(idev);
- if (err)
- return err;
- keys_dev.input = idev;
- keys_dev.notifier.notifier_call = nvec_keys_notifier;
- keys_dev.nvec = nvec;
- nvec_register_notifier(nvec, &keys_dev.notifier, 0);
- /* Enable keyboard */
- nvec_write_async(nvec, enable_kbd, 2);
- /* configures wake on special keys */
- nvec_write_async(nvec, cnfg_wake, 4);
- /* enable wake key reporting */
- nvec_write_async(nvec, cnfg_wake_key_reporting, 3);
- /* Disable caps lock LED */
- nvec_write_async(nvec, clear_leds, sizeof(clear_leds));
- return 0;
- }
- static int nvec_kbd_remove(struct platform_device *pdev)
- {
- struct nvec_chip *nvec = dev_get_drvdata(pdev->dev.parent);
- char disable_kbd[] = { NVEC_KBD, DISABLE_KBD },
- uncnfg_wake_key_reporting[] = { NVEC_KBD, CNFG_WAKE_KEY_REPORTING,
- false };
- nvec_write_async(nvec, uncnfg_wake_key_reporting, 3);
- nvec_write_async(nvec, disable_kbd, 2);
- nvec_unregister_notifier(nvec, &keys_dev.notifier);
- return 0;
- }
- static struct platform_driver nvec_kbd_driver = {
- .probe = nvec_kbd_probe,
- .remove = nvec_kbd_remove,
- .driver = {
- .name = "nvec-kbd",
- },
- };
- module_platform_driver(nvec_kbd_driver);
- MODULE_AUTHOR("Marc Dietrich <marvin24@gmx.de>");
- MODULE_DESCRIPTION("NVEC keyboard driver");
- MODULE_ALIAS("platform:nvec-kbd");
- MODULE_LICENSE("GPL");
|