mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-23 09:19:51 +00:00
![Wolfram Sang](/assets/img/avatar_default.png)
A platform_driver does not need to set an owner, it will be populated by the driver core. Signed-off-by: Wolfram Sang <wsa@the-dreams.de>
192 lines
4.6 KiB
C
192 lines
4.6 KiB
C
/*
|
|
* 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>
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License. See the file "COPYING" in the main directory of this archive
|
|
* for more details.
|
|
*
|
|
*/
|
|
|
|
#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 = (unsigned char *)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);
|
|
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");
|