Commit | Line | Data |
---|---|---|
bebb8a2b YY |
1 | /* |
2 | * Cobalt button interface driver. | |
3 | * | |
ada8e951 | 4 | * Copyright (C) 2007-2008 Yoichi Yuasa <yuasa@linux-mips.org> |
bebb8a2b YY |
5 | * |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License as published by | |
8 | * the Free Software Foundation; either version 2 of the License, or | |
9 | * (at your option) any later version. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, | |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | * GNU General Public License for more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License | |
17 | * along with this program; if not, write to the Free Software | |
3c514387 | 18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
bebb8a2b YY |
19 | */ |
20 | #include <linux/init.h> | |
3d29cdff | 21 | #include <linux/input-polldev.h> |
bebb8a2b YY |
22 | #include <linux/ioport.h> |
23 | #include <linux/module.h> | |
24 | #include <linux/platform_device.h> | |
5a0e3ad6 | 25 | #include <linux/slab.h> |
bebb8a2b YY |
26 | |
27 | #define BUTTONS_POLL_INTERVAL 30 /* msec */ | |
28 | #define BUTTONS_COUNT_THRESHOLD 3 | |
29 | #define BUTTONS_STATUS_MASK 0xfe000000 | |
30 | ||
b037b08e DT |
31 | static const unsigned short cobalt_map[] = { |
32 | KEY_RESERVED, | |
33 | KEY_RESTART, | |
34 | KEY_LEFT, | |
35 | KEY_UP, | |
36 | KEY_DOWN, | |
37 | KEY_RIGHT, | |
38 | KEY_ENTER, | |
39 | KEY_SELECT | |
40 | }; | |
41 | ||
bebb8a2b | 42 | struct buttons_dev { |
3d29cdff | 43 | struct input_polled_dev *poll_dev; |
b037b08e DT |
44 | unsigned short keymap[ARRAY_SIZE(cobalt_map)]; |
45 | int count[ARRAY_SIZE(cobalt_map)]; | |
bebb8a2b YY |
46 | void __iomem *reg; |
47 | }; | |
48 | ||
3d29cdff | 49 | static void handle_buttons(struct input_polled_dev *dev) |
bebb8a2b | 50 | { |
3d29cdff DT |
51 | struct buttons_dev *bdev = dev->private; |
52 | struct input_dev *input = dev->input; | |
bebb8a2b YY |
53 | uint32_t status; |
54 | int i; | |
55 | ||
b037b08e | 56 | status = ~readl(bdev->reg) >> 24; |
bebb8a2b | 57 | |
b037b08e | 58 | for (i = 0; i < ARRAY_SIZE(bdev->keymap); i++) { |
3c514387 | 59 | if (status & (1U << i)) { |
b037b08e DT |
60 | if (++bdev->count[i] == BUTTONS_COUNT_THRESHOLD) { |
61 | input_event(input, EV_MSC, MSC_SCAN, i); | |
62 | input_report_key(input, bdev->keymap[i], 1); | |
63 | input_sync(input); | |
64 | } | |
bebb8a2b | 65 | } else { |
b037b08e DT |
66 | if (bdev->count[i] >= BUTTONS_COUNT_THRESHOLD) { |
67 | input_event(input, EV_MSC, MSC_SCAN, i); | |
68 | input_report_key(input, bdev->keymap[i], 0); | |
3d29cdff | 69 | input_sync(input); |
bebb8a2b | 70 | } |
b037b08e | 71 | bdev->count[i] = 0; |
bebb8a2b | 72 | } |
bebb8a2b | 73 | } |
bebb8a2b YY |
74 | } |
75 | ||
5298cc4c | 76 | static int cobalt_buttons_probe(struct platform_device *pdev) |
bebb8a2b YY |
77 | { |
78 | struct buttons_dev *bdev; | |
3d29cdff | 79 | struct input_polled_dev *poll_dev; |
bebb8a2b YY |
80 | struct input_dev *input; |
81 | struct resource *res; | |
82 | int error, i; | |
83 | ||
84 | bdev = kzalloc(sizeof(struct buttons_dev), GFP_KERNEL); | |
3d29cdff DT |
85 | poll_dev = input_allocate_polled_device(); |
86 | if (!bdev || !poll_dev) { | |
bebb8a2b YY |
87 | error = -ENOMEM; |
88 | goto err_free_mem; | |
89 | } | |
90 | ||
b037b08e DT |
91 | memcpy(bdev->keymap, cobalt_map, sizeof(bdev->keymap)); |
92 | ||
3d29cdff DT |
93 | poll_dev->private = bdev; |
94 | poll_dev->poll = handle_buttons; | |
95 | poll_dev->poll_interval = BUTTONS_POLL_INTERVAL; | |
96 | ||
97 | input = poll_dev->input; | |
bebb8a2b YY |
98 | input->name = "Cobalt buttons"; |
99 | input->phys = "cobalt/input0"; | |
100 | input->id.bustype = BUS_HOST; | |
3c514387 | 101 | input->dev.parent = &pdev->dev; |
bebb8a2b | 102 | |
3c514387 YY |
103 | input->keycode = bdev->keymap; |
104 | input->keycodemax = ARRAY_SIZE(bdev->keymap); | |
b037b08e DT |
105 | input->keycodesize = sizeof(unsigned short); |
106 | ||
107 | input_set_capability(input, EV_MSC, MSC_SCAN); | |
108 | __set_bit(EV_KEY, input->evbit); | |
3c514387 YY |
109 | for (i = 0; i < ARRAY_SIZE(cobalt_map); i++) |
110 | __set_bit(bdev->keymap[i], input->keybit); | |
b037b08e | 111 | __clear_bit(KEY_RESERVED, input->keybit); |
bebb8a2b YY |
112 | |
113 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
114 | if (!res) { | |
115 | error = -EBUSY; | |
116 | goto err_free_mem; | |
117 | } | |
118 | ||
3d29cdff | 119 | bdev->poll_dev = poll_dev; |
72398e4b | 120 | bdev->reg = ioremap(res->start, resource_size(res)); |
bebb8a2b YY |
121 | dev_set_drvdata(&pdev->dev, bdev); |
122 | ||
3d29cdff | 123 | error = input_register_polled_device(poll_dev); |
bebb8a2b YY |
124 | if (error) |
125 | goto err_iounmap; | |
126 | ||
127 | return 0; | |
128 | ||
129 | err_iounmap: | |
130 | iounmap(bdev->reg); | |
131 | err_free_mem: | |
3d29cdff | 132 | input_free_polled_device(poll_dev); |
bebb8a2b YY |
133 | kfree(bdev); |
134 | dev_set_drvdata(&pdev->dev, NULL); | |
135 | return error; | |
136 | } | |
137 | ||
e2619cf7 | 138 | static int cobalt_buttons_remove(struct platform_device *pdev) |
bebb8a2b YY |
139 | { |
140 | struct device *dev = &pdev->dev; | |
141 | struct buttons_dev *bdev = dev_get_drvdata(dev); | |
142 | ||
3d29cdff DT |
143 | input_unregister_polled_device(bdev->poll_dev); |
144 | input_free_polled_device(bdev->poll_dev); | |
bebb8a2b YY |
145 | iounmap(bdev->reg); |
146 | kfree(bdev); | |
147 | dev_set_drvdata(dev, NULL); | |
148 | ||
149 | return 0; | |
150 | } | |
151 | ||
ada8e951 | 152 | MODULE_AUTHOR("Yoichi Yuasa <yuasa@linux-mips.org>"); |
26135ed3 MM |
153 | MODULE_DESCRIPTION("Cobalt button interface driver"); |
154 | MODULE_LICENSE("GPL"); | |
d7b5247b KS |
155 | /* work with hotplug and coldplug */ |
156 | MODULE_ALIAS("platform:Cobalt buttons"); | |
157 | ||
bebb8a2b YY |
158 | static struct platform_driver cobalt_buttons_driver = { |
159 | .probe = cobalt_buttons_probe, | |
1cb0aa88 | 160 | .remove = cobalt_buttons_remove, |
bebb8a2b YY |
161 | .driver = { |
162 | .name = "Cobalt buttons", | |
163 | .owner = THIS_MODULE, | |
164 | }, | |
165 | }; | |
840a746b | 166 | module_platform_driver(cobalt_buttons_driver); |