drm/tests: hdmi: Fix memory leaks in drm_display_mode_from_cea_vic()
[drm/drm-misc.git] / drivers / input / keyboard / ipaq-micro-keys.c
blob1d71dd79ffd289cb563271eb3c0547ade0dccdd0
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
4 * h3600 atmel micro companion support, key subdevice
5 * based on previous kernel 2.4 version
6 * Author : Alessandro Gardich <gremlin@gremlin.it>
7 * Author : Linus Walleij <linus.walleij@linaro.org>
8 */
9 #include <linux/module.h>
10 #include <linux/init.h>
11 #include <linux/fs.h>
12 #include <linux/interrupt.h>
13 #include <linux/sched.h>
14 #include <linux/pm.h>
15 #include <linux/sysctl.h>
16 #include <linux/proc_fs.h>
17 #include <linux/delay.h>
18 #include <linux/device.h>
19 #include <linux/input.h>
20 #include <linux/platform_device.h>
21 #include <linux/mfd/ipaq-micro.h>
23 struct ipaq_micro_keys {
24 struct ipaq_micro *micro;
25 struct input_dev *input;
26 u16 *codes;
29 static const u16 micro_keycodes[] = {
30 KEY_RECORD, /* 1: Record button */
31 KEY_CALENDAR, /* 2: Calendar */
32 KEY_ADDRESSBOOK, /* 3: Contacts (looks like Outlook) */
33 KEY_MAIL, /* 4: Envelope (Q on older iPAQs) */
34 KEY_HOMEPAGE, /* 5: Start (looks like swoopy arrow) */
35 KEY_UP, /* 6: Up */
36 KEY_RIGHT, /* 7: Right */
37 KEY_LEFT, /* 8: Left */
38 KEY_DOWN, /* 9: Down */
41 static void micro_key_receive(void *data, int len, unsigned char *msg)
43 struct ipaq_micro_keys *keys = data;
44 int key, down;
46 down = 0x80 & msg[0];
47 key = 0x7f & msg[0];
49 if (key < ARRAY_SIZE(micro_keycodes)) {
50 input_report_key(keys->input, keys->codes[key], down);
51 input_sync(keys->input);
55 static void micro_key_start(struct ipaq_micro_keys *keys)
57 spin_lock(&keys->micro->lock);
58 keys->micro->key = micro_key_receive;
59 keys->micro->key_data = keys;
60 spin_unlock(&keys->micro->lock);
63 static void micro_key_stop(struct ipaq_micro_keys *keys)
65 spin_lock(&keys->micro->lock);
66 keys->micro->key = NULL;
67 keys->micro->key_data = NULL;
68 spin_unlock(&keys->micro->lock);
71 static int micro_key_open(struct input_dev *input)
73 struct ipaq_micro_keys *keys = input_get_drvdata(input);
75 micro_key_start(keys);
77 return 0;
80 static void micro_key_close(struct input_dev *input)
82 struct ipaq_micro_keys *keys = input_get_drvdata(input);
84 micro_key_stop(keys);
87 static int micro_key_probe(struct platform_device *pdev)
89 struct ipaq_micro_keys *keys;
90 int error;
91 int i;
93 keys = devm_kzalloc(&pdev->dev, sizeof(*keys), GFP_KERNEL);
94 if (!keys)
95 return -ENOMEM;
97 keys->micro = dev_get_drvdata(pdev->dev.parent);
99 keys->input = devm_input_allocate_device(&pdev->dev);
100 if (!keys->input)
101 return -ENOMEM;
103 keys->input->keycodesize = sizeof(micro_keycodes[0]);
104 keys->input->keycodemax = ARRAY_SIZE(micro_keycodes);
105 keys->codes = devm_kmemdup(&pdev->dev, micro_keycodes,
106 keys->input->keycodesize * keys->input->keycodemax,
107 GFP_KERNEL);
108 if (!keys->codes)
109 return -ENOMEM;
111 keys->input->keycode = keys->codes;
113 __set_bit(EV_KEY, keys->input->evbit);
114 for (i = 0; i < ARRAY_SIZE(micro_keycodes); i++)
115 __set_bit(micro_keycodes[i], keys->input->keybit);
117 keys->input->name = "h3600 micro keys";
118 keys->input->open = micro_key_open;
119 keys->input->close = micro_key_close;
120 input_set_drvdata(keys->input, keys);
122 error = input_register_device(keys->input);
123 if (error)
124 return error;
126 platform_set_drvdata(pdev, keys);
127 return 0;
130 static int micro_key_suspend(struct device *dev)
132 struct ipaq_micro_keys *keys = dev_get_drvdata(dev);
134 micro_key_stop(keys);
136 return 0;
139 static int micro_key_resume(struct device *dev)
141 struct ipaq_micro_keys *keys = dev_get_drvdata(dev);
142 struct input_dev *input = keys->input;
144 mutex_lock(&input->mutex);
146 if (input_device_enabled(input))
147 micro_key_start(keys);
149 mutex_unlock(&input->mutex);
151 return 0;
154 static DEFINE_SIMPLE_DEV_PM_OPS(micro_key_dev_pm_ops,
155 micro_key_suspend, micro_key_resume);
157 static struct platform_driver micro_key_device_driver = {
158 .driver = {
159 .name = "ipaq-micro-keys",
160 .pm = pm_sleep_ptr(&micro_key_dev_pm_ops),
162 .probe = micro_key_probe,
164 module_platform_driver(micro_key_device_driver);
166 MODULE_LICENSE("GPL");
167 MODULE_DESCRIPTION("driver for iPAQ Atmel micro keys");
168 MODULE_ALIAS("platform:ipaq-micro-keys");