diff options
120 files changed, 4334 insertions, 3250 deletions
diff --git a/Documentation/input/input-programming.txt b/Documentation/input/input-programming.txt index 180e0689676c..d9d523099bb7 100644 --- a/Documentation/input/input-programming.txt +++ b/Documentation/input/input-programming.txt | |||
@@ -1,5 +1,3 @@ | |||
1 | $Id: input-programming.txt,v 1.4 2001/05/04 09:47:14 vojtech Exp $ | ||
2 | |||
3 | Programming input drivers | 1 | Programming input drivers |
4 | ~~~~~~~~~~~~~~~~~~~~~~~~~ | 2 | ~~~~~~~~~~~~~~~~~~~~~~~~~ |
5 | 3 | ||
@@ -20,28 +18,51 @@ pressed or released a BUTTON_IRQ happens. The driver could look like: | |||
20 | #include <asm/irq.h> | 18 | #include <asm/irq.h> |
21 | #include <asm/io.h> | 19 | #include <asm/io.h> |
22 | 20 | ||
21 | static struct input_dev *button_dev; | ||
22 | |||
23 | static void button_interrupt(int irq, void *dummy, struct pt_regs *fp) | 23 | static void button_interrupt(int irq, void *dummy, struct pt_regs *fp) |
24 | { | 24 | { |
25 | input_report_key(&button_dev, BTN_1, inb(BUTTON_PORT) & 1); | 25 | input_report_key(button_dev, BTN_1, inb(BUTTON_PORT) & 1); |
26 | input_sync(&button_dev); | 26 | input_sync(button_dev); |
27 | } | 27 | } |
28 | 28 | ||
29 | static int __init button_init(void) | 29 | static int __init button_init(void) |
30 | { | 30 | { |
31 | int error; | ||
32 | |||
31 | if (request_irq(BUTTON_IRQ, button_interrupt, 0, "button", NULL)) { | 33 | if (request_irq(BUTTON_IRQ, button_interrupt, 0, "button", NULL)) { |
32 | printk(KERN_ERR "button.c: Can't allocate irq %d\n", button_irq); | 34 | printk(KERN_ERR "button.c: Can't allocate irq %d\n", button_irq); |
33 | return -EBUSY; | 35 | return -EBUSY; |
34 | } | 36 | } |
35 | 37 | ||
36 | button_dev.evbit[0] = BIT(EV_KEY); | 38 | button_dev = input_allocate_device(); |
37 | button_dev.keybit[LONG(BTN_0)] = BIT(BTN_0); | 39 | if (!button_dev) { |
38 | 40 | printk(KERN_ERR "button.c: Not enough memory\n"); | |
39 | input_register_device(&button_dev); | 41 | error = -ENOMEM; |
42 | goto err_free_irq; | ||
43 | } | ||
44 | |||
45 | button_dev->evbit[0] = BIT(EV_KEY); | ||
46 | button_dev->keybit[LONG(BTN_0)] = BIT(BTN_0); | ||
47 | |||
48 | error = input_register_device(button_dev); | ||
49 | if (error) { | ||
50 | printk(KERN_ERR "button.c: Failed to register device\n"); | ||
51 | goto err_free_dev; | ||
52 | } | ||
53 | |||
54 | return 0; | ||
55 | |||
56 | err_free_dev: | ||
57 | input_free_device(button_dev); | ||
58 | err_free_irq: | ||
59 | free_irq(BUTTON_IRQ, button_interrupt); | ||
60 | return error; | ||
40 | } | 61 | } |
41 | 62 | ||
42 | static void __exit button_exit(void) | 63 | static void __exit button_exit(void) |
43 | { | 64 | { |
44 | input_unregister_device(&button_dev); | 65 | input_unregister_device(button_dev); |
45 | free_irq(BUTTON_IRQ, button_interrupt); | 66 | free_irq(BUTTON_IRQ, button_interrupt); |
46 | } | 67 | } |
47 | 68 | ||
@@ -58,17 +79,18 @@ In the _init function, which is called either upon module load or when | |||
58 | booting the kernel, it grabs the required resources (it should also check | 79 | booting the kernel, it grabs the required resources (it should also check |
59 | for the presence of the device). | 80 | for the presence of the device). |
60 | 81 | ||
61 | Then it sets the input bitfields. This way the device driver tells the other | 82 | Then it allocates a new input device structure with input_aloocate_device() |
83 | and sets up input bitfields. This way the device driver tells the other | ||
62 | parts of the input systems what it is - what events can be generated or | 84 | parts of the input systems what it is - what events can be generated or |
63 | accepted by this input device. Our example device can only generate EV_KEY type | 85 | accepted by this input device. Our example device can only generate EV_KEY |
64 | events, and from those only BTN_0 event code. Thus we only set these two | 86 | type events, and from those only BTN_0 event code. Thus we only set these |
65 | bits. We could have used | 87 | two bits. We could have used |
66 | 88 | ||
67 | set_bit(EV_KEY, button_dev.evbit); | 89 | set_bit(EV_KEY, button_dev.evbit); |
68 | set_bit(BTN_0, button_dev.keybit); | 90 | set_bit(BTN_0, button_dev.keybit); |
69 | 91 | ||
70 | as well, but with more than single bits the first approach tends to be | 92 | as well, but with more than single bits the first approach tends to be |
71 | shorter. | 93 | shorter. |
72 | 94 | ||
73 | Then the example driver registers the input device structure by calling | 95 | Then the example driver registers the input device structure by calling |
74 | 96 | ||
@@ -76,16 +98,15 @@ Then the example driver registers the input device structure by calling | |||
76 | 98 | ||
77 | This adds the button_dev structure to linked lists of the input driver and | 99 | This adds the button_dev structure to linked lists of the input driver and |
78 | calls device handler modules _connect functions to tell them a new input | 100 | calls device handler modules _connect functions to tell them a new input |
79 | device has appeared. Because the _connect functions may call kmalloc(, | 101 | device has appeared. input_register_device() may sleep and therefore must |
80 | GFP_KERNEL), which can sleep, input_register_device() must not be called | 102 | not be called from an interrupt or with a spinlock held. |
81 | from an interrupt or with a spinlock held. | ||
82 | 103 | ||
83 | While in use, the only used function of the driver is | 104 | While in use, the only used function of the driver is |
84 | 105 | ||
85 | button_interrupt() | 106 | button_interrupt() |
86 | 107 | ||
87 | which upon every interrupt from the button checks its state and reports it | 108 | which upon every interrupt from the button checks its state and reports it |
88 | via the | 109 | via the |
89 | 110 | ||
90 | input_report_key() | 111 | input_report_key() |
91 | 112 | ||
@@ -113,16 +134,10 @@ can use the open and close callback to know when it can stop polling or | |||
113 | release the interrupt and when it must resume polling or grab the interrupt | 134 | release the interrupt and when it must resume polling or grab the interrupt |
114 | again. To do that, we would add this to our example driver: | 135 | again. To do that, we would add this to our example driver: |
115 | 136 | ||
116 | int button_used = 0; | ||
117 | |||
118 | static int button_open(struct input_dev *dev) | 137 | static int button_open(struct input_dev *dev) |
119 | { | 138 | { |
120 | if (button_used++) | ||
121 | return 0; | ||
122 | |||
123 | if (request_irq(BUTTON_IRQ, button_interrupt, 0, "button", NULL)) { | 139 | if (request_irq(BUTTON_IRQ, button_interrupt, 0, "button", NULL)) { |
124 | printk(KERN_ERR "button.c: Can't allocate irq %d\n", button_irq); | 140 | printk(KERN_ERR "button.c: Can't allocate irq %d\n", button_irq); |
125 | button_used--; | ||
126 | return -EBUSY; | 141 | return -EBUSY; |
127 | } | 142 | } |
128 | 143 | ||
@@ -131,20 +146,21 @@ static int button_open(struct input_dev *dev) | |||
131 | 146 | ||
132 | static void button_close(struct input_dev *dev) | 147 | static void button_close(struct input_dev *dev) |
133 | { | 148 | { |
134 | if (!--button_used) | 149 | free_irq(IRQ_AMIGA_VERTB, button_interrupt); |
135 | free_irq(IRQ_AMIGA_VERTB, button_interrupt); | ||
136 | } | 150 | } |
137 | 151 | ||
138 | static int __init button_init(void) | 152 | static int __init button_init(void) |
139 | { | 153 | { |
140 | ... | 154 | ... |
141 | button_dev.open = button_open; | 155 | button_dev->open = button_open; |
142 | button_dev.close = button_close; | 156 | button_dev->close = button_close; |
143 | ... | 157 | ... |
144 | } | 158 | } |
145 | 159 | ||
146 | Note the button_used variable - we have to track how many times the open | 160 | Note that input core keeps track of number of users for the device and |
147 | function was called to know when exactly our device stops being used. | 161 | makes sure that dev->open() is called only when the first user connects |
162 | to the device and that dev->close() is called when the very last user | ||
163 | disconnects. Calls to both callbacks are serialized. | ||
148 | 164 | ||
149 | The open() callback should return a 0 in case of success or any nonzero value | 165 | The open() callback should return a 0 in case of success or any nonzero value |
150 | in case of failure. The close() callback (which is void) must always succeed. | 166 | in case of failure. The close() callback (which is void) must always succeed. |
@@ -175,7 +191,7 @@ set the corresponding bits and call the | |||
175 | 191 | ||
176 | input_report_rel(struct input_dev *dev, int code, int value) | 192 | input_report_rel(struct input_dev *dev, int code, int value) |
177 | 193 | ||
178 | function. Events are generated only for nonzero value. | 194 | function. Events are generated only for nonzero value. |
179 | 195 | ||
180 | However EV_ABS requires a little special care. Before calling | 196 | However EV_ABS requires a little special care. Before calling |
181 | input_register_device, you have to fill additional fields in the input_dev | 197 | input_register_device, you have to fill additional fields in the input_dev |
@@ -187,6 +203,10 @@ the ABS_X axis: | |||
187 | button_dev.absfuzz[ABS_X] = 4; | 203 | button_dev.absfuzz[ABS_X] = 4; |
188 | button_dev.absflat[ABS_X] = 8; | 204 | button_dev.absflat[ABS_X] = 8; |
189 | 205 | ||
206 | Or, you can just say: | ||
207 | |||
208 | input_set_abs_params(button_dev, ABS_X, 0, 255, 4, 8); | ||
209 | |||
190 | This setting would be appropriate for a joystick X axis, with the minimum of | 210 | This setting would be appropriate for a joystick X axis, with the minimum of |
191 | 0, maximum of 255 (which the joystick *must* be able to reach, no problem if | 211 | 0, maximum of 255 (which the joystick *must* be able to reach, no problem if |
192 | it sometimes reports more, but it must be able to always reach the min and | 212 | it sometimes reports more, but it must be able to always reach the min and |
@@ -197,14 +217,7 @@ If you don't need absfuzz and absflat, you can set them to zero, which mean | |||
197 | that the thing is precise and always returns to exactly the center position | 217 | that the thing is precise and always returns to exactly the center position |
198 | (if it has any). | 218 | (if it has any). |
199 | 219 | ||
200 | 1.4 The void *private field | 220 | 1.4 NBITS(), LONG(), BIT() |
201 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
202 | |||
203 | This field in the input structure can be used to point to any private data | ||
204 | structures in the input device driver, in case the driver handles more than | ||
205 | one device. You'll need it in the open and close callbacks. | ||
206 | |||
207 | 1.5 NBITS(), LONG(), BIT() | ||
208 | ~~~~~~~~~~~~~~~~~~~~~~~~~~ | 221 | ~~~~~~~~~~~~~~~~~~~~~~~~~~ |
209 | 222 | ||
210 | These three macros from input.h help some bitfield computations: | 223 | These three macros from input.h help some bitfield computations: |
@@ -213,13 +226,9 @@ These three macros from input.h help some bitfield computations: | |||
213 | LONG(x) - returns the index in the array in longs for bit x | 226 | LONG(x) - returns the index in the array in longs for bit x |
214 | BIT(x) - returns the index in a long for bit x | 227 | BIT(x) - returns the index in a long for bit x |
215 | 228 | ||
216 | 1.6 The number, id* and name fields | 229 | 1.5 The id* and name fields |
217 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | 230 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
218 | 231 | ||
219 | The dev->number is assigned by the input system to the input device when it | ||
220 | is registered. It has no use except for identifying the device to the user | ||
221 | in system messages. | ||
222 | |||
223 | The dev->name should be set before registering the input device by the input | 232 | The dev->name should be set before registering the input device by the input |
224 | device driver. It's a string like 'Generic button device' containing a | 233 | device driver. It's a string like 'Generic button device' containing a |
225 | user friendly name of the device. | 234 | user friendly name of the device. |
@@ -234,15 +243,25 @@ driver. | |||
234 | 243 | ||
235 | The id and name fields can be passed to userland via the evdev interface. | 244 | The id and name fields can be passed to userland via the evdev interface. |
236 | 245 | ||
237 | 1.7 The keycode, keycodemax, keycodesize fields | 246 | 1.6 The keycode, keycodemax, keycodesize fields |
238 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | 247 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
239 | 248 | ||
240 | These two fields will be used for any input devices that report their data | 249 | These three fields should be used by input devices that have dense keymaps. |
241 | as scancodes. If not all scancodes can be known by autodetection, they may | 250 | The keycode is an array used to map from scancodes to input system keycodes. |
242 | need to be set by userland utilities. The keycode array then is an array | 251 | The keycode max should contain the size of the array and keycodesize the |
243 | used to map from scancodes to input system keycodes. The keycode max will | 252 | size of each entry in it (in bytes). |
244 | contain the size of the array and keycodesize the size of each entry in it | 253 | |
245 | (in bytes). | 254 | Userspace can query and alter current scancode to keycode mappings using |
255 | EVIOCGKEYCODE and EVIOCSKEYCODE ioctls on corresponding evdev interface. | ||
256 | When a device has all 3 aforementioned fields filled in, the driver may | ||
257 | rely on kernel's default implementation of setting and querying keycode | ||
258 | mappings. | ||
259 | |||
260 | 1.7 dev->getkeycode() and dev->setkeycode() | ||
261 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
262 | getkeycode() and setkeycode() callbacks allow drivers to override default | ||
263 | keycode/keycodesize/keycodemax mapping mechanism provided by input core | ||
264 | and implement sparse keycode maps. | ||
246 | 265 | ||
247 | 1.8 Key autorepeat | 266 | 1.8 Key autorepeat |
248 | ~~~~~~~~~~~~~~~~~~ | 267 | ~~~~~~~~~~~~~~~~~~ |
@@ -266,7 +285,7 @@ direction - from the system to the input device driver. If your input device | |||
266 | driver can handle these events, it has to set the respective bits in evbit, | 285 | driver can handle these events, it has to set the respective bits in evbit, |
267 | *and* also the callback routine: | 286 | *and* also the callback routine: |
268 | 287 | ||
269 | button_dev.event = button_event; | 288 | button_dev->event = button_event; |
270 | 289 | ||
271 | int button_event(struct input_dev *dev, unsigned int type, unsigned int code, int value); | 290 | int button_event(struct input_dev *dev, unsigned int type, unsigned int code, int value); |
272 | { | 291 | { |
diff --git a/arch/mips/cobalt/Makefile b/arch/mips/cobalt/Makefile index de017c11f9b7..9565b2104dcd 100644 --- a/arch/mips/cobalt/Makefile +++ b/arch/mips/cobalt/Makefile | |||
@@ -2,7 +2,7 @@ | |||
2 | # Makefile for the Cobalt micro systems family specific parts of the kernel | 2 | # Makefile for the Cobalt micro systems family specific parts of the kernel |
3 | # | 3 | # |
4 | 4 | ||
5 | obj-y := irq.o reset.o setup.o | 5 | obj-y := irq.o reset.o setup.o buttons.o |
6 | 6 | ||
7 | obj-$(CONFIG_PCI) += pci.o | 7 | obj-$(CONFIG_PCI) += pci.o |
8 | obj-$(CONFIG_EARLY_PRINTK) += console.o | 8 | obj-$(CONFIG_EARLY_PRINTK) += console.o |
diff --git a/arch/mips/cobalt/buttons.c b/arch/mips/cobalt/buttons.c new file mode 100644 index 000000000000..9e143989c7b8 --- /dev/null +++ b/arch/mips/cobalt/buttons.c | |||
@@ -0,0 +1,54 @@ | |||
1 | /* | ||
2 | * Cobalt buttons platform device. | ||
3 | * | ||
4 | * Copyright (C) 2007 Yoichi Yuasa <yoichi_yuasa@tripeaks.co.jp> | ||
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 | ||
18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA | ||
19 | */ | ||
20 | |||
21 | #include <linux/platform_device.h> | ||
22 | #include <linux/errno.h> | ||
23 | #include <linux/init.h> | ||
24 | |||
25 | static struct resource cobalt_buttons_resource __initdata = { | ||
26 | .start = 0x1d000000, | ||
27 | .end = 0x1d000003, | ||
28 | .flags = IORESOURCE_MEM, | ||
29 | }; | ||
30 | |||
31 | static __init int cobalt_add_buttons(void) | ||
32 | { | ||
33 | struct platform_device *pd; | ||
34 | int error; | ||
35 | |||
36 | pd = platform_device_alloc("Cobalt buttons", -1); | ||
37 | if (!pd) | ||
38 | return -ENOMEM; | ||
39 | |||
40 | error = platform_device_add_resources(pd, &cobalt_buttons_resource, 1); | ||
41 | if (error) | ||
42 | goto err_free_device; | ||
43 | |||
44 | error = platform_device_add(pd); | ||
45 | if (error) | ||
46 | goto err_free_device; | ||
47 | |||
48 | return 0; | ||
49 | |||
50 | err_free_device: | ||
51 | platform_device_put(pd); | ||
52 | return error; | ||
53 | } | ||
54 | device_initcall(cobalt_add_buttons); | ||
diff --git a/drivers/char/keyboard.c b/drivers/char/keyboard.c index cb8d691576da..c06e86ad1dab 100644 --- a/drivers/char/keyboard.c +++ b/drivers/char/keyboard.c | |||
@@ -41,7 +41,6 @@ | |||
41 | #include <linux/input.h> | 41 | #include <linux/input.h> |
42 | #include <linux/reboot.h> | 42 | #include <linux/reboot.h> |
43 | 43 | ||
44 | static void kbd_disconnect(struct input_handle *handle); | ||
45 | extern void ctrl_alt_del(void); | 44 | extern void ctrl_alt_del(void); |
46 | 45 | ||
47 | /* | 46 | /* |
@@ -159,65 +158,41 @@ static int sysrq_alt_use; | |||
159 | static int sysrq_alt; | 158 | static int sysrq_alt; |
160 | 159 | ||
161 | /* | 160 | /* |
162 | * Translation of scancodes to keycodes. We set them on only the first attached | 161 | * Translation of scancodes to keycodes. We set them on only the first |
163 | * keyboard - for per-keyboard setting, /dev/input/event is more useful. | 162 | * keyboard in the list that accepts the scancode and keycode. |
163 | * Explanation for not choosing the first attached keyboard anymore: | ||
164 | * USB keyboards for example have two event devices: one for all "normal" | ||
165 | * keys and one for extra function keys (like "volume up", "make coffee", | ||
166 | * etc.). So this means that scancodes for the extra function keys won't | ||
167 | * be valid for the first event device, but will be for the second. | ||
164 | */ | 168 | */ |
165 | int getkeycode(unsigned int scancode) | 169 | int getkeycode(unsigned int scancode) |
166 | { | 170 | { |
167 | struct list_head *node; | 171 | struct input_handle *handle; |
168 | struct input_dev *dev = NULL; | 172 | int keycode; |
173 | int error = -ENODEV; | ||
169 | 174 | ||
170 | list_for_each(node, &kbd_handler.h_list) { | 175 | list_for_each_entry(handle, &kbd_handler.h_list, h_node) { |
171 | struct input_handle *handle = to_handle_h(node); | 176 | error = handle->dev->getkeycode(handle->dev, scancode, &keycode); |
172 | if (handle->dev->keycodesize) { | 177 | if (!error) |
173 | dev = handle->dev; | 178 | return keycode; |
174 | break; | ||
175 | } | ||
176 | } | 179 | } |
177 | 180 | ||
178 | if (!dev) | 181 | return error; |
179 | return -ENODEV; | ||
180 | |||
181 | if (scancode >= dev->keycodemax) | ||
182 | return -EINVAL; | ||
183 | |||
184 | return INPUT_KEYCODE(dev, scancode); | ||
185 | } | 182 | } |
186 | 183 | ||
187 | int setkeycode(unsigned int scancode, unsigned int keycode) | 184 | int setkeycode(unsigned int scancode, unsigned int keycode) |
188 | { | 185 | { |
189 | struct list_head *node; | 186 | struct input_handle *handle; |
190 | struct input_dev *dev = NULL; | 187 | int error = -ENODEV; |
191 | unsigned int i, oldkey; | ||
192 | 188 | ||
193 | list_for_each(node, &kbd_handler.h_list) { | 189 | list_for_each_entry(handle, &kbd_handler.h_list, h_node) { |
194 | struct input_handle *handle = to_handle_h(node); | 190 | error = handle->dev->setkeycode(handle->dev, scancode, keycode); |
195 | if (handle->dev->keycodesize) { | 191 | if (!error) |
196 | dev = handle->dev; | ||
197 | break; | 192 | break; |
198 | } | ||
199 | } | 193 | } |
200 | 194 | ||
201 | if (!dev) | 195 | return error; |
202 | return -ENODEV; | ||
203 | |||
204 | if (scancode >= dev->keycodemax) | ||
205 | return -EINVAL; | ||
206 | if (keycode < 0 || keycode > KEY_MAX) | ||
207 | return -EINVAL; | ||
208 | if (dev->keycodesize < sizeof(keycode) && (keycode >> (dev->keycodesize * 8))) | ||
209 | return -EINVAL; | ||
210 | |||
211 | oldkey = SET_INPUT_KEYCODE(dev, scancode, keycode); | ||
212 | |||
213 | clear_bit(oldkey, dev->keybit); | ||
214 | set_bit(keycode, dev->keybit); | ||
215 | |||
216 | for (i = 0; i < dev->keycodemax; i++) | ||
217 | if (INPUT_KEYCODE(dev,i) == oldkey) | ||
218 | set_bit(oldkey, dev->keybit); | ||
219 | |||
220 | return 0; | ||
221 | } | 196 | } |
222 | 197 | ||
223 | /* | 198 | /* |
@@ -225,10 +200,9 @@ int setkeycode(unsigned int scancode, unsigned int keycode) | |||
225 | */ | 200 | */ |
226 | static void kd_nosound(unsigned long ignored) | 201 | static void kd_nosound(unsigned long ignored) |
227 | { | 202 | { |
228 | struct list_head *node; | 203 | struct input_handle *handle; |
229 | 204 | ||
230 | list_for_each(node, &kbd_handler.h_list) { | 205 | list_for_each_entry(handle, &kbd_handler.h_list, h_node) { |
231 | struct input_handle *handle = to_handle_h(node); | ||
232 | if (test_bit(EV_SND, handle->dev->evbit)) { | 206 | if (test_bit(EV_SND, handle->dev->evbit)) { |
233 | if (test_bit(SND_TONE, handle->dev->sndbit)) | 207 | if (test_bit(SND_TONE, handle->dev->sndbit)) |
234 | input_inject_event(handle, EV_SND, SND_TONE, 0); | 208 | input_inject_event(handle, EV_SND, SND_TONE, 0); |
@@ -1161,7 +1135,7 @@ static void kbd_keycode(unsigned int keycode, int down, int hw_raw) | |||
1161 | 1135 | ||
1162 | if ((raw_mode = (kbd->kbdmode == VC_RAW)) && !hw_raw) | 1136 | if ((raw_mode = (kbd->kbdmode == VC_RAW)) && !hw_raw) |
1163 | if (emulate_raw(vc, keycode, !down << 7)) | 1137 | if (emulate_raw(vc, keycode, !down << 7)) |
1164 | if (keycode < BTN_MISC) | 1138 | if (keycode < BTN_MISC && printk_ratelimit()) |
1165 | printk(KERN_WARNING "keyboard.c: can't emulate rawmode for keycode %d\n", keycode); | 1139 | printk(KERN_WARNING "keyboard.c: can't emulate rawmode for keycode %d\n", keycode); |
1166 | 1140 | ||
1167 | #ifdef CONFIG_MAGIC_SYSRQ /* Handle the SysRq Hack */ | 1141 | #ifdef CONFIG_MAGIC_SYSRQ /* Handle the SysRq Hack */ |
@@ -1285,11 +1259,11 @@ static void kbd_event(struct input_handle *handle, unsigned int event_type, | |||
1285 | * likes it, it can open it and get events from it. In this (kbd_connect) | 1259 | * likes it, it can open it and get events from it. In this (kbd_connect) |
1286 | * function, we should decide which VT to bind that keyboard to initially. | 1260 | * function, we should decide which VT to bind that keyboard to initially. |
1287 | */ | 1261 | */ |
1288 | static struct input_handle *kbd_connect(struct input_handler *handler, | 1262 | static int kbd_connect(struct input_handler *handler, struct input_dev *dev, |
1289 | struct input_dev *dev, | 1263 | const struct input_device_id *id) |
1290 | const struct input_device_id *id) | ||
1291 | { | 1264 | { |
1292 | struct input_handle *handle; | 1265 | struct input_handle *handle; |
1266 | int error; | ||
1293 | int i; | 1267 | int i; |
1294 | 1268 | ||
1295 | for (i = KEY_RESERVED; i < BTN_MISC; i++) | 1269 | for (i = KEY_RESERVED; i < BTN_MISC; i++) |
@@ -1297,24 +1271,37 @@ static struct input_handle *kbd_connect(struct input_handler *handler, | |||
1297 | break; | 1271 | break; |
1298 | 1272 | ||
1299 | if (i == BTN_MISC && !test_bit(EV_SND, dev->evbit)) | 1273 | if (i == BTN_MISC && !test_bit(EV_SND, dev->evbit)) |
1300 | return NULL; | 1274 | return -ENODEV; |
1301 | 1275 | ||
1302 | handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL); | 1276 | handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL); |
1303 | if (!handle) | 1277 | if (!handle) |
1304 | return NULL; | 1278 | return -ENOMEM; |
1305 | 1279 | ||
1306 | handle->dev = dev; | 1280 | handle->dev = dev; |
1307 | handle->handler = handler; | 1281 | handle->handler = handler; |
1308 | handle->name = "kbd"; | 1282 | handle->name = "kbd"; |
1309 | 1283 | ||
1310 | input_open_device(handle); | 1284 | error = input_register_handle(handle); |
1285 | if (error) | ||
1286 | goto err_free_handle; | ||
1287 | |||
1288 | error = input_open_device(handle); | ||
1289 | if (error) | ||
1290 | goto err_unregister_handle; | ||
1291 | |||
1292 | return 0; | ||
1311 | 1293 | ||
1312 | return handle; | 1294 | err_unregister_handle: |
1295 | input_unregister_handle(handle); | ||
1296 | err_free_handle: | ||
1297 | kfree(handle); | ||
1298 | return error; | ||
1313 | } | 1299 | } |
1314 | 1300 | ||
1315 | static void kbd_disconnect(struct input_handle *handle) | 1301 | static void kbd_disconnect(struct input_handle *handle) |
1316 | { | 1302 | { |
1317 | input_close_device(handle); | 1303 | input_close_device(handle); |
1304 | input_unregister_handle(handle); | ||
1318 | kfree(handle); | 1305 | kfree(handle); |
1319 | } | 1306 | } |
1320 | 1307 | ||
diff --git a/drivers/input/Makefile b/drivers/input/Makefile index da575deb3c7a..b4cd10653c4f 100644 --- a/drivers/input/Makefile +++ b/drivers/input/Makefile | |||
@@ -13,7 +13,6 @@ obj-$(CONFIG_INPUT_MOUSEDEV) += mousedev.o | |||
13 | obj-$(CONFIG_INPUT_JOYDEV) += joydev.o | 13 | obj-$(CONFIG_INPUT_JOYDEV) += joydev.o |
14 | obj-$(CONFIG_INPUT_EVDEV) += evdev.o | 14 | obj-$(CONFIG_INPUT_EVDEV) += evdev.o |
15 | obj-$(CONFIG_INPUT_TSDEV) += tsdev.o | 15 | obj-$(CONFIG_INPUT_TSDEV) += tsdev.o |
16 | obj-$(CONFIG_INPUT_POWER) += power.o | ||
17 | obj-$(CONFIG_INPUT_EVBUG) += evbug.o | 16 | obj-$(CONFIG_INPUT_EVBUG) += evbug.o |
18 | 17 | ||
19 | obj-$(CONFIG_INPUT_KEYBOARD) += keyboard/ | 18 | obj-$(CONFIG_INPUT_KEYBOARD) += keyboard/ |
diff --git a/drivers/input/evbug.c b/drivers/input/evbug.c index 5a9653c3128a..c21f2f127234 100644 --- a/drivers/input/evbug.c +++ b/drivers/input/evbug.c | |||
@@ -38,31 +38,43 @@ MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); | |||
38 | MODULE_DESCRIPTION("Input driver event debug module"); | 38 | MODULE_DESCRIPTION("Input driver event debug module"); |
39 | MODULE_LICENSE("GPL"); | 39 | MODULE_LICENSE("GPL"); |
40 | 40 | ||
41 | static char evbug_name[] = "evbug"; | ||
42 | |||
43 | static void evbug_event(struct input_handle *handle, unsigned int type, unsigned int code, int value) | 41 | static void evbug_event(struct input_handle *handle, unsigned int type, unsigned int code, int value) |
44 | { | 42 | { |
45 | printk(KERN_DEBUG "evbug.c: Event. Dev: %s, Type: %d, Code: %d, Value: %d\n", | 43 | printk(KERN_DEBUG "evbug.c: Event. Dev: %s, Type: %d, Code: %d, Value: %d\n", |
46 | handle->dev->phys, type, code, value); | 44 | handle->dev->phys, type, code, value); |
47 | } | 45 | } |
48 | 46 | ||
49 | static struct input_handle *evbug_connect(struct input_handler *handler, struct input_dev *dev, | 47 | static int evbug_connect(struct input_handler *handler, struct input_dev *dev, |
50 | const struct input_device_id *id) | 48 | const struct input_device_id *id) |
51 | { | 49 | { |
52 | struct input_handle *handle; | 50 | struct input_handle *handle; |
51 | int error; | ||
53 | 52 | ||
54 | if (!(handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL))) | 53 | handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL); |
55 | return NULL; | 54 | if (!handle) |
55 | return -ENOMEM; | ||
56 | 56 | ||
57 | handle->dev = dev; | 57 | handle->dev = dev; |
58 | handle->handler = handler; | 58 | handle->handler = handler; |
59 | handle->name = evbug_name; | 59 | handle->name = "evbug"; |
60 | |||
61 | error = input_register_handle(handle); | ||
62 | if (error) | ||
63 | goto err_free_handle; | ||
60 | 64 | ||
61 | input_open_device(handle); | 65 | error = input_open_device(handle); |
66 | if (error) | ||
67 | goto err_unregister_handle; | ||
62 | 68 | ||
63 | printk(KERN_DEBUG "evbug.c: Connected device: \"%s\", %s\n", dev->name, dev->phys); | 69 | printk(KERN_DEBUG "evbug.c: Connected device: \"%s\", %s\n", dev->name, dev->phys); |
64 | 70 | ||
65 | return handle; | 71 | return 0; |
72 | |||
73 | err_unregister_handle: | ||
74 | input_unregister_handle(handle); | ||
75 | err_free_handle: | ||
76 | kfree(handle); | ||
77 | return error; | ||
66 | } | 78 | } |
67 | 79 | ||
68 | static void evbug_disconnect(struct input_handle *handle) | 80 | static void evbug_disconnect(struct input_handle *handle) |
@@ -70,7 +82,7 @@ static void evbug_disconnect(struct input_handle *handle) | |||
70 | printk(KERN_DEBUG "evbug.c: Disconnected device: %s\n", handle->dev->phys); | 82 | printk(KERN_DEBUG "evbug.c: Disconnected device: %s\n", handle->dev->phys); |
71 | 83 | ||
72 | input_close_device(handle); | 84 | input_close_device(handle); |
73 | 85 | input_unregister_handle(handle); | |
74 | kfree(handle); | 86 | kfree(handle); |
75 | } | 87 | } |
76 | 88 | ||
diff --git a/drivers/input/evdev.c b/drivers/input/evdev.c index 6e55b2c5874e..1f6fcec0c6fc 100644 --- a/drivers/input/evdev.c +++ b/drivers/input/evdev.c | |||
@@ -29,11 +29,11 @@ struct evdev { | |||
29 | char name[16]; | 29 | char name[16]; |
30 | struct input_handle handle; | 30 | struct input_handle handle; |
31 | wait_queue_head_t wait; | 31 | wait_queue_head_t wait; |
32 | struct evdev_list *grab; | 32 | struct evdev_client *grab; |
33 | struct list_head list; | 33 | struct list_head client_list; |
34 | }; | 34 | }; |
35 | 35 | ||
36 | struct evdev_list { | 36 | struct evdev_client { |
37 | struct input_event buffer[EVDEV_BUFFER_SIZE]; | 37 | struct input_event buffer[EVDEV_BUFFER_SIZE]; |
38 | int head; | 38 | int head; |
39 | int tail; | 39 | int tail; |
@@ -47,28 +47,28 @@ static struct evdev *evdev_table[EVDEV_MINORS]; | |||
47 | static void evdev_event(struct input_handle *handle, unsigned int type, unsigned int code, int value) | 47 | static void evdev_event(struct input_handle *handle, unsigned int type, unsigned int code, int value) |
48 | { | 48 | { |
49 | struct evdev *evdev = handle->private; | 49 | struct evdev *evdev = handle->private; |
50 | struct evdev_list *list; | 50 | struct evdev_client *client; |
51 | 51 | ||
52 | if (evdev->grab) { | 52 | if (evdev->grab) { |
53 | list = evdev->grab; | 53 | client = evdev->grab; |
54 | 54 | ||
55 | do_gettimeofday(&list->buffer[list->head].time); | 55 | do_gettimeofday(&client->buffer[client->head].time); |
56 | list->buffer[list->head].type = type; | 56 | client->buffer[client->head].type = type; |
57 | list->buffer[list->head].code = code; | 57 | client->buffer[client->head].code = code; |
58 | list->buffer[list->head].value = value; | 58 | client->buffer[client->head].value = value; |
59 | list->head = (list->head + 1) & (EVDEV_BUFFER_SIZE - 1); | 59 | client->head = (client->head + 1) & (EVDEV_BUFFER_SIZE - 1); |
60 | 60 | ||
61 | kill_fasync(&list->fasync, SIGIO, POLL_IN); | 61 | kill_fasync(&client->fasync, SIGIO, POLL_IN); |
62 | } else | 62 | } else |
63 | list_for_each_entry(list, &evdev->list, node) { | 63 | list_for_each_entry(client, &evdev->client_list, node) { |
64 | 64 | ||
65 | do_gettimeofday(&list->buffer[list->head].time); | 65 | do_gettimeofday(&client->buffer[client->head].time); |
66 | list->buffer[list->head].type = type; | 66 | client->buffer[client->head].type = type; |
67 | list->buffer[list->head].code = code; | 67 | client->buffer[client->head].code = code; |
68 | list->buffer[list->head].value = value; | 68 | client->buffer[client->head].value = value; |
69 | list->head = (list->head + 1) & (EVDEV_BUFFER_SIZE - 1); | 69 | client->head = (client->head + 1) & (EVDEV_BUFFER_SIZE - 1); |
70 | 70 | ||
71 | kill_fasync(&list->fasync, SIGIO, POLL_IN); | 71 | kill_fasync(&client->fasync, SIGIO, POLL_IN); |
72 | } | 72 | } |
73 | 73 | ||
74 | wake_up_interruptible(&evdev->wait); | 74 | wake_up_interruptible(&evdev->wait); |
@@ -76,22 +76,23 @@ static void evdev_event(struct input_handle *handle, unsigned int type, unsigned | |||
76 | 76 | ||
77 | static int evdev_fasync(int fd, struct file *file, int on) | 77 | static int evdev_fasync(int fd, struct file *file, int on) |
78 | { | 78 | { |
79 | struct evdev_client *client = file->private_data; | ||
79 | int retval; | 80 | int retval; |
80 | struct evdev_list *list = file->private_data; | ||
81 | 81 | ||
82 | retval = fasync_helper(fd, file, on, &list->fasync); | 82 | retval = fasync_helper(fd, file, on, &client->fasync); |
83 | 83 | ||
84 | return retval < 0 ? retval : 0; | 84 | return retval < 0 ? retval : 0; |
85 | } | 85 | } |
86 | 86 | ||
87 | static int evdev_flush(struct file *file, fl_owner_t id) | 87 | static int evdev_flush(struct file *file, fl_owner_t id) |
88 | { | 88 | { |
89 | struct evdev_list *list = file->private_data; | 89 | struct evdev_client *client = file->private_data; |
90 | struct evdev *evdev = client->evdev; | ||
90 | 91 | ||
91 | if (!list->evdev->exist) | 92 | if (!evdev->exist) |
92 | return -ENODEV; | 93 | return -ENODEV; |
93 | 94 | ||
94 | return input_flush_device(&list->evdev->handle, file); | 95 | return input_flush_device(&evdev->handle, file); |
95 | } | 96 | } |
96 | 97 | ||
97 | static void evdev_free(struct evdev *evdev) | 98 | static void evdev_free(struct evdev *evdev) |
@@ -100,48 +101,62 @@ static void evdev_free(struct evdev *evdev) | |||
100 | kfree(evdev); | 101 | kfree(evdev); |
101 | } | 102 | } |
102 | 103 | ||
103 | static int evdev_release(struct inode * inode, struct file * file) | 104 | static int evdev_release(struct inode *inode, struct file *file) |
104 | { | 105 | { |
105 | struct evdev_list *list = file->private_data; | 106 | struct evdev_client *client = file->private_data; |
107 | struct evdev *evdev = client->evdev; | ||
106 | 108 | ||
107 | if (list->evdev->grab == list) { | 109 | if (evdev->grab == client) { |
108 | input_release_device(&list->evdev->handle); | 110 | input_release_device(&evdev->handle); |
109 | list->evdev->grab = NULL; | 111 | evdev->grab = NULL; |
110 | } | 112 | } |
111 | 113 | ||
112 | evdev_fasync(-1, file, 0); | 114 | evdev_fasync(-1, file, 0); |
113 | list_del(&list->node); | 115 | list_del(&client->node); |
116 | kfree(client); | ||
114 | 117 | ||
115 | if (!--list->evdev->open) { | 118 | if (!--evdev->open) { |
116 | if (list->evdev->exist) | 119 | if (evdev->exist) |
117 | input_close_device(&list->evdev->handle); | 120 | input_close_device(&evdev->handle); |
118 | else | 121 | else |
119 | evdev_free(list->evdev); | 122 | evdev_free(evdev); |
120 | } | 123 | } |
121 | 124 | ||
122 | kfree(list); | ||
123 | return 0; | 125 | return 0; |
124 | } | 126 | } |
125 | 127 | ||
126 | static int evdev_open(struct inode * inode, struct file * file) | 128 | static int evdev_open(struct inode *inode, struct file *file) |
127 | { | 129 | { |
128 | struct evdev_list *list; | 130 | struct evdev_client *client; |
131 | struct evdev *evdev; | ||
129 | int i = iminor(inode) - EVDEV_MINOR_BASE; | 132 | int i = iminor(inode) - EVDEV_MINOR_BASE; |
133 | int error; | ||
130 | 134 | ||
131 | if (i >= EVDEV_MINORS || !evdev_table[i] || !evdev_table[i]->exist) | 135 | if (i >= EVDEV_MINORS) |
132 | return -ENODEV; | 136 | return -ENODEV; |
133 | 137 | ||
134 | if (!(list = kzalloc(sizeof(struct evdev_list), GFP_KERNEL))) | 138 | evdev = evdev_table[i]; |
139 | |||
140 | if (!evdev || !evdev->exist) | ||
141 | return -ENODEV; | ||
142 | |||
143 | client = kzalloc(sizeof(struct evdev_client), GFP_KERNEL); | ||
144 | if (!client) | ||
135 | return -ENOMEM; | 145 | return -ENOMEM; |
136 | 146 | ||
137 | list->evdev = evdev_table[i]; | 147 | client->evdev = evdev; |
138 | list_add_tail(&list->node, &evdev_table[i]->list); | 148 | list_add_tail(&client->node, &evdev->client_list); |
139 | file->private_data = list; | ||
140 | 149 | ||
141 | if (!list->evdev->open++) | 150 | if (!evdev->open++ && evdev->exist) { |
142 | if (list->evdev->exist) | 151 | error = input_open_device(&evdev->handle); |
143 | input_open_device(&list->evdev->handle); | 152 | if (error) { |
153 | list_del(&client->node); | ||
154 | kfree(client); | ||
155 | return error; | ||
156 | } | ||
157 | } | ||
144 | 158 | ||
159 | file->private_data = client; | ||
145 | return 0; | 160 | return 0; |
146 | } | 161 | } |
147 | 162 | ||
@@ -243,54 +258,55 @@ static int evdev_event_to_user(char __user *buffer, const struct input_event *ev | |||
243 | 258 | ||
244 | #endif /* CONFIG_COMPAT */ | 259 | #endif /* CONFIG_COMPAT */ |
245 | 260 | ||
246 | static ssize_t evdev_write(struct file * file, const char __user * buffer, size_t count, loff_t *ppos) | 261 | static ssize_t evdev_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos) |
247 | { | 262 | { |
248 | struct evdev_list *list = file->private_data; | 263 | struct evdev_client *client = file->private_data; |
264 | struct evdev *evdev = client->evdev; | ||
249 | struct input_event event; | 265 | struct input_event event; |
250 | int retval = 0; | 266 | int retval = 0; |
251 | 267 | ||
252 | if (!list->evdev->exist) | 268 | if (!evdev->exist) |
253 | return -ENODEV; | 269 | return -ENODEV; |
254 | 270 | ||
255 | while (retval < count) { | 271 | while (retval < count) { |
256 | 272 | ||
257 | if (evdev_event_from_user(buffer + retval, &event)) | 273 | if (evdev_event_from_user(buffer + retval, &event)) |
258 | return -EFAULT; | 274 | return -EFAULT; |
259 | input_inject_event(&list->evdev->handle, event.type, event.code, event.value); | 275 | input_inject_event(&evdev->handle, event.type, event.code, event.value); |
260 | retval += evdev_event_size(); | 276 | retval += evdev_event_size(); |
261 | } | 277 | } |
262 | 278 | ||
263 | return retval; | 279 | return retval; |
264 | } | 280 | } |
265 | 281 | ||
266 | static ssize_t evdev_read(struct file * file, char __user * buffer, size_t count, loff_t *ppos) | 282 | static ssize_t evdev_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos) |
267 | { | 283 | { |
268 | struct evdev_list *list = file->private_data; | 284 | struct evdev_client *client = file->private_data; |
285 | struct evdev *evdev = client->evdev; | ||
269 | int retval; | 286 | int retval; |
270 | 287 | ||
271 | if (count < evdev_event_size()) | 288 | if (count < evdev_event_size()) |
272 | return -EINVAL; | 289 | return -EINVAL; |
273 | 290 | ||
274 | if (list->head == list->tail && list->evdev->exist && (file->f_flags & O_NONBLOCK)) | 291 | if (client->head == client->tail && evdev->exist && (file->f_flags & O_NONBLOCK)) |
275 | return -EAGAIN; | 292 | return -EAGAIN; |
276 | 293 | ||
277 | retval = wait_event_interruptible(list->evdev->wait, | 294 | retval = wait_event_interruptible(evdev->wait, |
278 | list->head != list->tail || (!list->evdev->exist)); | 295 | client->head != client->tail || !evdev->exist); |
279 | |||
280 | if (retval) | 296 | if (retval) |
281 | return retval; | 297 | return retval; |
282 | 298 | ||
283 | if (!list->evdev->exist) | 299 | if (!evdev->exist) |
284 | return -ENODEV; | 300 | return -ENODEV; |
285 | 301 | ||
286 | while (list->head != list->tail && retval + evdev_event_size() <= count) { | 302 | while (client->head != client->tail && retval + evdev_event_size() <= count) { |
287 | 303 | ||
288 | struct input_event *event = (struct input_event *) list->buffer + list->tail; | 304 | struct input_event *event = (struct input_event *) client->buffer + client->tail; |
289 | 305 | ||
290 | if (evdev_event_to_user(buffer + retval, event)) | 306 | if (evdev_event_to_user(buffer + retval, event)) |
291 | return -EFAULT; | 307 | return -EFAULT; |
292 | 308 | ||
293 | list->tail = (list->tail + 1) & (EVDEV_BUFFER_SIZE - 1); | 309 | client->tail = (client->tail + 1) & (EVDEV_BUFFER_SIZE - 1); |
294 | retval += evdev_event_size(); | 310 | retval += evdev_event_size(); |
295 | } | 311 | } |
296 | 312 | ||
@@ -300,11 +316,12 @@ static ssize_t evdev_read(struct file * file, char __user * buffer, size_t count | |||
300 | /* No kernel lock - fine */ | 316 | /* No kernel lock - fine */ |
301 | static unsigned int evdev_poll(struct file *file, poll_table *wait) | 317 | static unsigned int evdev_poll(struct file *file, poll_table *wait) |
302 | { | 318 | { |
303 | struct evdev_list *list = file->private_data; | 319 | struct evdev_client *client = file->private_data; |
320 | struct evdev *evdev = client->evdev; | ||
304 | 321 | ||
305 | poll_wait(file, &list->evdev->wait, wait); | 322 | poll_wait(file, &evdev->wait, wait); |
306 | return ((list->head == list->tail) ? 0 : (POLLIN | POLLRDNORM)) | | 323 | return ((client->head == client->tail) ? 0 : (POLLIN | POLLRDNORM)) | |
307 | (list->evdev->exist ? 0 : (POLLHUP | POLLERR)); | 324 | (evdev->exist ? 0 : (POLLHUP | POLLERR)); |
308 | } | 325 | } |
309 | 326 | ||
310 | #ifdef CONFIG_COMPAT | 327 | #ifdef CONFIG_COMPAT |
@@ -387,8 +404,8 @@ static int str_to_user(const char *str, unsigned int maxlen, void __user *p) | |||
387 | static long evdev_ioctl_handler(struct file *file, unsigned int cmd, | 404 | static long evdev_ioctl_handler(struct file *file, unsigned int cmd, |
388 | void __user *p, int compat_mode) | 405 | void __user *p, int compat_mode) |
389 | { | 406 | { |
390 | struct evdev_list *list = file->private_data; | 407 | struct evdev_client *client = file->private_data; |
391 | struct evdev *evdev = list->evdev; | 408 | struct evdev *evdev = client->evdev; |
392 | struct input_dev *dev = evdev->handle.dev; | 409 | struct input_dev *dev = evdev->handle.dev; |
393 | struct input_absinfo abs; | 410 | struct input_absinfo abs; |
394 | struct ff_effect effect; | 411 | struct ff_effect effect; |
@@ -434,32 +451,21 @@ static long evdev_ioctl_handler(struct file *file, unsigned int cmd, | |||
434 | case EVIOCGKEYCODE: | 451 | case EVIOCGKEYCODE: |
435 | if (get_user(t, ip)) | 452 | if (get_user(t, ip)) |
436 | return -EFAULT; | 453 | return -EFAULT; |
437 | if (t < 0 || t >= dev->keycodemax || !dev->keycodesize) | 454 | |
438 | return -EINVAL; | 455 | error = dev->getkeycode(dev, t, &v); |
439 | if (put_user(INPUT_KEYCODE(dev, t), ip + 1)) | 456 | if (error) |
457 | return error; | ||
458 | |||
459 | if (put_user(v, ip + 1)) | ||
440 | return -EFAULT; | 460 | return -EFAULT; |
461 | |||
441 | return 0; | 462 | return 0; |
442 | 463 | ||
443 | case EVIOCSKEYCODE: | 464 | case EVIOCSKEYCODE: |
444 | if (get_user(t, ip)) | 465 | if (get_user(t, ip) || get_user(v, ip + 1)) |
445 | return -EFAULT; | 466 | return -EFAULT; |
446 | if (t < 0 || t >= dev->keycodemax || !dev->keycodesize) | ||
447 | return -EINVAL; | ||
448 | if (get_user(v, ip + 1)) | ||
449 | return -EFAULT; | ||
450 | if (v < 0 || v > KEY_MAX) | ||
451 | return -EINVAL; | ||
452 | if (dev->keycodesize < sizeof(v) && (v >> (dev->keycodesize * 8))) | ||
453 | return -EINVAL; | ||
454 | 467 | ||
455 | u = SET_INPUT_KEYCODE(dev, t, v); | 468 | return dev->setkeycode(dev, t, v); |
456 | clear_bit(u, dev->keybit); | ||
457 | set_bit(v, dev->keybit); | ||
458 | for (i = 0; i < dev->keycodemax; i++) | ||
459 | if (INPUT_KEYCODE(dev, i) == u) | ||
460 | set_bit(u, dev->keybit); | ||
461 | |||
462 | return 0; | ||
463 | 469 | ||
464 | case EVIOCSFF: | 470 | case EVIOCSFF: |
465 | if (copy_from_user(&effect, p, sizeof(effect))) | 471 | if (copy_from_user(&effect, p, sizeof(effect))) |
@@ -487,10 +493,10 @@ static long evdev_ioctl_handler(struct file *file, unsigned int cmd, | |||
487 | return -EBUSY; | 493 | return -EBUSY; |
488 | if (input_grab_device(&evdev->handle)) | 494 | if (input_grab_device(&evdev->handle)) |
489 | return -EBUSY; | 495 | return -EBUSY; |
490 | evdev->grab = list; | 496 | evdev->grab = client; |
491 | return 0; | 497 | return 0; |
492 | } else { | 498 | } else { |
493 | if (evdev->grab != list) | 499 | if (evdev->grab != client) |
494 | return -EINVAL; | 500 | return -EINVAL; |
495 | input_release_device(&evdev->handle); | 501 | input_release_device(&evdev->handle); |
496 | evdev->grab = NULL; | 502 | evdev->grab = NULL; |
@@ -616,23 +622,26 @@ static const struct file_operations evdev_fops = { | |||
616 | .flush = evdev_flush | 622 | .flush = evdev_flush |
617 | }; | 623 | }; |
618 | 624 | ||
619 | static struct input_handle *evdev_connect(struct input_handler *handler, struct input_dev *dev, | 625 | static int evdev_connect(struct input_handler *handler, struct input_dev *dev, |
620 | const struct input_device_id *id) | 626 | const struct input_device_id *id) |
621 | { | 627 | { |
622 | struct evdev *evdev; | 628 | struct evdev *evdev; |
623 | struct class_device *cdev; | 629 | struct class_device *cdev; |
630 | dev_t devt; | ||
624 | int minor; | 631 | int minor; |
632 | int error; | ||
625 | 633 | ||
626 | for (minor = 0; minor < EVDEV_MINORS && evdev_table[minor]; minor++); | 634 | for (minor = 0; minor < EVDEV_MINORS && evdev_table[minor]; minor++); |
627 | if (minor == EVDEV_MINORS) { | 635 | if (minor == EVDEV_MINORS) { |
628 | printk(KERN_ERR "evdev: no more free evdev devices\n"); | 636 | printk(KERN_ERR "evdev: no more free evdev devices\n"); |
629 | return NULL; | 637 | return -ENFILE; |
630 | } | 638 | } |
631 | 639 | ||
632 | if (!(evdev = kzalloc(sizeof(struct evdev), GFP_KERNEL))) | 640 | evdev = kzalloc(sizeof(struct evdev), GFP_KERNEL); |
633 | return NULL; | 641 | if (!evdev) |
642 | return -ENOMEM; | ||
634 | 643 | ||
635 | INIT_LIST_HEAD(&evdev->list); | 644 | INIT_LIST_HEAD(&evdev->client_list); |
636 | init_waitqueue_head(&evdev->wait); | 645 | init_waitqueue_head(&evdev->wait); |
637 | 646 | ||
638 | evdev->exist = 1; | 647 | evdev->exist = 1; |
@@ -645,21 +654,43 @@ static struct input_handle *evdev_connect(struct input_handler *handler, struct | |||
645 | 654 | ||
646 | evdev_table[minor] = evdev; | 655 | evdev_table[minor] = evdev; |
647 | 656 | ||
648 | cdev = class_device_create(&input_class, &dev->cdev, | 657 | devt = MKDEV(INPUT_MAJOR, EVDEV_MINOR_BASE + minor), |
649 | MKDEV(INPUT_MAJOR, EVDEV_MINOR_BASE + minor), | 658 | |
650 | dev->cdev.dev, evdev->name); | 659 | cdev = class_device_create(&input_class, &dev->cdev, devt, |
660 | dev->cdev.dev, evdev->name); | ||
661 | if (IS_ERR(cdev)) { | ||
662 | error = PTR_ERR(cdev); | ||
663 | goto err_free_evdev; | ||
664 | } | ||
651 | 665 | ||
652 | /* temporary symlink to keep userspace happy */ | 666 | /* temporary symlink to keep userspace happy */ |
653 | sysfs_create_link(&input_class.subsys.kobj, &cdev->kobj, | 667 | error = sysfs_create_link(&input_class.subsys.kobj, |
654 | evdev->name); | 668 | &cdev->kobj, evdev->name); |
669 | if (error) | ||
670 | goto err_cdev_destroy; | ||
671 | |||
672 | error = input_register_handle(&evdev->handle); | ||
673 | if (error) | ||
674 | goto err_remove_link; | ||
675 | |||
676 | return 0; | ||
655 | 677 | ||
656 | return &evdev->handle; | 678 | err_remove_link: |
679 | sysfs_remove_link(&input_class.subsys.kobj, evdev->name); | ||
680 | err_cdev_destroy: | ||
681 | class_device_destroy(&input_class, devt); | ||
682 | err_free_evdev: | ||
683 | kfree(evdev); | ||
684 | evdev_table[minor] = NULL; | ||
685 | return error; | ||
657 | } | 686 | } |
658 | 687 | ||
659 | static void evdev_disconnect(struct input_handle *handle) | 688 | static void evdev_disconnect(struct input_handle *handle) |
660 | { | 689 | { |
661 | struct evdev *evdev = handle->private; | 690 | struct evdev *evdev = handle->private; |
662 | struct evdev_list *list; | 691 | struct evdev_client *client; |
692 | |||
693 | input_unregister_handle(handle); | ||
663 | 694 | ||
664 | sysfs_remove_link(&input_class.subsys.kobj, evdev->name); | 695 | sysfs_remove_link(&input_class.subsys.kobj, evdev->name); |
665 | class_device_destroy(&input_class, | 696 | class_device_destroy(&input_class, |
@@ -670,8 +701,8 @@ static void evdev_disconnect(struct input_handle *handle) | |||
670 | input_flush_device(handle, NULL); | 701 | input_flush_device(handle, NULL); |
671 | input_close_device(handle); | 702 | input_close_device(handle); |
672 | wake_up_interruptible(&evdev->wait); | 703 | wake_up_interruptible(&evdev->wait); |
673 | list_for_each_entry(list, &evdev->list, node) | 704 | list_for_each_entry(client, &evdev->client_list, node) |
674 | kill_fasync(&list->fasync, SIGIO, POLL_HUP); | 705 | kill_fasync(&client->fasync, SIGIO, POLL_HUP); |
675 | } else | 706 | } else |
676 | evdev_free(evdev); | 707 | evdev_free(evdev); |
677 | } | 708 | } |
diff --git a/drivers/input/input.c b/drivers/input/input.c index a9a706f8fff9..915e9ab7cab0 100644 --- a/drivers/input/input.c +++ b/drivers/input/input.c | |||
@@ -299,12 +299,87 @@ void input_close_device(struct input_handle *handle) | |||
299 | } | 299 | } |
300 | EXPORT_SYMBOL(input_close_device); | 300 | EXPORT_SYMBOL(input_close_device); |
301 | 301 | ||
302 | static void input_link_handle(struct input_handle *handle) | 302 | static int input_fetch_keycode(struct input_dev *dev, int scancode) |
303 | { | 303 | { |
304 | list_add_tail(&handle->d_node, &handle->dev->h_list); | 304 | switch (dev->keycodesize) { |
305 | list_add_tail(&handle->h_node, &handle->handler->h_list); | 305 | case 1: |
306 | return ((u8 *)dev->keycode)[scancode]; | ||
307 | |||
308 | case 2: | ||
309 | return ((u16 *)dev->keycode)[scancode]; | ||
310 | |||
311 | default: | ||
312 | return ((u32 *)dev->keycode)[scancode]; | ||
313 | } | ||
314 | } | ||
315 | |||
316 | static int input_default_getkeycode(struct input_dev *dev, | ||
317 | int scancode, int *keycode) | ||
318 | { | ||
319 | if (!dev->keycodesize) | ||
320 | return -EINVAL; | ||
321 | |||
322 | if (scancode < 0 || scancode >= dev->keycodemax) | ||
323 | return -EINVAL; | ||
324 | |||
325 | *keycode = input_fetch_keycode(dev, scancode); | ||
326 | |||
327 | return 0; | ||
328 | } | ||
329 | |||
330 | static int input_default_setkeycode(struct input_dev *dev, | ||
331 | int scancode, int keycode) | ||
332 | { | ||
333 | int old_keycode; | ||
334 | int i; | ||
335 | |||
336 | if (scancode < 0 || scancode >= dev->keycodemax) | ||
337 | return -EINVAL; | ||
338 | |||
339 | if (keycode < 0 || keycode > KEY_MAX) | ||
340 | return -EINVAL; | ||
341 | |||
342 | if (!dev->keycodesize) | ||
343 | return -EINVAL; | ||
344 | |||
345 | if (dev->keycodesize < sizeof(keycode) && (keycode >> (dev->keycodesize * 8))) | ||
346 | return -EINVAL; | ||
347 | |||
348 | switch (dev->keycodesize) { | ||
349 | case 1: { | ||
350 | u8 *k = (u8 *)dev->keycode; | ||
351 | old_keycode = k[scancode]; | ||
352 | k[scancode] = keycode; | ||
353 | break; | ||
354 | } | ||
355 | case 2: { | ||
356 | u16 *k = (u16 *)dev->keycode; | ||
357 | old_keycode = k[scancode]; | ||
358 | k[scancode] = keycode; | ||
359 | break; | ||
360 | } | ||
361 | default: { | ||
362 | u32 *k = (u32 *)dev->keycode; | ||
363 | old_keycode = k[scancode]; | ||
364 | k[scancode] = keycode; | ||
365 | break; | ||
366 | } | ||
367 | } | ||
368 | |||
369 | clear_bit(old_keycode, dev->keybit); | ||
370 | set_bit(keycode, dev->keybit); | ||
371 | |||
372 | for (i = 0; i < dev->keycodemax; i++) { | ||
373 | if (input_fetch_keycode(dev, i) == old_keycode) { | ||
374 | set_bit(old_keycode, dev->keybit); | ||
375 | break; /* Setting the bit twice is useless, so break */ | ||
376 | } | ||
377 | } | ||
378 | |||
379 | return 0; | ||
306 | } | 380 | } |
307 | 381 | ||
382 | |||
308 | #define MATCH_BIT(bit, max) \ | 383 | #define MATCH_BIT(bit, max) \ |
309 | for (i = 0; i < NBITS(max); i++) \ | 384 | for (i = 0; i < NBITS(max); i++) \ |
310 | if ((id->bit[i] & dev->bit[i]) != id->bit[i]) \ | 385 | if ((id->bit[i] & dev->bit[i]) != id->bit[i]) \ |
@@ -351,6 +426,29 @@ static const struct input_device_id *input_match_device(const struct input_devic | |||
351 | return NULL; | 426 | return NULL; |
352 | } | 427 | } |
353 | 428 | ||
429 | static int input_attach_handler(struct input_dev *dev, struct input_handler *handler) | ||
430 | { | ||
431 | const struct input_device_id *id; | ||
432 | int error; | ||
433 | |||
434 | if (handler->blacklist && input_match_device(handler->blacklist, dev)) | ||
435 | return -ENODEV; | ||
436 | |||
437 | id = input_match_device(handler->id_table, dev); | ||
438 | if (!id) | ||
439 | return -ENODEV; | ||
440 | |||
441 | error = handler->connect(handler, dev, id); | ||
442 | if (error && error != -ENODEV) | ||
443 | printk(KERN_ERR | ||
444 | "input: failed to attach handler %s to device %s, " | ||
445 | "error: %d\n", | ||
446 | handler->name, kobject_name(&dev->cdev.kobj), error); | ||
447 | |||
448 | return error; | ||
449 | } | ||
450 | |||
451 | |||
354 | #ifdef CONFIG_PROC_FS | 452 | #ifdef CONFIG_PROC_FS |
355 | 453 | ||
356 | static struct proc_dir_entry *proc_bus_input_dir; | 454 | static struct proc_dir_entry *proc_bus_input_dir; |
@@ -439,6 +537,7 @@ static int input_devices_seq_show(struct seq_file *seq, void *v) | |||
439 | seq_printf(seq, "N: Name=\"%s\"\n", dev->name ? dev->name : ""); | 537 | seq_printf(seq, "N: Name=\"%s\"\n", dev->name ? dev->name : ""); |
440 | seq_printf(seq, "P: Phys=%s\n", dev->phys ? dev->phys : ""); | 538 | seq_printf(seq, "P: Phys=%s\n", dev->phys ? dev->phys : ""); |
441 | seq_printf(seq, "S: Sysfs=%s\n", path ? path : ""); | 539 | seq_printf(seq, "S: Sysfs=%s\n", path ? path : ""); |
540 | seq_printf(seq, "U: Uniq=%s\n", dev->uniq ? dev->uniq : ""); | ||
442 | seq_printf(seq, "H: Handlers="); | 541 | seq_printf(seq, "H: Handlers="); |
443 | 542 | ||
444 | list_for_each_entry(handle, &dev->h_list, d_node) | 543 | list_for_each_entry(handle, &dev->h_list, d_node) |
@@ -753,6 +852,13 @@ static struct attribute_group input_dev_caps_attr_group = { | |||
753 | .attrs = input_dev_caps_attrs, | 852 | .attrs = input_dev_caps_attrs, |
754 | }; | 853 | }; |
755 | 854 | ||
855 | static struct attribute_group *input_dev_attr_groups[] = { | ||
856 | &input_dev_attr_group, | ||
857 | &input_dev_id_attr_group, | ||
858 | &input_dev_caps_attr_group, | ||
859 | NULL | ||
860 | }; | ||
861 | |||
756 | static void input_dev_release(struct class_device *class_dev) | 862 | static void input_dev_release(struct class_device *class_dev) |
757 | { | 863 | { |
758 | struct input_dev *dev = to_input_dev(class_dev); | 864 | struct input_dev *dev = to_input_dev(class_dev); |
@@ -906,6 +1012,7 @@ struct input_dev *input_allocate_device(void) | |||
906 | dev = kzalloc(sizeof(struct input_dev), GFP_KERNEL); | 1012 | dev = kzalloc(sizeof(struct input_dev), GFP_KERNEL); |
907 | if (dev) { | 1013 | if (dev) { |
908 | dev->cdev.class = &input_class; | 1014 | dev->cdev.class = &input_class; |
1015 | dev->cdev.groups = input_dev_attr_groups; | ||
909 | class_device_initialize(&dev->cdev); | 1016 | class_device_initialize(&dev->cdev); |
910 | mutex_init(&dev->mutex); | 1017 | mutex_init(&dev->mutex); |
911 | INIT_LIST_HEAD(&dev->h_list); | 1018 | INIT_LIST_HEAD(&dev->h_list); |
@@ -934,23 +1041,71 @@ EXPORT_SYMBOL(input_allocate_device); | |||
934 | */ | 1041 | */ |
935 | void input_free_device(struct input_dev *dev) | 1042 | void input_free_device(struct input_dev *dev) |
936 | { | 1043 | { |
937 | if (dev) { | 1044 | if (dev) |
938 | |||
939 | mutex_lock(&dev->mutex); | ||
940 | dev->name = dev->phys = dev->uniq = NULL; | ||
941 | mutex_unlock(&dev->mutex); | ||
942 | |||
943 | input_put_device(dev); | 1045 | input_put_device(dev); |
944 | } | ||
945 | } | 1046 | } |
946 | EXPORT_SYMBOL(input_free_device); | 1047 | EXPORT_SYMBOL(input_free_device); |
947 | 1048 | ||
1049 | /** | ||
1050 | * input_set_capability - mark device as capable of a certain event | ||
1051 | * @dev: device that is capable of emitting or accepting event | ||
1052 | * @type: type of the event (EV_KEY, EV_REL, etc...) | ||
1053 | * @code: event code | ||
1054 | * | ||
1055 | * In addition to setting up corresponding bit in appropriate capability | ||
1056 | * bitmap the function also adjusts dev->evbit. | ||
1057 | */ | ||
1058 | void input_set_capability(struct input_dev *dev, unsigned int type, unsigned int code) | ||
1059 | { | ||
1060 | switch (type) { | ||
1061 | case EV_KEY: | ||
1062 | __set_bit(code, dev->keybit); | ||
1063 | break; | ||
1064 | |||
1065 | case EV_REL: | ||
1066 | __set_bit(code, dev->relbit); | ||
1067 | break; | ||
1068 | |||
1069 | case EV_ABS: | ||
1070 | __set_bit(code, dev->absbit); | ||
1071 | break; | ||
1072 | |||
1073 | case EV_MSC: | ||
1074 | __set_bit(code, dev->mscbit); | ||
1075 | break; | ||
1076 | |||
1077 | case EV_SW: | ||
1078 | __set_bit(code, dev->swbit); | ||
1079 | break; | ||
1080 | |||
1081 | case EV_LED: | ||
1082 | __set_bit(code, dev->ledbit); | ||
1083 | break; | ||
1084 | |||
1085 | case EV_SND: | ||
1086 | __set_bit(code, dev->sndbit); | ||
1087 | break; | ||
1088 | |||
1089 | case EV_FF: | ||
1090 | __set_bit(code, dev->ffbit); | ||
1091 | break; | ||
1092 | |||
1093 | default: | ||
1094 | printk(KERN_ERR | ||
1095 | "input_set_capability: unknown type %u (code %u)\n", | ||
1096 | type, code); | ||
1097 | dump_stack(); | ||
1098 | return; | ||
1099 | } | ||
1100 | |||
1101 | __set_bit(type, dev->evbit); | ||
1102 | } | ||
1103 | EXPORT_SYMBOL(input_set_capability); | ||
1104 | |||
948 | int input_register_device(struct input_dev *dev) | 1105 | int input_register_device(struct input_dev *dev) |
949 | { | 1106 | { |
950 | static atomic_t input_no = ATOMIC_INIT(0); | 1107 | static atomic_t input_no = ATOMIC_INIT(0); |
951 | struct input_handle *handle; | ||
952 | struct input_handler *handler; | 1108 | struct input_handler *handler; |
953 | const struct input_device_id *id; | ||
954 | const char *path; | 1109 | const char *path; |
955 | int error; | 1110 | int error; |
956 | 1111 | ||
@@ -969,55 +1124,41 @@ int input_register_device(struct input_dev *dev) | |||
969 | dev->rep[REP_PERIOD] = 33; | 1124 | dev->rep[REP_PERIOD] = 33; |
970 | } | 1125 | } |
971 | 1126 | ||
1127 | if (!dev->getkeycode) | ||
1128 | dev->getkeycode = input_default_getkeycode; | ||
1129 | |||
1130 | if (!dev->setkeycode) | ||
1131 | dev->setkeycode = input_default_setkeycode; | ||
1132 | |||
972 | list_add_tail(&dev->node, &input_dev_list); | 1133 | list_add_tail(&dev->node, &input_dev_list); |
973 | 1134 | ||
974 | snprintf(dev->cdev.class_id, sizeof(dev->cdev.class_id), | 1135 | snprintf(dev->cdev.class_id, sizeof(dev->cdev.class_id), |
975 | "input%ld", (unsigned long) atomic_inc_return(&input_no) - 1); | 1136 | "input%ld", (unsigned long) atomic_inc_return(&input_no) - 1); |
976 | 1137 | ||
1138 | if (!dev->cdev.dev) | ||
1139 | dev->cdev.dev = dev->dev.parent; | ||
1140 | |||
977 | error = class_device_add(&dev->cdev); | 1141 | error = class_device_add(&dev->cdev); |
978 | if (error) | 1142 | if (error) |
979 | return error; | 1143 | return error; |
980 | 1144 | ||
981 | error = sysfs_create_group(&dev->cdev.kobj, &input_dev_attr_group); | ||
982 | if (error) | ||
983 | goto fail1; | ||
984 | |||
985 | error = sysfs_create_group(&dev->cdev.kobj, &input_dev_id_attr_group); | ||
986 | if (error) | ||
987 | goto fail2; | ||
988 | |||
989 | error = sysfs_create_group(&dev->cdev.kobj, &input_dev_caps_attr_group); | ||
990 | if (error) | ||
991 | goto fail3; | ||
992 | |||
993 | path = kobject_get_path(&dev->cdev.kobj, GFP_KERNEL); | 1145 | path = kobject_get_path(&dev->cdev.kobj, GFP_KERNEL); |
994 | printk(KERN_INFO "input: %s as %s\n", | 1146 | printk(KERN_INFO "input: %s as %s\n", |
995 | dev->name ? dev->name : "Unspecified device", path ? path : "N/A"); | 1147 | dev->name ? dev->name : "Unspecified device", path ? path : "N/A"); |
996 | kfree(path); | 1148 | kfree(path); |
997 | 1149 | ||
998 | list_for_each_entry(handler, &input_handler_list, node) | 1150 | list_for_each_entry(handler, &input_handler_list, node) |
999 | if (!handler->blacklist || !input_match_device(handler->blacklist, dev)) | 1151 | input_attach_handler(dev, handler); |
1000 | if ((id = input_match_device(handler->id_table, dev))) | ||
1001 | if ((handle = handler->connect(handler, dev, id))) { | ||
1002 | input_link_handle(handle); | ||
1003 | if (handler->start) | ||
1004 | handler->start(handle); | ||
1005 | } | ||
1006 | 1152 | ||
1007 | input_wakeup_procfs_readers(); | 1153 | input_wakeup_procfs_readers(); |
1008 | 1154 | ||
1009 | return 0; | 1155 | return 0; |
1010 | |||
1011 | fail3: sysfs_remove_group(&dev->cdev.kobj, &input_dev_id_attr_group); | ||
1012 | fail2: sysfs_remove_group(&dev->cdev.kobj, &input_dev_attr_group); | ||
1013 | fail1: class_device_del(&dev->cdev); | ||
1014 | return error; | ||
1015 | } | 1156 | } |
1016 | EXPORT_SYMBOL(input_register_device); | 1157 | EXPORT_SYMBOL(input_register_device); |
1017 | 1158 | ||
1018 | void input_unregister_device(struct input_dev *dev) | 1159 | void input_unregister_device(struct input_dev *dev) |
1019 | { | 1160 | { |
1020 | struct list_head *node, *next; | 1161 | struct input_handle *handle, *next; |
1021 | int code; | 1162 | int code; |
1022 | 1163 | ||
1023 | for (code = 0; code <= KEY_MAX; code++) | 1164 | for (code = 0; code <= KEY_MAX; code++) |
@@ -1027,19 +1168,12 @@ void input_unregister_device(struct input_dev *dev) | |||
1027 | 1168 | ||
1028 | del_timer_sync(&dev->timer); | 1169 | del_timer_sync(&dev->timer); |
1029 | 1170 | ||
1030 | list_for_each_safe(node, next, &dev->h_list) { | 1171 | list_for_each_entry_safe(handle, next, &dev->h_list, d_node) |
1031 | struct input_handle * handle = to_handle(node); | ||
1032 | list_del_init(&handle->d_node); | ||
1033 | list_del_init(&handle->h_node); | ||
1034 | handle->handler->disconnect(handle); | 1172 | handle->handler->disconnect(handle); |
1035 | } | 1173 | WARN_ON(!list_empty(&dev->h_list)); |
1036 | 1174 | ||
1037 | list_del_init(&dev->node); | 1175 | list_del_init(&dev->node); |
1038 | 1176 | ||
1039 | sysfs_remove_group(&dev->cdev.kobj, &input_dev_caps_attr_group); | ||
1040 | sysfs_remove_group(&dev->cdev.kobj, &input_dev_id_attr_group); | ||
1041 | sysfs_remove_group(&dev->cdev.kobj, &input_dev_attr_group); | ||
1042 | |||
1043 | class_device_unregister(&dev->cdev); | 1177 | class_device_unregister(&dev->cdev); |
1044 | 1178 | ||
1045 | input_wakeup_procfs_readers(); | 1179 | input_wakeup_procfs_readers(); |
@@ -1049,8 +1183,6 @@ EXPORT_SYMBOL(input_unregister_device); | |||
1049 | int input_register_handler(struct input_handler *handler) | 1183 | int input_register_handler(struct input_handler *handler) |
1050 | { | 1184 | { |
1051 | struct input_dev *dev; | 1185 | struct input_dev *dev; |
1052 | struct input_handle *handle; | ||
1053 | const struct input_device_id *id; | ||
1054 | 1186 | ||
1055 | INIT_LIST_HEAD(&handler->h_list); | 1187 | INIT_LIST_HEAD(&handler->h_list); |
1056 | 1188 | ||
@@ -1064,13 +1196,7 @@ int input_register_handler(struct input_handler *handler) | |||
1064 | list_add_tail(&handler->node, &input_handler_list); | 1196 | list_add_tail(&handler->node, &input_handler_list); |
1065 | 1197 | ||
1066 | list_for_each_entry(dev, &input_dev_list, node) | 1198 | list_for_each_entry(dev, &input_dev_list, node) |
1067 | if (!handler->blacklist || !input_match_device(handler->blacklist, dev)) | 1199 | input_attach_handler(dev, handler); |
1068 | if ((id = input_match_device(handler->id_table, dev))) | ||
1069 | if ((handle = handler->connect(handler, dev, id))) { | ||
1070 | input_link_handle(handle); | ||
1071 | if (handler->start) | ||
1072 | handler->start(handle); | ||
1073 | } | ||
1074 | 1200 | ||
1075 | input_wakeup_procfs_readers(); | 1201 | input_wakeup_procfs_readers(); |
1076 | return 0; | 1202 | return 0; |
@@ -1079,14 +1205,11 @@ EXPORT_SYMBOL(input_register_handler); | |||
1079 | 1205 | ||
1080 | void input_unregister_handler(struct input_handler *handler) | 1206 | void input_unregister_handler(struct input_handler *handler) |
1081 | { | 1207 | { |
1082 | struct list_head *node, *next; | 1208 | struct input_handle *handle, *next; |
1083 | 1209 | ||
1084 | list_for_each_safe(node, next, &handler->h_list) { | 1210 | list_for_each_entry_safe(handle, next, &handler->h_list, h_node) |
1085 | struct input_handle * handle = to_handle_h(node); | ||
1086 | list_del_init(&handle->h_node); | ||
1087 | list_del_init(&handle->d_node); | ||
1088 | handler->disconnect(handle); | 1211 | handler->disconnect(handle); |
1089 | } | 1212 | WARN_ON(!list_empty(&handler->h_list)); |
1090 | 1213 | ||
1091 | list_del_init(&handler->node); | 1214 | list_del_init(&handler->node); |
1092 | 1215 | ||
@@ -1097,6 +1220,27 @@ void input_unregister_handler(struct input_handler *handler) | |||
1097 | } | 1220 | } |
1098 | EXPORT_SYMBOL(input_unregister_handler); | 1221 | EXPORT_SYMBOL(input_unregister_handler); |
1099 | 1222 | ||
1223 | int input_register_handle(struct input_handle *handle) | ||
1224 | { | ||
1225 | struct input_handler *handler = handle->handler; | ||
1226 | |||
1227 | list_add_tail(&handle->d_node, &handle->dev->h_list); | ||
1228 | list_add_tail(&handle->h_node, &handler->h_list); | ||
1229 | |||
1230 | if (handler->start) | ||
1231 | handler->start(handle); | ||
1232 | |||
1233 | return 0; | ||
1234 | } | ||
1235 | EXPORT_SYMBOL(input_register_handle); | ||
1236 | |||
1237 | void input_unregister_handle(struct input_handle *handle) | ||
1238 | { | ||
1239 | list_del_init(&handle->h_node); | ||
1240 | list_del_init(&handle->d_node); | ||
1241 | } | ||
1242 | EXPORT_SYMBOL(input_unregister_handle); | ||
1243 | |||
1100 | static int input_open_file(struct inode *inode, struct file *file) | 1244 | static int input_open_file(struct inode *inode, struct file *file) |
1101 | { | 1245 | { |
1102 | struct input_handler *handler = input_table[iminor(inode) >> 5]; | 1246 | struct input_handler *handler = input_table[iminor(inode) >> 5]; |
diff --git a/drivers/input/joydev.c b/drivers/input/joydev.c index d2482e4f71be..9bcc5425049b 100644 --- a/drivers/input/joydev.c +++ b/drivers/input/joydev.c | |||
@@ -43,7 +43,7 @@ struct joydev { | |||
43 | char name[16]; | 43 | char name[16]; |
44 | struct input_handle handle; | 44 | struct input_handle handle; |
45 | wait_queue_head_t wait; | 45 | wait_queue_head_t wait; |
46 | struct list_head list; | 46 | struct list_head client_list; |
47 | struct js_corr corr[ABS_MAX + 1]; | 47 | struct js_corr corr[ABS_MAX + 1]; |
48 | struct JS_DATA_SAVE_TYPE glue; | 48 | struct JS_DATA_SAVE_TYPE glue; |
49 | int nabs; | 49 | int nabs; |
@@ -55,7 +55,7 @@ struct joydev { | |||
55 | __s16 abs[ABS_MAX + 1]; | 55 | __s16 abs[ABS_MAX + 1]; |
56 | }; | 56 | }; |
57 | 57 | ||
58 | struct joydev_list { | 58 | struct joydev_client { |
59 | struct js_event buffer[JOYDEV_BUFFER_SIZE]; | 59 | struct js_event buffer[JOYDEV_BUFFER_SIZE]; |
60 | int head; | 60 | int head; |
61 | int tail; | 61 | int tail; |
@@ -87,7 +87,7 @@ static int joydev_correct(int value, struct js_corr *corr) | |||
87 | static void joydev_event(struct input_handle *handle, unsigned int type, unsigned int code, int value) | 87 | static void joydev_event(struct input_handle *handle, unsigned int type, unsigned int code, int value) |
88 | { | 88 | { |
89 | struct joydev *joydev = handle->private; | 89 | struct joydev *joydev = handle->private; |
90 | struct joydev_list *list; | 90 | struct joydev_client *client; |
91 | struct js_event event; | 91 | struct js_event event; |
92 | 92 | ||
93 | switch (type) { | 93 | switch (type) { |
@@ -115,15 +115,15 @@ static void joydev_event(struct input_handle *handle, unsigned int type, unsigne | |||
115 | 115 | ||
116 | event.time = jiffies_to_msecs(jiffies); | 116 | event.time = jiffies_to_msecs(jiffies); |
117 | 117 | ||
118 | list_for_each_entry(list, &joydev->list, node) { | 118 | list_for_each_entry(client, &joydev->client_list, node) { |
119 | 119 | ||
120 | memcpy(list->buffer + list->head, &event, sizeof(struct js_event)); | 120 | memcpy(client->buffer + client->head, &event, sizeof(struct js_event)); |
121 | 121 | ||
122 | if (list->startup == joydev->nabs + joydev->nkey) | 122 | if (client->startup == joydev->nabs + joydev->nkey) |
123 | if (list->tail == (list->head = (list->head + 1) & (JOYDEV_BUFFER_SIZE - 1))) | 123 | if (client->tail == (client->head = (client->head + 1) & (JOYDEV_BUFFER_SIZE - 1))) |
124 | list->startup = 0; | 124 | client->startup = 0; |
125 | 125 | ||
126 | kill_fasync(&list->fasync, SIGIO, POLL_IN); | 126 | kill_fasync(&client->fasync, SIGIO, POLL_IN); |
127 | } | 127 | } |
128 | 128 | ||
129 | wake_up_interruptible(&joydev->wait); | 129 | wake_up_interruptible(&joydev->wait); |
@@ -132,9 +132,9 @@ static void joydev_event(struct input_handle *handle, unsigned int type, unsigne | |||
132 | static int joydev_fasync(int fd, struct file *file, int on) | 132 | static int joydev_fasync(int fd, struct file *file, int on) |
133 | { | 133 | { |
134 | int retval; | 134 | int retval; |
135 | struct joydev_list *list = file->private_data; | 135 | struct joydev_client *client = file->private_data; |
136 | 136 | ||
137 | retval = fasync_helper(fd, file, on, &list->fasync); | 137 | retval = fasync_helper(fd, file, on, &client->fasync); |
138 | 138 | ||
139 | return retval < 0 ? retval : 0; | 139 | return retval < 0 ? retval : 0; |
140 | } | 140 | } |
@@ -145,60 +145,73 @@ static void joydev_free(struct joydev *joydev) | |||
145 | kfree(joydev); | 145 | kfree(joydev); |
146 | } | 146 | } |
147 | 147 | ||
148 | static int joydev_release(struct inode * inode, struct file * file) | 148 | static int joydev_release(struct inode *inode, struct file *file) |
149 | { | 149 | { |
150 | struct joydev_list *list = file->private_data; | 150 | struct joydev_client *client = file->private_data; |
151 | struct joydev *joydev = client->joydev; | ||
151 | 152 | ||
152 | joydev_fasync(-1, file, 0); | 153 | joydev_fasync(-1, file, 0); |
153 | 154 | ||
154 | list_del(&list->node); | 155 | list_del(&client->node); |
156 | kfree(client); | ||
155 | 157 | ||
156 | if (!--list->joydev->open) { | 158 | if (!--joydev->open) { |
157 | if (list->joydev->exist) | 159 | if (joydev->exist) |
158 | input_close_device(&list->joydev->handle); | 160 | input_close_device(&joydev->handle); |
159 | else | 161 | else |
160 | joydev_free(list->joydev); | 162 | joydev_free(joydev); |
161 | } | 163 | } |
162 | 164 | ||
163 | kfree(list); | ||
164 | return 0; | 165 | return 0; |
165 | } | 166 | } |
166 | 167 | ||
167 | static int joydev_open(struct inode *inode, struct file *file) | 168 | static int joydev_open(struct inode *inode, struct file *file) |
168 | { | 169 | { |
169 | struct joydev_list *list; | 170 | struct joydev_client *client; |
171 | struct joydev *joydev; | ||
170 | int i = iminor(inode) - JOYDEV_MINOR_BASE; | 172 | int i = iminor(inode) - JOYDEV_MINOR_BASE; |
173 | int error; | ||
174 | |||
175 | if (i >= JOYDEV_MINORS) | ||
176 | return -ENODEV; | ||
171 | 177 | ||
172 | if (i >= JOYDEV_MINORS || !joydev_table[i]) | 178 | joydev = joydev_table[i]; |
179 | if (!joydev || !joydev->exist) | ||
173 | return -ENODEV; | 180 | return -ENODEV; |
174 | 181 | ||
175 | if (!(list = kzalloc(sizeof(struct joydev_list), GFP_KERNEL))) | 182 | client = kzalloc(sizeof(struct joydev_client), GFP_KERNEL); |
183 | if (!client) | ||
176 | return -ENOMEM; | 184 | return -ENOMEM; |
177 | 185 | ||
178 | list->joydev = joydev_table[i]; | 186 | client->joydev = joydev; |
179 | list_add_tail(&list->node, &joydev_table[i]->list); | 187 | list_add_tail(&client->node, &joydev->client_list); |
180 | file->private_data = list; | ||
181 | 188 | ||
182 | if (!list->joydev->open++) | 189 | if (!joydev->open++ && joydev->exist) { |
183 | if (list->joydev->exist) | 190 | error = input_open_device(&joydev->handle); |
184 | input_open_device(&list->joydev->handle); | 191 | if (error) { |
192 | list_del(&client->node); | ||
193 | kfree(client); | ||
194 | return error; | ||
195 | } | ||
196 | } | ||
185 | 197 | ||
198 | file->private_data = client; | ||
186 | return 0; | 199 | return 0; |
187 | } | 200 | } |
188 | 201 | ||
189 | static ssize_t joydev_write(struct file * file, const char __user * buffer, size_t count, loff_t *ppos) | 202 | static ssize_t joydev_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos) |
190 | { | 203 | { |
191 | return -EINVAL; | 204 | return -EINVAL; |
192 | } | 205 | } |
193 | 206 | ||
194 | static ssize_t joydev_read(struct file *file, char __user *buf, size_t count, loff_t *ppos) | 207 | static ssize_t joydev_read(struct file *file, char __user *buf, size_t count, loff_t *ppos) |
195 | { | 208 | { |
196 | struct joydev_list *list = file->private_data; | 209 | struct joydev_client *client = file->private_data; |
197 | struct joydev *joydev = list->joydev; | 210 | struct joydev *joydev = client->joydev; |
198 | struct input_dev *input = joydev->handle.dev; | 211 | struct input_dev *input = joydev->handle.dev; |
199 | int retval = 0; | 212 | int retval = 0; |
200 | 213 | ||
201 | if (!list->joydev->exist) | 214 | if (!joydev->exist) |
202 | return -ENODEV; | 215 | return -ENODEV; |
203 | 216 | ||
204 | if (count < sizeof(struct js_event)) | 217 | if (count < sizeof(struct js_event)) |
@@ -217,56 +230,55 @@ static ssize_t joydev_read(struct file *file, char __user *buf, size_t count, lo | |||
217 | if (copy_to_user(buf, &data, sizeof(struct JS_DATA_TYPE))) | 230 | if (copy_to_user(buf, &data, sizeof(struct JS_DATA_TYPE))) |
218 | return -EFAULT; | 231 | return -EFAULT; |
219 | 232 | ||
220 | list->startup = 0; | 233 | client->startup = 0; |
221 | list->tail = list->head; | 234 | client->tail = client->head; |
222 | 235 | ||
223 | return sizeof(struct JS_DATA_TYPE); | 236 | return sizeof(struct JS_DATA_TYPE); |
224 | } | 237 | } |
225 | 238 | ||
226 | if (list->startup == joydev->nabs + joydev->nkey && | 239 | if (client->startup == joydev->nabs + joydev->nkey && |
227 | list->head == list->tail && (file->f_flags & O_NONBLOCK)) | 240 | client->head == client->tail && (file->f_flags & O_NONBLOCK)) |
228 | return -EAGAIN; | 241 | return -EAGAIN; |
229 | 242 | ||
230 | retval = wait_event_interruptible(list->joydev->wait, | 243 | retval = wait_event_interruptible(joydev->wait, |
231 | !list->joydev->exist || | 244 | !joydev->exist || |
232 | list->startup < joydev->nabs + joydev->nkey || | 245 | client->startup < joydev->nabs + joydev->nkey || |
233 | list->head != list->tail); | 246 | client->head != client->tail); |
234 | |||
235 | if (retval) | 247 | if (retval) |
236 | return retval; | 248 | return retval; |
237 | 249 | ||
238 | if (!list->joydev->exist) | 250 | if (!joydev->exist) |
239 | return -ENODEV; | 251 | return -ENODEV; |
240 | 252 | ||
241 | while (list->startup < joydev->nabs + joydev->nkey && retval + sizeof(struct js_event) <= count) { | 253 | while (client->startup < joydev->nabs + joydev->nkey && retval + sizeof(struct js_event) <= count) { |
242 | 254 | ||
243 | struct js_event event; | 255 | struct js_event event; |
244 | 256 | ||
245 | event.time = jiffies_to_msecs(jiffies); | 257 | event.time = jiffies_to_msecs(jiffies); |
246 | 258 | ||
247 | if (list->startup < joydev->nkey) { | 259 | if (client->startup < joydev->nkey) { |
248 | event.type = JS_EVENT_BUTTON | JS_EVENT_INIT; | 260 | event.type = JS_EVENT_BUTTON | JS_EVENT_INIT; |
249 | event.number = list->startup; | 261 | event.number = client->startup; |
250 | event.value = !!test_bit(joydev->keypam[event.number], input->key); | 262 | event.value = !!test_bit(joydev->keypam[event.number], input->key); |
251 | } else { | 263 | } else { |
252 | event.type = JS_EVENT_AXIS | JS_EVENT_INIT; | 264 | event.type = JS_EVENT_AXIS | JS_EVENT_INIT; |
253 | event.number = list->startup - joydev->nkey; | 265 | event.number = client->startup - joydev->nkey; |
254 | event.value = joydev->abs[event.number]; | 266 | event.value = joydev->abs[event.number]; |
255 | } | 267 | } |
256 | 268 | ||
257 | if (copy_to_user(buf + retval, &event, sizeof(struct js_event))) | 269 | if (copy_to_user(buf + retval, &event, sizeof(struct js_event))) |
258 | return -EFAULT; | 270 | return -EFAULT; |
259 | 271 | ||
260 | list->startup++; | 272 | client->startup++; |
261 | retval += sizeof(struct js_event); | 273 | retval += sizeof(struct js_event); |
262 | } | 274 | } |
263 | 275 | ||
264 | while (list->head != list->tail && retval + sizeof(struct js_event) <= count) { | 276 | while (client->head != client->tail && retval + sizeof(struct js_event) <= count) { |
265 | 277 | ||
266 | if (copy_to_user(buf + retval, list->buffer + list->tail, sizeof(struct js_event))) | 278 | if (copy_to_user(buf + retval, client->buffer + client->tail, sizeof(struct js_event))) |
267 | return -EFAULT; | 279 | return -EFAULT; |
268 | 280 | ||
269 | list->tail = (list->tail + 1) & (JOYDEV_BUFFER_SIZE - 1); | 281 | client->tail = (client->tail + 1) & (JOYDEV_BUFFER_SIZE - 1); |
270 | retval += sizeof(struct js_event); | 282 | retval += sizeof(struct js_event); |
271 | } | 283 | } |
272 | 284 | ||
@@ -276,11 +288,12 @@ static ssize_t joydev_read(struct file *file, char __user *buf, size_t count, lo | |||
276 | /* No kernel lock - fine */ | 288 | /* No kernel lock - fine */ |
277 | static unsigned int joydev_poll(struct file *file, poll_table *wait) | 289 | static unsigned int joydev_poll(struct file *file, poll_table *wait) |
278 | { | 290 | { |
279 | struct joydev_list *list = file->private_data; | 291 | struct joydev_client *client = file->private_data; |
292 | struct joydev *joydev = client->joydev; | ||
280 | 293 | ||
281 | poll_wait(file, &list->joydev->wait, wait); | 294 | poll_wait(file, &joydev->wait, wait); |
282 | return ((list->head != list->tail || list->startup < list->joydev->nabs + list->joydev->nkey) ? | 295 | return ((client->head != client->tail || client->startup < joydev->nabs + joydev->nkey) ? |
283 | (POLLIN | POLLRDNORM) : 0) | (list->joydev->exist ? 0 : (POLLHUP | POLLERR)); | 296 | (POLLIN | POLLRDNORM) : 0) | (joydev->exist ? 0 : (POLLHUP | POLLERR)); |
284 | } | 297 | } |
285 | 298 | ||
286 | static int joydev_ioctl_common(struct joydev *joydev, unsigned int cmd, void __user *argp) | 299 | static int joydev_ioctl_common(struct joydev *joydev, unsigned int cmd, void __user *argp) |
@@ -374,8 +387,8 @@ static int joydev_ioctl_common(struct joydev *joydev, unsigned int cmd, void __u | |||
374 | #ifdef CONFIG_COMPAT | 387 | #ifdef CONFIG_COMPAT |
375 | static long joydev_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg) | 388 | static long joydev_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg) |
376 | { | 389 | { |
377 | struct joydev_list *list = file->private_data; | 390 | struct joydev_client *client = file->private_data; |
378 | struct joydev *joydev = list->joydev; | 391 | struct joydev *joydev = client->joydev; |
379 | void __user *argp = (void __user *)arg; | 392 | void __user *argp = (void __user *)arg; |
380 | s32 tmp32; | 393 | s32 tmp32; |
381 | struct JS_DATA_SAVE_TYPE_32 ds32; | 394 | struct JS_DATA_SAVE_TYPE_32 ds32; |
@@ -428,8 +441,8 @@ static long joydev_compat_ioctl(struct file *file, unsigned int cmd, unsigned lo | |||
428 | 441 | ||
429 | static int joydev_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) | 442 | static int joydev_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) |
430 | { | 443 | { |
431 | struct joydev_list *list = file->private_data; | 444 | struct joydev_client *client = file->private_data; |
432 | struct joydev *joydev = list->joydev; | 445 | struct joydev *joydev = client->joydev; |
433 | void __user *argp = (void __user *)arg; | 446 | void __user *argp = (void __user *)arg; |
434 | 447 | ||
435 | if (!joydev->exist) | 448 | if (!joydev->exist) |
@@ -465,23 +478,26 @@ static const struct file_operations joydev_fops = { | |||
465 | .fasync = joydev_fasync, | 478 | .fasync = joydev_fasync, |
466 | }; | 479 | }; |
467 | 480 | ||
468 | static struct input_handle *joydev_connect(struct input_handler *handler, struct input_dev *dev, | 481 | static int joydev_connect(struct input_handler *handler, struct input_dev *dev, |
469 | const struct input_device_id *id) | 482 | const struct input_device_id *id) |
470 | { | 483 | { |
471 | struct joydev *joydev; | 484 | struct joydev *joydev; |
472 | struct class_device *cdev; | 485 | struct class_device *cdev; |
486 | dev_t devt; | ||
473 | int i, j, t, minor; | 487 | int i, j, t, minor; |
488 | int error; | ||
474 | 489 | ||
475 | for (minor = 0; minor < JOYDEV_MINORS && joydev_table[minor]; minor++); | 490 | for (minor = 0; minor < JOYDEV_MINORS && joydev_table[minor]; minor++); |
476 | if (minor == JOYDEV_MINORS) { | 491 | if (minor == JOYDEV_MINORS) { |
477 | printk(KERN_ERR "joydev: no more free joydev devices\n"); | 492 | printk(KERN_ERR "joydev: no more free joydev devices\n"); |
478 | return NULL; | 493 | return -ENFILE; |
479 | } | 494 | } |
480 | 495 | ||
481 | if (!(joydev = kzalloc(sizeof(struct joydev), GFP_KERNEL))) | 496 | joydev = kzalloc(sizeof(struct joydev), GFP_KERNEL); |
482 | return NULL; | 497 | if (!joydev) |
498 | return -ENOMEM; | ||
483 | 499 | ||
484 | INIT_LIST_HEAD(&joydev->list); | 500 | INIT_LIST_HEAD(&joydev->client_list); |
485 | init_waitqueue_head(&joydev->wait); | 501 | init_waitqueue_head(&joydev->wait); |
486 | 502 | ||
487 | joydev->minor = minor; | 503 | joydev->minor = minor; |
@@ -534,21 +550,44 @@ static struct input_handle *joydev_connect(struct input_handler *handler, struct | |||
534 | 550 | ||
535 | joydev_table[minor] = joydev; | 551 | joydev_table[minor] = joydev; |
536 | 552 | ||
537 | cdev = class_device_create(&input_class, &dev->cdev, | 553 | devt = MKDEV(INPUT_MAJOR, JOYDEV_MINOR_BASE + minor), |
538 | MKDEV(INPUT_MAJOR, JOYDEV_MINOR_BASE + minor), | 554 | |
539 | dev->cdev.dev, joydev->name); | 555 | cdev = class_device_create(&input_class, &dev->cdev, devt, |
556 | dev->cdev.dev, joydev->name); | ||
557 | if (IS_ERR(cdev)) { | ||
558 | error = PTR_ERR(cdev); | ||
559 | goto err_free_joydev; | ||
560 | } | ||
540 | 561 | ||
541 | /* temporary symlink to keep userspace happy */ | 562 | /* temporary symlink to keep userspace happy */ |
542 | sysfs_create_link(&input_class.subsys.kobj, &cdev->kobj, | 563 | error = sysfs_create_link(&input_class.subsys.kobj, |
543 | joydev->name); | 564 | &cdev->kobj, joydev->name); |
565 | if (error) | ||
566 | goto err_cdev_destroy; | ||
567 | |||
568 | error = input_register_handle(&joydev->handle); | ||
569 | if (error) | ||
570 | goto err_remove_link; | ||
571 | |||
572 | return 0; | ||
544 | 573 | ||
545 | return &joydev->handle; | 574 | err_remove_link: |
575 | sysfs_remove_link(&input_class.subsys.kobj, joydev->name); | ||
576 | err_cdev_destroy: | ||
577 | class_device_destroy(&input_class, devt); | ||
578 | err_free_joydev: | ||
579 | joydev_table[minor] = NULL; | ||
580 | kfree(joydev); | ||
581 | return error; | ||
546 | } | 582 | } |
547 | 583 | ||
584 | |||
548 | static void joydev_disconnect(struct input_handle *handle) | 585 | static void joydev_disconnect(struct input_handle *handle) |
549 | { | 586 | { |
550 | struct joydev *joydev = handle->private; | 587 | struct joydev *joydev = handle->private; |
551 | struct joydev_list *list; | 588 | struct joydev_client *client; |
589 | |||
590 | input_unregister_handle(handle); | ||
552 | 591 | ||
553 | sysfs_remove_link(&input_class.subsys.kobj, joydev->name); | 592 | sysfs_remove_link(&input_class.subsys.kobj, joydev->name); |
554 | class_device_destroy(&input_class, MKDEV(INPUT_MAJOR, JOYDEV_MINOR_BASE + joydev->minor)); | 593 | class_device_destroy(&input_class, MKDEV(INPUT_MAJOR, JOYDEV_MINOR_BASE + joydev->minor)); |
@@ -557,8 +596,8 @@ static void joydev_disconnect(struct input_handle *handle) | |||
557 | if (joydev->open) { | 596 | if (joydev->open) { |
558 | input_close_device(handle); | 597 | input_close_device(handle); |
559 | wake_up_interruptible(&joydev->wait); | 598 | wake_up_interruptible(&joydev->wait); |
560 | list_for_each_entry(list, &joydev->list, node) | 599 | list_for_each_entry(client, &joydev->client_list, node) |
561 | kill_fasync(&list->fasync, SIGIO, POLL_HUP); | 600 | kill_fasync(&client->fasync, SIGIO, POLL_HUP); |
562 | } else | 601 | } else |
563 | joydev_free(joydev); | 602 | joydev_free(joydev); |
564 | } | 603 | } |
diff --git a/drivers/input/joystick/a3d.c b/drivers/input/joystick/a3d.c index b11a4bbc84c4..ff701ab10d74 100644 --- a/drivers/input/joystick/a3d.c +++ b/drivers/input/joystick/a3d.c | |||
@@ -241,7 +241,7 @@ static void a3d_adc_close(struct gameport *gameport) | |||
241 | 241 | ||
242 | static int a3d_open(struct input_dev *dev) | 242 | static int a3d_open(struct input_dev *dev) |
243 | { | 243 | { |
244 | struct a3d *a3d = dev->private; | 244 | struct a3d *a3d = input_get_drvdata(dev); |
245 | 245 | ||
246 | gameport_start_polling(a3d->gameport); | 246 | gameport_start_polling(a3d->gameport); |
247 | return 0; | 247 | return 0; |
@@ -253,7 +253,7 @@ static int a3d_open(struct input_dev *dev) | |||
253 | 253 | ||
254 | static void a3d_close(struct input_dev *dev) | 254 | static void a3d_close(struct input_dev *dev) |
255 | { | 255 | { |
256 | struct a3d *a3d = dev->private; | 256 | struct a3d *a3d = input_get_drvdata(dev); |
257 | 257 | ||
258 | gameport_stop_polling(a3d->gameport); | 258 | gameport_stop_polling(a3d->gameport); |
259 | } | 259 | } |
@@ -314,11 +314,12 @@ static int a3d_connect(struct gameport *gameport, struct gameport_driver *drv) | |||
314 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_MADCATZ; | 314 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_MADCATZ; |
315 | input_dev->id.product = a3d->mode; | 315 | input_dev->id.product = a3d->mode; |
316 | input_dev->id.version = 0x0100; | 316 | input_dev->id.version = 0x0100; |
317 | input_dev->cdev.dev = &gameport->dev; | 317 | input_dev->dev.parent = &gameport->dev; |
318 | input_dev->private = a3d; | ||
319 | input_dev->open = a3d_open; | 318 | input_dev->open = a3d_open; |
320 | input_dev->close = a3d_close; | 319 | input_dev->close = a3d_close; |
321 | 320 | ||
321 | input_set_drvdata(input_dev, a3d); | ||
322 | |||
322 | if (a3d->mode == A3D_MODE_PXL) { | 323 | if (a3d->mode == A3D_MODE_PXL) { |
323 | 324 | ||
324 | int axes[] = { ABS_X, ABS_Y, ABS_THROTTLE, ABS_RUDDER }; | 325 | int axes[] = { ABS_X, ABS_Y, ABS_THROTTLE, ABS_RUDDER }; |
diff --git a/drivers/input/joystick/adi.c b/drivers/input/joystick/adi.c index 6279ced8a35b..28140c4a110d 100644 --- a/drivers/input/joystick/adi.c +++ b/drivers/input/joystick/adi.c | |||
@@ -290,7 +290,7 @@ static void adi_poll(struct gameport *gameport) | |||
290 | 290 | ||
291 | static int adi_open(struct input_dev *dev) | 291 | static int adi_open(struct input_dev *dev) |
292 | { | 292 | { |
293 | struct adi_port *port = dev->private; | 293 | struct adi_port *port = input_get_drvdata(dev); |
294 | 294 | ||
295 | gameport_start_polling(port->gameport); | 295 | gameport_start_polling(port->gameport); |
296 | return 0; | 296 | return 0; |
@@ -302,7 +302,7 @@ static int adi_open(struct input_dev *dev) | |||
302 | 302 | ||
303 | static void adi_close(struct input_dev *dev) | 303 | static void adi_close(struct input_dev *dev) |
304 | { | 304 | { |
305 | struct adi_port *port = dev->private; | 305 | struct adi_port *port = input_get_drvdata(dev); |
306 | 306 | ||
307 | gameport_stop_polling(port->gameport); | 307 | gameport_stop_polling(port->gameport); |
308 | } | 308 | } |
@@ -424,8 +424,9 @@ static int adi_init_input(struct adi *adi, struct adi_port *port, int half) | |||
424 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_LOGITECH; | 424 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_LOGITECH; |
425 | input_dev->id.product = adi->id; | 425 | input_dev->id.product = adi->id; |
426 | input_dev->id.version = 0x0100; | 426 | input_dev->id.version = 0x0100; |
427 | input_dev->cdev.dev = &port->gameport->dev; | 427 | input_dev->dev.parent = &port->gameport->dev; |
428 | input_dev->private = port; | 428 | |
429 | input_set_drvdata(input_dev, port); | ||
429 | 430 | ||
430 | input_dev->open = adi_open; | 431 | input_dev->open = adi_open; |
431 | input_dev->close = adi_close; | 432 | input_dev->close = adi_close; |
diff --git a/drivers/input/joystick/analog.c b/drivers/input/joystick/analog.c index 51f1e4bfff3e..1c1afb5d4684 100644 --- a/drivers/input/joystick/analog.c +++ b/drivers/input/joystick/analog.c | |||
@@ -343,7 +343,7 @@ static void analog_poll(struct gameport *gameport) | |||
343 | 343 | ||
344 | static int analog_open(struct input_dev *dev) | 344 | static int analog_open(struct input_dev *dev) |
345 | { | 345 | { |
346 | struct analog_port *port = dev->private; | 346 | struct analog_port *port = input_get_drvdata(dev); |
347 | 347 | ||
348 | gameport_start_polling(port->gameport); | 348 | gameport_start_polling(port->gameport); |
349 | return 0; | 349 | return 0; |
@@ -355,7 +355,7 @@ static int analog_open(struct input_dev *dev) | |||
355 | 355 | ||
356 | static void analog_close(struct input_dev *dev) | 356 | static void analog_close(struct input_dev *dev) |
357 | { | 357 | { |
358 | struct analog_port *port = dev->private; | 358 | struct analog_port *port = input_get_drvdata(dev); |
359 | 359 | ||
360 | gameport_stop_polling(port->gameport); | 360 | gameport_stop_polling(port->gameport); |
361 | } | 361 | } |
@@ -449,10 +449,13 @@ static int analog_init_device(struct analog_port *port, struct analog *analog, i | |||
449 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_ANALOG; | 449 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_ANALOG; |
450 | input_dev->id.product = analog->mask >> 4; | 450 | input_dev->id.product = analog->mask >> 4; |
451 | input_dev->id.version = 0x0100; | 451 | input_dev->id.version = 0x0100; |
452 | input_dev->dev.parent = &port->gameport->dev; | ||
453 | |||
454 | input_set_drvdata(input_dev, port); | ||
452 | 455 | ||
453 | input_dev->open = analog_open; | 456 | input_dev->open = analog_open; |
454 | input_dev->close = analog_close; | 457 | input_dev->close = analog_close; |
455 | input_dev->private = port; | 458 | |
456 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 459 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
457 | 460 | ||
458 | for (i = j = 0; i < 4; i++) | 461 | for (i = j = 0; i < 4; i++) |
diff --git a/drivers/input/joystick/cobra.c b/drivers/input/joystick/cobra.c index 034ec39c251d..d3352a849b85 100644 --- a/drivers/input/joystick/cobra.c +++ b/drivers/input/joystick/cobra.c | |||
@@ -142,7 +142,7 @@ static void cobra_poll(struct gameport *gameport) | |||
142 | 142 | ||
143 | static int cobra_open(struct input_dev *dev) | 143 | static int cobra_open(struct input_dev *dev) |
144 | { | 144 | { |
145 | struct cobra *cobra = dev->private; | 145 | struct cobra *cobra = input_get_drvdata(dev); |
146 | 146 | ||
147 | gameport_start_polling(cobra->gameport); | 147 | gameport_start_polling(cobra->gameport); |
148 | return 0; | 148 | return 0; |
@@ -150,7 +150,7 @@ static int cobra_open(struct input_dev *dev) | |||
150 | 150 | ||
151 | static void cobra_close(struct input_dev *dev) | 151 | static void cobra_close(struct input_dev *dev) |
152 | { | 152 | { |
153 | struct cobra *cobra = dev->private; | 153 | struct cobra *cobra = input_get_drvdata(dev); |
154 | 154 | ||
155 | gameport_stop_polling(cobra->gameport); | 155 | gameport_stop_polling(cobra->gameport); |
156 | } | 156 | } |
@@ -211,8 +211,9 @@ static int cobra_connect(struct gameport *gameport, struct gameport_driver *drv) | |||
211 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_CREATIVE; | 211 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_CREATIVE; |
212 | input_dev->id.product = 0x0008; | 212 | input_dev->id.product = 0x0008; |
213 | input_dev->id.version = 0x0100; | 213 | input_dev->id.version = 0x0100; |
214 | input_dev->cdev.dev = &gameport->dev; | 214 | input_dev->dev.parent = &gameport->dev; |
215 | input_dev->private = cobra; | 215 | |
216 | input_set_drvdata(input_dev, cobra); | ||
216 | 217 | ||
217 | input_dev->open = cobra_open; | 218 | input_dev->open = cobra_open; |
218 | input_dev->close = cobra_close; | 219 | input_dev->close = cobra_close; |
diff --git a/drivers/input/joystick/db9.c b/drivers/input/joystick/db9.c index b41bd2eb37dd..c27593bf9978 100644 --- a/drivers/input/joystick/db9.c +++ b/drivers/input/joystick/db9.c | |||
@@ -518,7 +518,7 @@ static void db9_timer(unsigned long private) | |||
518 | 518 | ||
519 | static int db9_open(struct input_dev *dev) | 519 | static int db9_open(struct input_dev *dev) |
520 | { | 520 | { |
521 | struct db9 *db9 = dev->private; | 521 | struct db9 *db9 = input_get_drvdata(dev); |
522 | struct parport *port = db9->pd->port; | 522 | struct parport *port = db9->pd->port; |
523 | int err; | 523 | int err; |
524 | 524 | ||
@@ -542,7 +542,7 @@ static int db9_open(struct input_dev *dev) | |||
542 | 542 | ||
543 | static void db9_close(struct input_dev *dev) | 543 | static void db9_close(struct input_dev *dev) |
544 | { | 544 | { |
545 | struct db9 *db9 = dev->private; | 545 | struct db9 *db9 = input_get_drvdata(dev); |
546 | struct parport *port = db9->pd->port; | 546 | struct parport *port = db9->pd->port; |
547 | 547 | ||
548 | mutex_lock(&db9->mutex); | 548 | mutex_lock(&db9->mutex); |
@@ -625,7 +625,8 @@ static struct db9 __init *db9_probe(int parport, int mode) | |||
625 | input_dev->id.vendor = 0x0002; | 625 | input_dev->id.vendor = 0x0002; |
626 | input_dev->id.product = mode; | 626 | input_dev->id.product = mode; |
627 | input_dev->id.version = 0x0100; | 627 | input_dev->id.version = 0x0100; |
628 | input_dev->private = db9; | 628 | |
629 | input_set_drvdata(input_dev, db9); | ||
629 | 630 | ||
630 | input_dev->open = db9_open; | 631 | input_dev->open = db9_open; |
631 | input_dev->close = db9_close; | 632 | input_dev->close = db9_close; |
diff --git a/drivers/input/joystick/gamecon.c b/drivers/input/joystick/gamecon.c index 711e4b3e9e61..c71b58fe225d 100644 --- a/drivers/input/joystick/gamecon.c +++ b/drivers/input/joystick/gamecon.c | |||
@@ -591,7 +591,7 @@ static void gc_timer(unsigned long private) | |||
591 | 591 | ||
592 | static int gc_open(struct input_dev *dev) | 592 | static int gc_open(struct input_dev *dev) |
593 | { | 593 | { |
594 | struct gc *gc = dev->private; | 594 | struct gc *gc = input_get_drvdata(dev); |
595 | int err; | 595 | int err; |
596 | 596 | ||
597 | err = mutex_lock_interruptible(&gc->mutex); | 597 | err = mutex_lock_interruptible(&gc->mutex); |
@@ -610,7 +610,7 @@ static int gc_open(struct input_dev *dev) | |||
610 | 610 | ||
611 | static void gc_close(struct input_dev *dev) | 611 | static void gc_close(struct input_dev *dev) |
612 | { | 612 | { |
613 | struct gc *gc = dev->private; | 613 | struct gc *gc = input_get_drvdata(dev); |
614 | 614 | ||
615 | mutex_lock(&gc->mutex); | 615 | mutex_lock(&gc->mutex); |
616 | if (!--gc->used) { | 616 | if (!--gc->used) { |
@@ -646,7 +646,8 @@ static int __init gc_setup_pad(struct gc *gc, int idx, int pad_type) | |||
646 | input_dev->id.vendor = 0x0001; | 646 | input_dev->id.vendor = 0x0001; |
647 | input_dev->id.product = pad_type; | 647 | input_dev->id.product = pad_type; |
648 | input_dev->id.version = 0x0100; | 648 | input_dev->id.version = 0x0100; |
649 | input_dev->private = gc; | 649 | |
650 | input_set_drvdata(input_dev, gc); | ||
650 | 651 | ||
651 | input_dev->open = gc_open; | 652 | input_dev->open = gc_open; |
652 | input_dev->close = gc_close; | 653 | input_dev->close = gc_close; |
diff --git a/drivers/input/joystick/gf2k.c b/drivers/input/joystick/gf2k.c index bacbab5d1b6f..d514aebf7554 100644 --- a/drivers/input/joystick/gf2k.c +++ b/drivers/input/joystick/gf2k.c | |||
@@ -220,7 +220,7 @@ static void gf2k_poll(struct gameport *gameport) | |||
220 | 220 | ||
221 | static int gf2k_open(struct input_dev *dev) | 221 | static int gf2k_open(struct input_dev *dev) |
222 | { | 222 | { |
223 | struct gf2k *gf2k = dev->private; | 223 | struct gf2k *gf2k = input_get_drvdata(dev); |
224 | 224 | ||
225 | gameport_start_polling(gf2k->gameport); | 225 | gameport_start_polling(gf2k->gameport); |
226 | return 0; | 226 | return 0; |
@@ -228,7 +228,7 @@ static int gf2k_open(struct input_dev *dev) | |||
228 | 228 | ||
229 | static void gf2k_close(struct input_dev *dev) | 229 | static void gf2k_close(struct input_dev *dev) |
230 | { | 230 | { |
231 | struct gf2k *gf2k = dev->private; | 231 | struct gf2k *gf2k = input_get_drvdata(dev); |
232 | 232 | ||
233 | gameport_stop_polling(gf2k->gameport); | 233 | gameport_stop_polling(gf2k->gameport); |
234 | } | 234 | } |
@@ -308,11 +308,13 @@ static int gf2k_connect(struct gameport *gameport, struct gameport_driver *drv) | |||
308 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_GENIUS; | 308 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_GENIUS; |
309 | input_dev->id.product = gf2k->id; | 309 | input_dev->id.product = gf2k->id; |
310 | input_dev->id.version = 0x0100; | 310 | input_dev->id.version = 0x0100; |
311 | input_dev->cdev.dev = &gameport->dev; | 311 | input_dev->dev.parent = &gameport->dev; |
312 | input_dev->private = gf2k; | 312 | |
313 | input_set_drvdata(input_dev, gf2k); | ||
313 | 314 | ||
314 | input_dev->open = gf2k_open; | 315 | input_dev->open = gf2k_open; |
315 | input_dev->close = gf2k_close; | 316 | input_dev->close = gf2k_close; |
317 | |||
316 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 318 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
317 | 319 | ||
318 | for (i = 0; i < gf2k_axes[gf2k->id]; i++) | 320 | for (i = 0; i < gf2k_axes[gf2k->id]; i++) |
diff --git a/drivers/input/joystick/grip.c b/drivers/input/joystick/grip.c index 17a90c436de8..73eb5ab6f140 100644 --- a/drivers/input/joystick/grip.c +++ b/drivers/input/joystick/grip.c | |||
@@ -285,7 +285,7 @@ static void grip_poll(struct gameport *gameport) | |||
285 | 285 | ||
286 | static int grip_open(struct input_dev *dev) | 286 | static int grip_open(struct input_dev *dev) |
287 | { | 287 | { |
288 | struct grip *grip = dev->private; | 288 | struct grip *grip = input_get_drvdata(dev); |
289 | 289 | ||
290 | gameport_start_polling(grip->gameport); | 290 | gameport_start_polling(grip->gameport); |
291 | return 0; | 291 | return 0; |
@@ -293,7 +293,7 @@ static int grip_open(struct input_dev *dev) | |||
293 | 293 | ||
294 | static void grip_close(struct input_dev *dev) | 294 | static void grip_close(struct input_dev *dev) |
295 | { | 295 | { |
296 | struct grip *grip = dev->private; | 296 | struct grip *grip = input_get_drvdata(dev); |
297 | 297 | ||
298 | gameport_stop_polling(grip->gameport); | 298 | gameport_stop_polling(grip->gameport); |
299 | } | 299 | } |
@@ -363,8 +363,9 @@ static int grip_connect(struct gameport *gameport, struct gameport_driver *drv) | |||
363 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_GRAVIS; | 363 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_GRAVIS; |
364 | input_dev->id.product = grip->mode[i]; | 364 | input_dev->id.product = grip->mode[i]; |
365 | input_dev->id.version = 0x0100; | 365 | input_dev->id.version = 0x0100; |
366 | input_dev->cdev.dev = &gameport->dev; | 366 | input_dev->dev.parent = &gameport->dev; |
367 | input_dev->private = grip; | 367 | |
368 | input_set_drvdata(input_dev, grip); | ||
368 | 369 | ||
369 | input_dev->open = grip_open; | 370 | input_dev->open = grip_open; |
370 | input_dev->close = grip_close; | 371 | input_dev->close = grip_close; |
diff --git a/drivers/input/joystick/grip_mp.c b/drivers/input/joystick/grip_mp.c index 8120a9c40773..555319e6378c 100644 --- a/drivers/input/joystick/grip_mp.c +++ b/drivers/input/joystick/grip_mp.c | |||
@@ -562,7 +562,7 @@ static void grip_poll(struct gameport *gameport) | |||
562 | 562 | ||
563 | static int grip_open(struct input_dev *dev) | 563 | static int grip_open(struct input_dev *dev) |
564 | { | 564 | { |
565 | struct grip_mp *grip = dev->private; | 565 | struct grip_mp *grip = input_get_drvdata(dev); |
566 | 566 | ||
567 | gameport_start_polling(grip->gameport); | 567 | gameport_start_polling(grip->gameport); |
568 | return 0; | 568 | return 0; |
@@ -574,9 +574,9 @@ static int grip_open(struct input_dev *dev) | |||
574 | 574 | ||
575 | static void grip_close(struct input_dev *dev) | 575 | static void grip_close(struct input_dev *dev) |
576 | { | 576 | { |
577 | struct grip_mp *grip = dev->private; | 577 | struct grip_mp *grip = input_get_drvdata(dev); |
578 | 578 | ||
579 | gameport_start_polling(grip->gameport); | 579 | gameport_stop_polling(grip->gameport); |
580 | } | 580 | } |
581 | 581 | ||
582 | /* | 582 | /* |
@@ -599,8 +599,9 @@ static int register_slot(int slot, struct grip_mp *grip) | |||
599 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_GRAVIS; | 599 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_GRAVIS; |
600 | input_dev->id.product = 0x0100 + port->mode; | 600 | input_dev->id.product = 0x0100 + port->mode; |
601 | input_dev->id.version = 0x0100; | 601 | input_dev->id.version = 0x0100; |
602 | input_dev->cdev.dev = &grip->gameport->dev; | 602 | input_dev->dev.parent = &grip->gameport->dev; |
603 | input_dev->private = grip; | 603 | |
604 | input_set_drvdata(input_dev, grip); | ||
604 | 605 | ||
605 | input_dev->open = grip_open; | 606 | input_dev->open = grip_open; |
606 | input_dev->close = grip_close; | 607 | input_dev->close = grip_close; |
diff --git a/drivers/input/joystick/guillemot.c b/drivers/input/joystick/guillemot.c index dbc5d92858b8..d4e8073caf27 100644 --- a/drivers/input/joystick/guillemot.c +++ b/drivers/input/joystick/guillemot.c | |||
@@ -156,7 +156,7 @@ static void guillemot_poll(struct gameport *gameport) | |||
156 | 156 | ||
157 | static int guillemot_open(struct input_dev *dev) | 157 | static int guillemot_open(struct input_dev *dev) |
158 | { | 158 | { |
159 | struct guillemot *guillemot = dev->private; | 159 | struct guillemot *guillemot = input_get_drvdata(dev); |
160 | 160 | ||
161 | gameport_start_polling(guillemot->gameport); | 161 | gameport_start_polling(guillemot->gameport); |
162 | return 0; | 162 | return 0; |
@@ -168,7 +168,7 @@ static int guillemot_open(struct input_dev *dev) | |||
168 | 168 | ||
169 | static void guillemot_close(struct input_dev *dev) | 169 | static void guillemot_close(struct input_dev *dev) |
170 | { | 170 | { |
171 | struct guillemot *guillemot = dev->private; | 171 | struct guillemot *guillemot = input_get_drvdata(dev); |
172 | 172 | ||
173 | gameport_stop_polling(guillemot->gameport); | 173 | gameport_stop_polling(guillemot->gameport); |
174 | } | 174 | } |
@@ -231,8 +231,9 @@ static int guillemot_connect(struct gameport *gameport, struct gameport_driver * | |||
231 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_GUILLEMOT; | 231 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_GUILLEMOT; |
232 | input_dev->id.product = guillemot_type[i].id; | 232 | input_dev->id.product = guillemot_type[i].id; |
233 | input_dev->id.version = (int)data[14] << 8 | data[15]; | 233 | input_dev->id.version = (int)data[14] << 8 | data[15]; |
234 | input_dev->cdev.dev = &gameport->dev; | 234 | input_dev->dev.parent = &gameport->dev; |
235 | input_dev->private = guillemot; | 235 | |
236 | input_set_drvdata(input_dev, guillemot); | ||
236 | 237 | ||
237 | input_dev->open = guillemot_open; | 238 | input_dev->open = guillemot_open; |
238 | input_dev->close = guillemot_close; | 239 | input_dev->close = guillemot_close; |
diff --git a/drivers/input/joystick/iforce/iforce-ff.c b/drivers/input/joystick/iforce/iforce-ff.c index 8fb0c19cc60e..f2a4381d0ab8 100644 --- a/drivers/input/joystick/iforce/iforce-ff.c +++ b/drivers/input/joystick/iforce/iforce-ff.c | |||
@@ -2,7 +2,7 @@ | |||
2 | * $Id: iforce-ff.c,v 1.9 2002/02/02 19:28:35 jdeneux Exp $ | 2 | * $Id: iforce-ff.c,v 1.9 2002/02/02 19:28:35 jdeneux Exp $ |
3 | * | 3 | * |
4 | * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> | 4 | * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> |
5 | * Copyright (c) 2001-2002 Johann Deneux <deneux@ifrance.com> | 5 | * Copyright (c) 2001-2002, 2007 Johann Deneux <johann.deneux@gmail.com> |
6 | * | 6 | * |
7 | * USB/RS232 I-Force joysticks and wheels. | 7 | * USB/RS232 I-Force joysticks and wheels. |
8 | */ | 8 | */ |
@@ -205,7 +205,7 @@ static int need_condition_modifier(struct ff_effect *old, struct ff_effect *new) | |||
205 | int i; | 205 | int i; |
206 | 206 | ||
207 | if (new->type != FF_SPRING && new->type != FF_FRICTION) { | 207 | if (new->type != FF_SPRING && new->type != FF_FRICTION) { |
208 | printk(KERN_WARNING "iforce.c: bad effect type in need_condition_modifier\n"); | 208 | warn("bad effect type in need_condition_modifier"); |
209 | return 0; | 209 | return 0; |
210 | } | 210 | } |
211 | 211 | ||
@@ -227,7 +227,7 @@ static int need_condition_modifier(struct ff_effect *old, struct ff_effect *new) | |||
227 | static int need_magnitude_modifier(struct ff_effect *old, struct ff_effect *effect) | 227 | static int need_magnitude_modifier(struct ff_effect *old, struct ff_effect *effect) |
228 | { | 228 | { |
229 | if (effect->type != FF_CONSTANT) { | 229 | if (effect->type != FF_CONSTANT) { |
230 | printk(KERN_WARNING "iforce.c: bad effect type in need_envelope_modifier\n"); | 230 | warn("bad effect type in need_envelope_modifier"); |
231 | return 0; | 231 | return 0; |
232 | } | 232 | } |
233 | 233 | ||
@@ -258,7 +258,7 @@ static int need_envelope_modifier(struct ff_effect *old, struct ff_effect *effec | |||
258 | break; | 258 | break; |
259 | 259 | ||
260 | default: | 260 | default: |
261 | printk(KERN_WARNING "iforce.c: bad effect type in need_envelope_modifier\n"); | 261 | warn("bad effect type in need_envelope_modifier"); |
262 | } | 262 | } |
263 | 263 | ||
264 | return 0; | 264 | return 0; |
@@ -271,7 +271,7 @@ static int need_envelope_modifier(struct ff_effect *old, struct ff_effect *effec | |||
271 | static int need_period_modifier(struct ff_effect *old, struct ff_effect *new) | 271 | static int need_period_modifier(struct ff_effect *old, struct ff_effect *new) |
272 | { | 272 | { |
273 | if (new->type != FF_PERIODIC) { | 273 | if (new->type != FF_PERIODIC) { |
274 | printk(KERN_WARNING "iforce.c: bad effect type in need_period_modifier\n"); | 274 | warn("bad effect type in need_period_modifier"); |
275 | return 0; | 275 | return 0; |
276 | } | 276 | } |
277 | return (old->u.periodic.period != new->u.periodic.period | 277 | return (old->u.periodic.period != new->u.periodic.period |
diff --git a/drivers/input/joystick/iforce/iforce-main.c b/drivers/input/joystick/iforce/iforce-main.c index 3393a37fec39..fb129c479a66 100644 --- a/drivers/input/joystick/iforce/iforce-main.c +++ b/drivers/input/joystick/iforce/iforce-main.c | |||
@@ -2,7 +2,7 @@ | |||
2 | * $Id: iforce-main.c,v 1.19 2002/07/07 10:22:50 jdeneux Exp $ | 2 | * $Id: iforce-main.c,v 1.19 2002/07/07 10:22:50 jdeneux Exp $ |
3 | * | 3 | * |
4 | * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> | 4 | * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> |
5 | * Copyright (c) 2001-2002 Johann Deneux <deneux@ifrance.com> | 5 | * Copyright (c) 2001-2002, 2007 Johann Deneux <johann.deneux@gmail.com> |
6 | * | 6 | * |
7 | * USB/RS232 I-Force joysticks and wheels. | 7 | * USB/RS232 I-Force joysticks and wheels. |
8 | */ | 8 | */ |
@@ -29,7 +29,7 @@ | |||
29 | 29 | ||
30 | #include "iforce.h" | 30 | #include "iforce.h" |
31 | 31 | ||
32 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>, Johann Deneux <deneux@ifrance.com>"); | 32 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>, Johann Deneux <johann.deneux@gmail.com>"); |
33 | MODULE_DESCRIPTION("USB/RS232 I-Force joysticks and wheels driver"); | 33 | MODULE_DESCRIPTION("USB/RS232 I-Force joysticks and wheels driver"); |
34 | MODULE_LICENSE("GPL"); | 34 | MODULE_LICENSE("GPL"); |
35 | 35 | ||
@@ -220,7 +220,7 @@ static void iforce_release(struct input_dev *dev) | |||
220 | /* Check: no effects should be present in memory */ | 220 | /* Check: no effects should be present in memory */ |
221 | for (i = 0; i < dev->ff->max_effects; i++) { | 221 | for (i = 0; i < dev->ff->max_effects; i++) { |
222 | if (test_bit(FF_CORE_IS_USED, iforce->core_effects[i].flags)) { | 222 | if (test_bit(FF_CORE_IS_USED, iforce->core_effects[i].flags)) { |
223 | printk(KERN_WARNING "iforce_release: Device still owns effects\n"); | 223 | warn("iforce_release: Device still owns effects"); |
224 | break; | 224 | break; |
225 | } | 225 | } |
226 | } | 226 | } |
@@ -232,7 +232,7 @@ static void iforce_release(struct input_dev *dev) | |||
232 | switch (iforce->bus) { | 232 | switch (iforce->bus) { |
233 | #ifdef CONFIG_JOYSTICK_IFORCE_USB | 233 | #ifdef CONFIG_JOYSTICK_IFORCE_USB |
234 | case IFORCE_USB: | 234 | case IFORCE_USB: |
235 | usb_unlink_urb(iforce->irq); | 235 | usb_kill_urb(iforce->irq); |
236 | 236 | ||
237 | /* The device was unplugged before the file | 237 | /* The device was unplugged before the file |
238 | * was released */ | 238 | * was released */ |
@@ -287,13 +287,13 @@ int iforce_init_device(struct iforce *iforce) | |||
287 | #ifdef CONFIG_JOYSTICK_IFORCE_USB | 287 | #ifdef CONFIG_JOYSTICK_IFORCE_USB |
288 | case IFORCE_USB: | 288 | case IFORCE_USB: |
289 | input_dev->id.bustype = BUS_USB; | 289 | input_dev->id.bustype = BUS_USB; |
290 | input_dev->cdev.dev = &iforce->usbdev->dev; | 290 | input_dev->dev.parent = &iforce->usbdev->dev; |
291 | break; | 291 | break; |
292 | #endif | 292 | #endif |
293 | #ifdef CONFIG_JOYSTICK_IFORCE_232 | 293 | #ifdef CONFIG_JOYSTICK_IFORCE_232 |
294 | case IFORCE_232: | 294 | case IFORCE_232: |
295 | input_dev->id.bustype = BUS_RS232; | 295 | input_dev->id.bustype = BUS_RS232; |
296 | input_dev->cdev.dev = &iforce->serio->dev; | 296 | input_dev->dev.parent = &iforce->serio->dev; |
297 | break; | 297 | break; |
298 | #endif | 298 | #endif |
299 | } | 299 | } |
@@ -324,7 +324,7 @@ int iforce_init_device(struct iforce *iforce) | |||
324 | break; | 324 | break; |
325 | 325 | ||
326 | if (i == 20) { /* 5 seconds */ | 326 | if (i == 20) { /* 5 seconds */ |
327 | printk(KERN_ERR "iforce-main.c: Timeout waiting for response from device.\n"); | 327 | err("Timeout waiting for response from device."); |
328 | error = -ENODEV; | 328 | error = -ENODEV; |
329 | goto fail; | 329 | goto fail; |
330 | } | 330 | } |
@@ -336,26 +336,26 @@ int iforce_init_device(struct iforce *iforce) | |||
336 | if (!iforce_get_id_packet(iforce, "M")) | 336 | if (!iforce_get_id_packet(iforce, "M")) |
337 | input_dev->id.vendor = (iforce->edata[2] << 8) | iforce->edata[1]; | 337 | input_dev->id.vendor = (iforce->edata[2] << 8) | iforce->edata[1]; |
338 | else | 338 | else |
339 | printk(KERN_WARNING "iforce-main.c: Device does not respond to id packet M\n"); | 339 | warn("Device does not respond to id packet M"); |
340 | 340 | ||
341 | if (!iforce_get_id_packet(iforce, "P")) | 341 | if (!iforce_get_id_packet(iforce, "P")) |
342 | input_dev->id.product = (iforce->edata[2] << 8) | iforce->edata[1]; | 342 | input_dev->id.product = (iforce->edata[2] << 8) | iforce->edata[1]; |
343 | else | 343 | else |
344 | printk(KERN_WARNING "iforce-main.c: Device does not respond to id packet P\n"); | 344 | warn("Device does not respond to id packet P"); |
345 | 345 | ||
346 | if (!iforce_get_id_packet(iforce, "B")) | 346 | if (!iforce_get_id_packet(iforce, "B")) |
347 | iforce->device_memory.end = (iforce->edata[2] << 8) | iforce->edata[1]; | 347 | iforce->device_memory.end = (iforce->edata[2] << 8) | iforce->edata[1]; |
348 | else | 348 | else |
349 | printk(KERN_WARNING "iforce-main.c: Device does not respond to id packet B\n"); | 349 | warn("Device does not respond to id packet B"); |
350 | 350 | ||
351 | if (!iforce_get_id_packet(iforce, "N")) | 351 | if (!iforce_get_id_packet(iforce, "N")) |
352 | ff_effects = iforce->edata[1]; | 352 | ff_effects = iforce->edata[1]; |
353 | else | 353 | else |
354 | printk(KERN_WARNING "iforce-main.c: Device does not respond to id packet N\n"); | 354 | warn("Device does not respond to id packet N"); |
355 | 355 | ||
356 | /* Check if the device can store more effects than the driver can really handle */ | 356 | /* Check if the device can store more effects than the driver can really handle */ |
357 | if (ff_effects > IFORCE_EFFECTS_MAX) { | 357 | if (ff_effects > IFORCE_EFFECTS_MAX) { |
358 | printk(KERN_WARNING "iforce: Limiting number of effects to %d (device reports %d)\n", | 358 | warn("Limiting number of effects to %d (device reports %d)", |
359 | IFORCE_EFFECTS_MAX, ff_effects); | 359 | IFORCE_EFFECTS_MAX, ff_effects); |
360 | ff_effects = IFORCE_EFFECTS_MAX; | 360 | ff_effects = IFORCE_EFFECTS_MAX; |
361 | } | 361 | } |
@@ -457,8 +457,6 @@ int iforce_init_device(struct iforce *iforce) | |||
457 | if (error) | 457 | if (error) |
458 | goto fail; | 458 | goto fail; |
459 | 459 | ||
460 | printk(KERN_DEBUG "iforce->dev->open = %p\n", iforce->dev->open); | ||
461 | |||
462 | return 0; | 460 | return 0; |
463 | 461 | ||
464 | fail: input_free_device(input_dev); | 462 | fail: input_free_device(input_dev); |
diff --git a/drivers/input/joystick/iforce/iforce-packets.c b/drivers/input/joystick/iforce/iforce-packets.c index 808f05932a6f..21c4e13d3a50 100644 --- a/drivers/input/joystick/iforce/iforce-packets.c +++ b/drivers/input/joystick/iforce/iforce-packets.c | |||
@@ -2,7 +2,7 @@ | |||
2 | * $Id: iforce-packets.c,v 1.16 2002/07/07 10:22:50 jdeneux Exp $ | 2 | * $Id: iforce-packets.c,v 1.16 2002/07/07 10:22:50 jdeneux Exp $ |
3 | * | 3 | * |
4 | * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> | 4 | * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> |
5 | * Copyright (c) 2001-2002 Johann Deneux <deneux@ifrance.com> | 5 | * Copyright (c) 2001-2002, 2007 Johann Deneux <johann.deneux@gmail.com> |
6 | * | 6 | * |
7 | * USB/RS232 I-Force joysticks and wheels. | 7 | * USB/RS232 I-Force joysticks and wheels. |
8 | */ | 8 | */ |
@@ -39,10 +39,10 @@ void iforce_dump_packet(char *msg, u16 cmd, unsigned char *data) | |||
39 | { | 39 | { |
40 | int i; | 40 | int i; |
41 | 41 | ||
42 | printk(KERN_DEBUG "iforce.c: %s ( cmd = %04x, data = ", msg, cmd); | 42 | printk(KERN_DEBUG __FILE__ ": %s cmd = %04x, data = ", msg, cmd); |
43 | for (i = 0; i < LO(cmd); i++) | 43 | for (i = 0; i < LO(cmd); i++) |
44 | printk("%02x ", data[i]); | 44 | printk("%02x ", data[i]); |
45 | printk(")\n"); | 45 | printk("\n"); |
46 | } | 46 | } |
47 | 47 | ||
48 | /* | 48 | /* |
@@ -65,8 +65,9 @@ int iforce_send_packet(struct iforce *iforce, u16 cmd, unsigned char* data) | |||
65 | head = iforce->xmit.head; | 65 | head = iforce->xmit.head; |
66 | tail = iforce->xmit.tail; | 66 | tail = iforce->xmit.tail; |
67 | 67 | ||
68 | |||
68 | if (CIRC_SPACE(head, tail, XMIT_SIZE) < n+2) { | 69 | if (CIRC_SPACE(head, tail, XMIT_SIZE) < n+2) { |
69 | printk(KERN_WARNING "iforce.c: not enough space in xmit buffer to send new packet\n"); | 70 | warn("not enough space in xmit buffer to send new packet"); |
70 | spin_unlock_irqrestore(&iforce->xmit_lock, flags); | 71 | spin_unlock_irqrestore(&iforce->xmit_lock, flags); |
71 | return -1; | 72 | return -1; |
72 | } | 73 | } |
@@ -126,8 +127,6 @@ int iforce_control_playback(struct iforce* iforce, u16 id, unsigned int value) | |||
126 | { | 127 | { |
127 | unsigned char data[3]; | 128 | unsigned char data[3]; |
128 | 129 | ||
129 | printk(KERN_DEBUG "iforce-packets.c: control_playback %d %d\n", id, value); | ||
130 | |||
131 | data[0] = LO(id); | 130 | data[0] = LO(id); |
132 | data[1] = (value > 0) ? ((value > 1) ? 0x41 : 0x01) : 0; | 131 | data[1] = (value > 0) ? ((value > 1) ? 0x41 : 0x01) : 0; |
133 | data[2] = LO(value); | 132 | data[2] = LO(value); |
@@ -151,7 +150,7 @@ static int mark_core_as_ready(struct iforce *iforce, unsigned short addr) | |||
151 | return 0; | 150 | return 0; |
152 | } | 151 | } |
153 | } | 152 | } |
154 | printk(KERN_WARNING "iforce-packets.c: unused effect %04x updated !!!\n", addr); | 153 | warn("unused effect %04x updated !!!", addr); |
155 | return -1; | 154 | return -1; |
156 | } | 155 | } |
157 | 156 | ||
@@ -162,7 +161,7 @@ void iforce_process_packet(struct iforce *iforce, u16 cmd, unsigned char *data) | |||
162 | static int being_used = 0; | 161 | static int being_used = 0; |
163 | 162 | ||
164 | if (being_used) | 163 | if (being_used) |
165 | printk(KERN_WARNING "iforce-packets.c: re-entrant call to iforce_process %d\n", being_used); | 164 | warn("re-entrant call to iforce_process %d", being_used); |
166 | being_used++; | 165 | being_used++; |
167 | 166 | ||
168 | #ifdef CONFIG_JOYSTICK_IFORCE_232 | 167 | #ifdef CONFIG_JOYSTICK_IFORCE_232 |
@@ -266,7 +265,7 @@ int iforce_get_id_packet(struct iforce *iforce, char *packet) | |||
266 | return -1; | 265 | return -1; |
267 | } | 266 | } |
268 | #else | 267 | #else |
269 | printk(KERN_ERR "iforce_get_id_packet: iforce->bus = USB!\n"); | 268 | err("iforce_get_id_packet: iforce->bus = USB!"); |
270 | #endif | 269 | #endif |
271 | break; | 270 | break; |
272 | 271 | ||
@@ -284,13 +283,12 @@ int iforce_get_id_packet(struct iforce *iforce, char *packet) | |||
284 | return -1; | 283 | return -1; |
285 | } | 284 | } |
286 | #else | 285 | #else |
287 | printk(KERN_ERR "iforce_get_id_packet: iforce->bus = SERIO!\n"); | 286 | err("iforce_get_id_packet: iforce->bus = SERIO!"); |
288 | #endif | 287 | #endif |
289 | break; | 288 | break; |
290 | 289 | ||
291 | default: | 290 | default: |
292 | printk(KERN_ERR "iforce_get_id_packet: iforce->bus = %d\n", | 291 | err("iforce_get_id_packet: iforce->bus = %d", iforce->bus); |
293 | iforce->bus); | ||
294 | break; | 292 | break; |
295 | } | 293 | } |
296 | 294 | ||
diff --git a/drivers/input/joystick/iforce/iforce-serio.c b/drivers/input/joystick/iforce/iforce-serio.c index ec4be535f483..7b4bc19cef27 100644 --- a/drivers/input/joystick/iforce/iforce-serio.c +++ b/drivers/input/joystick/iforce/iforce-serio.c | |||
@@ -2,7 +2,7 @@ | |||
2 | * $Id: iforce-serio.c,v 1.4 2002/01/28 22:45:00 jdeneux Exp $ | 2 | * $Id: iforce-serio.c,v 1.4 2002/01/28 22:45:00 jdeneux Exp $ |
3 | * | 3 | * |
4 | * Copyright (c) 2000-2001 Vojtech Pavlik <vojtech@ucw.cz> | 4 | * Copyright (c) 2000-2001 Vojtech Pavlik <vojtech@ucw.cz> |
5 | * Copyright (c) 2001 Johann Deneux <deneux@ifrance.com> | 5 | * Copyright (c) 2001, 2007 Johann Deneux <johann.deneux@gmail.com> |
6 | * | 6 | * |
7 | * USB/RS232 I-Force joysticks and wheels. | 7 | * USB/RS232 I-Force joysticks and wheels. |
8 | */ | 8 | */ |
diff --git a/drivers/input/joystick/iforce/iforce-usb.c b/drivers/input/joystick/iforce/iforce-usb.c index 80cdebcbcb99..750099d8e3c6 100644 --- a/drivers/input/joystick/iforce/iforce-usb.c +++ b/drivers/input/joystick/iforce/iforce-usb.c | |||
@@ -2,7 +2,7 @@ | |||
2 | * $Id: iforce-usb.c,v 1.16 2002/06/09 11:08:04 jdeneux Exp $ | 2 | * $Id: iforce-usb.c,v 1.16 2002/06/09 11:08:04 jdeneux Exp $ |
3 | * | 3 | * |
4 | * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> | 4 | * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> |
5 | * Copyright (c) 2001-2002 Johann Deneux <deneux@ifrance.com> | 5 | * Copyright (c) 2001-2002, 2007 Johann Deneux <johann.deneux@gmail.com> |
6 | * | 6 | * |
7 | * USB/RS232 I-Force joysticks and wheels. | 7 | * USB/RS232 I-Force joysticks and wheels. |
8 | */ | 8 | */ |
@@ -65,7 +65,7 @@ void iforce_usb_xmit(struct iforce *iforce) | |||
65 | XMIT_INC(iforce->xmit.tail, n); | 65 | XMIT_INC(iforce->xmit.tail, n); |
66 | 66 | ||
67 | if ( (n=usb_submit_urb(iforce->out, GFP_ATOMIC)) ) { | 67 | if ( (n=usb_submit_urb(iforce->out, GFP_ATOMIC)) ) { |
68 | printk(KERN_WARNING "iforce-usb.c: iforce_usb_xmit: usb_submit_urb failed %d\n", n); | 68 | warn("usb_submit_urb failed %d\n", n); |
69 | } | 69 | } |
70 | 70 | ||
71 | /* The IFORCE_XMIT_RUNNING bit is not cleared here. That's intended. | 71 | /* The IFORCE_XMIT_RUNNING bit is not cleared here. That's intended. |
@@ -110,7 +110,7 @@ static void iforce_usb_out(struct urb *urb) | |||
110 | struct iforce *iforce = urb->context; | 110 | struct iforce *iforce = urb->context; |
111 | 111 | ||
112 | if (urb->status) { | 112 | if (urb->status) { |
113 | printk(KERN_DEBUG "iforce_usb_out: urb->status %d, exiting", urb->status); | 113 | dbg("urb->status %d, exiting", urb->status); |
114 | return; | 114 | return; |
115 | } | 115 | } |
116 | 116 | ||
@@ -190,10 +190,9 @@ fail: | |||
190 | /* Called by iforce_delete() */ | 190 | /* Called by iforce_delete() */ |
191 | void iforce_usb_delete(struct iforce* iforce) | 191 | void iforce_usb_delete(struct iforce* iforce) |
192 | { | 192 | { |
193 | usb_unlink_urb(iforce->irq); | 193 | usb_kill_urb(iforce->irq); |
194 | /* Is it ok to unlink those ? */ | 194 | usb_kill_urb(iforce->out); |
195 | usb_unlink_urb(iforce->out); | 195 | usb_kill_urb(iforce->ctrl); |
196 | usb_unlink_urb(iforce->ctrl); | ||
197 | 196 | ||
198 | usb_free_urb(iforce->irq); | 197 | usb_free_urb(iforce->irq); |
199 | usb_free_urb(iforce->out); | 198 | usb_free_urb(iforce->out); |
diff --git a/drivers/input/joystick/iforce/iforce.h b/drivers/input/joystick/iforce/iforce.h index ffaeaefa1a42..dadcf4fb92ae 100644 --- a/drivers/input/joystick/iforce/iforce.h +++ b/drivers/input/joystick/iforce/iforce.h | |||
@@ -2,7 +2,7 @@ | |||
2 | * $Id: iforce.h,v 1.13 2002/07/07 10:22:50 jdeneux Exp $ | 2 | * $Id: iforce.h,v 1.13 2002/07/07 10:22:50 jdeneux Exp $ |
3 | * | 3 | * |
4 | * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> | 4 | * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> |
5 | * Copyright (c) 2001-2002 Johann Deneux <deneux@ifrance.com> | 5 | * Copyright (c) 2001-2002, 2007 Johann Deneux <johann.deneux@gmail.com> |
6 | * | 6 | * |
7 | * USB/RS232 I-Force joysticks and wheels. | 7 | * USB/RS232 I-Force joysticks and wheels. |
8 | */ | 8 | */ |
diff --git a/drivers/input/joystick/interact.c b/drivers/input/joystick/interact.c index fec8b3d0967d..1aec1e9d7c59 100644 --- a/drivers/input/joystick/interact.c +++ b/drivers/input/joystick/interact.c | |||
@@ -185,7 +185,7 @@ static void interact_poll(struct gameport *gameport) | |||
185 | 185 | ||
186 | static int interact_open(struct input_dev *dev) | 186 | static int interact_open(struct input_dev *dev) |
187 | { | 187 | { |
188 | struct interact *interact = dev->private; | 188 | struct interact *interact = input_get_drvdata(dev); |
189 | 189 | ||
190 | gameport_start_polling(interact->gameport); | 190 | gameport_start_polling(interact->gameport); |
191 | return 0; | 191 | return 0; |
@@ -197,7 +197,7 @@ static int interact_open(struct input_dev *dev) | |||
197 | 197 | ||
198 | static void interact_close(struct input_dev *dev) | 198 | static void interact_close(struct input_dev *dev) |
199 | { | 199 | { |
200 | struct interact *interact = dev->private; | 200 | struct interact *interact = input_get_drvdata(dev); |
201 | 201 | ||
202 | gameport_stop_polling(interact->gameport); | 202 | gameport_stop_polling(interact->gameport); |
203 | } | 203 | } |
@@ -262,7 +262,9 @@ static int interact_connect(struct gameport *gameport, struct gameport_driver *d | |||
262 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_INTERACT; | 262 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_INTERACT; |
263 | input_dev->id.product = interact_type[i].id; | 263 | input_dev->id.product = interact_type[i].id; |
264 | input_dev->id.version = 0x0100; | 264 | input_dev->id.version = 0x0100; |
265 | input_dev->private = interact; | 265 | input_dev->dev.parent = &gameport->dev; |
266 | |||
267 | input_set_drvdata(input_dev, interact); | ||
266 | 268 | ||
267 | input_dev->open = interact_open; | 269 | input_dev->open = interact_open; |
268 | input_dev->close = interact_close; | 270 | input_dev->close = interact_close; |
diff --git a/drivers/input/joystick/magellan.c b/drivers/input/joystick/magellan.c index 4112789f1196..b35604ee43ae 100644 --- a/drivers/input/joystick/magellan.c +++ b/drivers/input/joystick/magellan.c | |||
@@ -168,8 +168,7 @@ static int magellan_connect(struct serio *serio, struct serio_driver *drv) | |||
168 | input_dev->id.vendor = SERIO_MAGELLAN; | 168 | input_dev->id.vendor = SERIO_MAGELLAN; |
169 | input_dev->id.product = 0x0001; | 169 | input_dev->id.product = 0x0001; |
170 | input_dev->id.version = 0x0100; | 170 | input_dev->id.version = 0x0100; |
171 | input_dev->cdev.dev = &serio->dev; | 171 | input_dev->dev.parent = &serio->dev; |
172 | input_dev->private = magellan; | ||
173 | 172 | ||
174 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 173 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
175 | 174 | ||
diff --git a/drivers/input/joystick/sidewinder.c b/drivers/input/joystick/sidewinder.c index e58b22c018e4..2adf73f63c94 100644 --- a/drivers/input/joystick/sidewinder.c +++ b/drivers/input/joystick/sidewinder.c | |||
@@ -509,7 +509,7 @@ static void sw_poll(struct gameport *gameport) | |||
509 | 509 | ||
510 | static int sw_open(struct input_dev *dev) | 510 | static int sw_open(struct input_dev *dev) |
511 | { | 511 | { |
512 | struct sw *sw = dev->private; | 512 | struct sw *sw = input_get_drvdata(dev); |
513 | 513 | ||
514 | gameport_start_polling(sw->gameport); | 514 | gameport_start_polling(sw->gameport); |
515 | return 0; | 515 | return 0; |
@@ -517,7 +517,7 @@ static int sw_open(struct input_dev *dev) | |||
517 | 517 | ||
518 | static void sw_close(struct input_dev *dev) | 518 | static void sw_close(struct input_dev *dev) |
519 | { | 519 | { |
520 | struct sw *sw = dev->private; | 520 | struct sw *sw = input_get_drvdata(dev); |
521 | 521 | ||
522 | gameport_stop_polling(sw->gameport); | 522 | gameport_stop_polling(sw->gameport); |
523 | } | 523 | } |
@@ -751,8 +751,9 @@ static int sw_connect(struct gameport *gameport, struct gameport_driver *drv) | |||
751 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_MICROSOFT; | 751 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_MICROSOFT; |
752 | input_dev->id.product = sw->type; | 752 | input_dev->id.product = sw->type; |
753 | input_dev->id.version = 0x0100; | 753 | input_dev->id.version = 0x0100; |
754 | input_dev->cdev.dev = &gameport->dev; | 754 | input_dev->dev.parent = &gameport->dev; |
755 | input_dev->private = sw; | 755 | |
756 | input_set_drvdata(input_dev, sw); | ||
756 | 757 | ||
757 | input_dev->open = sw_open; | 758 | input_dev->open = sw_open; |
758 | input_dev->close = sw_close; | 759 | input_dev->close = sw_close; |
diff --git a/drivers/input/joystick/spaceball.c b/drivers/input/joystick/spaceball.c index 08bf113e62eb..abb7c4cf54ad 100644 --- a/drivers/input/joystick/spaceball.c +++ b/drivers/input/joystick/spaceball.c | |||
@@ -226,8 +226,7 @@ static int spaceball_connect(struct serio *serio, struct serio_driver *drv) | |||
226 | input_dev->id.vendor = SERIO_SPACEBALL; | 226 | input_dev->id.vendor = SERIO_SPACEBALL; |
227 | input_dev->id.product = id; | 227 | input_dev->id.product = id; |
228 | input_dev->id.version = 0x0100; | 228 | input_dev->id.version = 0x0100; |
229 | input_dev->cdev.dev = &serio->dev; | 229 | input_dev->dev.parent = &serio->dev; |
230 | input_dev->private = spaceball; | ||
231 | 230 | ||
232 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 231 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
233 | 232 | ||
diff --git a/drivers/input/joystick/spaceorb.c b/drivers/input/joystick/spaceorb.c index c9c79211af71..c4937f1e837c 100644 --- a/drivers/input/joystick/spaceorb.c +++ b/drivers/input/joystick/spaceorb.c | |||
@@ -183,8 +183,7 @@ static int spaceorb_connect(struct serio *serio, struct serio_driver *drv) | |||
183 | input_dev->id.vendor = SERIO_SPACEORB; | 183 | input_dev->id.vendor = SERIO_SPACEORB; |
184 | input_dev->id.product = 0x0001; | 184 | input_dev->id.product = 0x0001; |
185 | input_dev->id.version = 0x0100; | 185 | input_dev->id.version = 0x0100; |
186 | input_dev->cdev.dev = &serio->dev; | 186 | input_dev->dev.parent = &serio->dev; |
187 | input_dev->private = spaceorb; | ||
188 | 187 | ||
189 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 188 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
190 | 189 | ||
diff --git a/drivers/input/joystick/stinger.c b/drivers/input/joystick/stinger.c index ecb0916215fa..8581ee991d4e 100644 --- a/drivers/input/joystick/stinger.c +++ b/drivers/input/joystick/stinger.c | |||
@@ -154,8 +154,7 @@ static int stinger_connect(struct serio *serio, struct serio_driver *drv) | |||
154 | input_dev->id.vendor = SERIO_STINGER; | 154 | input_dev->id.vendor = SERIO_STINGER; |
155 | input_dev->id.product = 0x0001; | 155 | input_dev->id.product = 0x0001; |
156 | input_dev->id.version = 0x0100; | 156 | input_dev->id.version = 0x0100; |
157 | input_dev->cdev.dev = &serio->dev; | 157 | input_dev->dev.parent = &serio->dev; |
158 | input_dev->private = stinger; | ||
159 | 158 | ||
160 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 159 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
161 | input_dev->keybit[LONG(BTN_A)] = BIT(BTN_A) | BIT(BTN_B) | BIT(BTN_C) | BIT(BTN_X) | | 160 | input_dev->keybit[LONG(BTN_A)] = BIT(BTN_A) | BIT(BTN_B) | BIT(BTN_C) | BIT(BTN_X) | |
diff --git a/drivers/input/joystick/tmdc.c b/drivers/input/joystick/tmdc.c index bb23ed2a04a6..3b36ee04f726 100644 --- a/drivers/input/joystick/tmdc.c +++ b/drivers/input/joystick/tmdc.c | |||
@@ -265,7 +265,7 @@ static void tmdc_poll(struct gameport *gameport) | |||
265 | 265 | ||
266 | static int tmdc_open(struct input_dev *dev) | 266 | static int tmdc_open(struct input_dev *dev) |
267 | { | 267 | { |
268 | struct tmdc *tmdc = dev->private; | 268 | struct tmdc *tmdc = input_get_drvdata(dev); |
269 | 269 | ||
270 | gameport_start_polling(tmdc->gameport); | 270 | gameport_start_polling(tmdc->gameport); |
271 | return 0; | 271 | return 0; |
@@ -273,7 +273,7 @@ static int tmdc_open(struct input_dev *dev) | |||
273 | 273 | ||
274 | static void tmdc_close(struct input_dev *dev) | 274 | static void tmdc_close(struct input_dev *dev) |
275 | { | 275 | { |
276 | struct tmdc *tmdc = dev->private; | 276 | struct tmdc *tmdc = input_get_drvdata(dev); |
277 | 277 | ||
278 | gameport_stop_polling(tmdc->gameport); | 278 | gameport_stop_polling(tmdc->gameport); |
279 | } | 279 | } |
@@ -326,8 +326,9 @@ static int tmdc_setup_port(struct tmdc *tmdc, int idx, unsigned char *data) | |||
326 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_THRUSTMASTER; | 326 | input_dev->id.vendor = GAMEPORT_ID_VENDOR_THRUSTMASTER; |
327 | input_dev->id.product = model->id; | 327 | input_dev->id.product = model->id; |
328 | input_dev->id.version = 0x0100; | 328 | input_dev->id.version = 0x0100; |
329 | input_dev->cdev.dev = &tmdc->gameport->dev; | 329 | input_dev->dev.parent = &tmdc->gameport->dev; |
330 | input_dev->private = tmdc; | 330 | |
331 | input_set_drvdata(input_dev, tmdc); | ||
331 | 332 | ||
332 | input_dev->open = tmdc_open; | 333 | input_dev->open = tmdc_open; |
333 | input_dev->close = tmdc_close; | 334 | input_dev->close = tmdc_close; |
diff --git a/drivers/input/joystick/turbografx.c b/drivers/input/joystick/turbografx.c index 037d3487fcc7..0f2c60823b0b 100644 --- a/drivers/input/joystick/turbografx.c +++ b/drivers/input/joystick/turbografx.c | |||
@@ -122,7 +122,7 @@ static void tgfx_timer(unsigned long private) | |||
122 | 122 | ||
123 | static int tgfx_open(struct input_dev *dev) | 123 | static int tgfx_open(struct input_dev *dev) |
124 | { | 124 | { |
125 | struct tgfx *tgfx = dev->private; | 125 | struct tgfx *tgfx = input_get_drvdata(dev); |
126 | int err; | 126 | int err; |
127 | 127 | ||
128 | err = mutex_lock_interruptible(&tgfx->sem); | 128 | err = mutex_lock_interruptible(&tgfx->sem); |
@@ -141,7 +141,7 @@ static int tgfx_open(struct input_dev *dev) | |||
141 | 141 | ||
142 | static void tgfx_close(struct input_dev *dev) | 142 | static void tgfx_close(struct input_dev *dev) |
143 | { | 143 | { |
144 | struct tgfx *tgfx = dev->private; | 144 | struct tgfx *tgfx = input_get_drvdata(dev); |
145 | 145 | ||
146 | mutex_lock(&tgfx->sem); | 146 | mutex_lock(&tgfx->sem); |
147 | if (!--tgfx->used) { | 147 | if (!--tgfx->used) { |
@@ -224,7 +224,8 @@ static struct tgfx __init *tgfx_probe(int parport, int *n_buttons, int n_devs) | |||
224 | input_dev->id.product = n_buttons[i]; | 224 | input_dev->id.product = n_buttons[i]; |
225 | input_dev->id.version = 0x0100; | 225 | input_dev->id.version = 0x0100; |
226 | 226 | ||
227 | input_dev->private = tgfx; | 227 | input_set_drvdata(input_dev, tgfx); |
228 | |||
228 | input_dev->open = tgfx_open; | 229 | input_dev->open = tgfx_open; |
229 | input_dev->close = tgfx_close; | 230 | input_dev->close = tgfx_close; |
230 | 231 | ||
diff --git a/drivers/input/joystick/twidjoy.c b/drivers/input/joystick/twidjoy.c index 9cf17d6ced82..c91504ec38eb 100644 --- a/drivers/input/joystick/twidjoy.c +++ b/drivers/input/joystick/twidjoy.c | |||
@@ -205,11 +205,9 @@ static int twidjoy_connect(struct serio *serio, struct serio_driver *drv) | |||
205 | input_dev->id.vendor = SERIO_TWIDJOY; | 205 | input_dev->id.vendor = SERIO_TWIDJOY; |
206 | input_dev->id.product = 0x0001; | 206 | input_dev->id.product = 0x0001; |
207 | input_dev->id.version = 0x0100; | 207 | input_dev->id.version = 0x0100; |
208 | input_dev->cdev.dev = &serio->dev; | 208 | input_dev->dev.parent = &serio->dev; |
209 | input_dev->private = twidjoy; | ||
210 | 209 | ||
211 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 210 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
212 | input_dev->absbit[0] = BIT(ABS_X) | BIT(ABS_Y); | ||
213 | input_set_abs_params(input_dev, ABS_X, -50, 50, 4, 4); | 211 | input_set_abs_params(input_dev, ABS_X, -50, 50, 4, 4); |
214 | input_set_abs_params(input_dev, ABS_Y, -50, 50, 4, 4); | 212 | input_set_abs_params(input_dev, ABS_Y, -50, 50, 4, 4); |
215 | 213 | ||
diff --git a/drivers/input/joystick/warrior.c b/drivers/input/joystick/warrior.c index 29d339acf430..4e85f72eefd7 100644 --- a/drivers/input/joystick/warrior.c +++ b/drivers/input/joystick/warrior.c | |||
@@ -160,8 +160,7 @@ static int warrior_connect(struct serio *serio, struct serio_driver *drv) | |||
160 | input_dev->id.vendor = SERIO_WARRIOR; | 160 | input_dev->id.vendor = SERIO_WARRIOR; |
161 | input_dev->id.product = 0x0001; | 161 | input_dev->id.product = 0x0001; |
162 | input_dev->id.version = 0x0100; | 162 | input_dev->id.version = 0x0100; |
163 | input_dev->cdev.dev = &serio->dev; | 163 | input_dev->dev.parent = &serio->dev; |
164 | input_dev->private = warrior; | ||
165 | 164 | ||
166 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REL) | BIT(EV_ABS); | 165 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REL) | BIT(EV_ABS); |
167 | input_dev->keybit[LONG(BTN_TRIGGER)] = BIT(BTN_TRIGGER) | BIT(BTN_THUMB) | BIT(BTN_TOP) | BIT(BTN_TOP2); | 166 | input_dev->keybit[LONG(BTN_TRIGGER)] = BIT(BTN_TRIGGER) | BIT(BTN_THUMB) | BIT(BTN_TOP) | BIT(BTN_TOP2); |
diff --git a/drivers/input/keyboard/Kconfig b/drivers/input/keyboard/Kconfig index c845d5c4cbba..9f42e4d3649e 100644 --- a/drivers/input/keyboard/Kconfig +++ b/drivers/input/keyboard/Kconfig | |||
@@ -214,6 +214,15 @@ config KEYBOARD_OMAP | |||
214 | To compile this driver as a module, choose M here: the | 214 | To compile this driver as a module, choose M here: the |
215 | module will be called omap-keypad. | 215 | module will be called omap-keypad. |
216 | 216 | ||
217 | config KEYBOARD_PXA27x | ||
218 | tristate "PXA27x keyboard support" | ||
219 | depends on PXA27x | ||
220 | help | ||
221 | Enable support for PXA27x matrix keyboard controller | ||
222 | |||
223 | To compile this driver as a module, choose M here: the | ||
224 | module will be called pxa27x_keyboard. | ||
225 | |||
217 | config KEYBOARD_AAED2000 | 226 | config KEYBOARD_AAED2000 |
218 | tristate "AAED-2000 keyboard" | 227 | tristate "AAED-2000 keyboard" |
219 | depends on MACH_AAED2000 | 228 | depends on MACH_AAED2000 |
diff --git a/drivers/input/keyboard/Makefile b/drivers/input/keyboard/Makefile index 7aa59ee5a0b6..28d211b87b14 100644 --- a/drivers/input/keyboard/Makefile +++ b/drivers/input/keyboard/Makefile | |||
@@ -18,6 +18,7 @@ obj-$(CONFIG_KEYBOARD_SPITZ) += spitzkbd.o | |||
18 | obj-$(CONFIG_KEYBOARD_HIL) += hil_kbd.o | 18 | obj-$(CONFIG_KEYBOARD_HIL) += hil_kbd.o |
19 | obj-$(CONFIG_KEYBOARD_HIL_OLD) += hilkbd.o | 19 | obj-$(CONFIG_KEYBOARD_HIL_OLD) += hilkbd.o |
20 | obj-$(CONFIG_KEYBOARD_OMAP) += omap-keypad.o | 20 | obj-$(CONFIG_KEYBOARD_OMAP) += omap-keypad.o |
21 | obj-$(CONFIG_KEYBOARD_PXA27x) += pxa27x_keyboard.o | ||
21 | obj-$(CONFIG_KEYBOARD_AAED2000) += aaed2000_kbd.o | 22 | obj-$(CONFIG_KEYBOARD_AAED2000) += aaed2000_kbd.o |
22 | obj-$(CONFIG_KEYBOARD_GPIO) += gpio_keys.o | 23 | obj-$(CONFIG_KEYBOARD_GPIO) += gpio_keys.o |
23 | 24 | ||
diff --git a/drivers/input/keyboard/aaed2000_kbd.c b/drivers/input/keyboard/aaed2000_kbd.c index 65fcb6af63a8..3a37505f067c 100644 --- a/drivers/input/keyboard/aaed2000_kbd.c +++ b/drivers/input/keyboard/aaed2000_kbd.c | |||
@@ -97,7 +97,7 @@ static void aaedkbd_work(void *data) | |||
97 | 97 | ||
98 | static int aaedkbd_open(struct input_dev *indev) | 98 | static int aaedkbd_open(struct input_dev *indev) |
99 | { | 99 | { |
100 | struct aaedkbd *aaedkbd = indev->private; | 100 | struct aaedkbd *aaedkbd = input_get_drvdata(indev); |
101 | 101 | ||
102 | schedule_delayed_work(&aaedkbd->workq, msecs_to_jiffies(SCAN_INTERVAL)); | 102 | schedule_delayed_work(&aaedkbd->workq, msecs_to_jiffies(SCAN_INTERVAL)); |
103 | 103 | ||
@@ -106,7 +106,7 @@ static int aaedkbd_open(struct input_dev *indev) | |||
106 | 106 | ||
107 | static void aaedkbd_close(struct input_dev *indev) | 107 | static void aaedkbd_close(struct input_dev *indev) |
108 | { | 108 | { |
109 | struct aaedkbd *aaedkbd = indev->private; | 109 | struct aaedkbd *aaedkbd = input_get_drvdata(indev); |
110 | 110 | ||
111 | cancel_delayed_work(&aaedkbd->workq); | 111 | cancel_delayed_work(&aaedkbd->workq); |
112 | flush_scheduled_work(); | 112 | flush_scheduled_work(); |
@@ -141,8 +141,9 @@ static int __devinit aaedkbd_probe(struct platform_device *pdev) | |||
141 | input_dev->id.vendor = 0x0001; | 141 | input_dev->id.vendor = 0x0001; |
142 | input_dev->id.product = 0x0001; | 142 | input_dev->id.product = 0x0001; |
143 | input_dev->id.version = 0x0100; | 143 | input_dev->id.version = 0x0100; |
144 | input_dev->cdev.dev = &pdev->dev; | 144 | input_dev->dev.parent = &pdev->dev; |
145 | input_dev->private = aaedkbd; | 145 | |
146 | input_set_drvdata(input_dev, aaedkbd); | ||
146 | 147 | ||
147 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); | 148 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); |
148 | input_dev->keycode = aaedkbd->keycode; | 149 | input_dev->keycode = aaedkbd->keycode; |
diff --git a/drivers/input/keyboard/atkbd.c b/drivers/input/keyboard/atkbd.c index 663877076bc7..be1fe46cd308 100644 --- a/drivers/input/keyboard/atkbd.c +++ b/drivers/input/keyboard/atkbd.c | |||
@@ -586,7 +586,7 @@ static void atkbd_event_work(struct work_struct *work) | |||
586 | 586 | ||
587 | static int atkbd_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) | 587 | static int atkbd_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) |
588 | { | 588 | { |
589 | struct atkbd *atkbd = dev->private; | 589 | struct atkbd *atkbd = input_get_drvdata(dev); |
590 | 590 | ||
591 | if (!atkbd->write) | 591 | if (!atkbd->write) |
592 | return -1; | 592 | return -1; |
@@ -883,8 +883,9 @@ static void atkbd_set_device_attrs(struct atkbd *atkbd) | |||
883 | input_dev->id.product = atkbd->translated ? 1 : atkbd->set; | 883 | input_dev->id.product = atkbd->translated ? 1 : atkbd->set; |
884 | input_dev->id.version = atkbd->id; | 884 | input_dev->id.version = atkbd->id; |
885 | input_dev->event = atkbd_event; | 885 | input_dev->event = atkbd_event; |
886 | input_dev->private = atkbd; | 886 | input_dev->dev.parent = &atkbd->ps2dev.serio->dev; |
887 | input_dev->cdev.dev = &atkbd->ps2dev.serio->dev; | 887 | |
888 | input_set_drvdata(input_dev, atkbd); | ||
888 | 889 | ||
889 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_MSC); | 890 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_MSC); |
890 | 891 | ||
diff --git a/drivers/input/keyboard/corgikbd.c b/drivers/input/keyboard/corgikbd.c index 1016c94e65db..6578bfff644b 100644 --- a/drivers/input/keyboard/corgikbd.c +++ b/drivers/input/keyboard/corgikbd.c | |||
@@ -323,8 +323,7 @@ static int __init corgikbd_probe(struct platform_device *pdev) | |||
323 | input_dev->id.vendor = 0x0001; | 323 | input_dev->id.vendor = 0x0001; |
324 | input_dev->id.product = 0x0001; | 324 | input_dev->id.product = 0x0001; |
325 | input_dev->id.version = 0x0100; | 325 | input_dev->id.version = 0x0100; |
326 | input_dev->cdev.dev = &pdev->dev; | 326 | input_dev->dev.parent = &pdev->dev; |
327 | input_dev->private = corgikbd; | ||
328 | 327 | ||
329 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_PWR) | BIT(EV_SW); | 328 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_PWR) | BIT(EV_SW); |
330 | input_dev->keycode = corgikbd->keycode; | 329 | input_dev->keycode = corgikbd->keycode; |
diff --git a/drivers/input/keyboard/gpio_keys.c b/drivers/input/keyboard/gpio_keys.c index ccf6df387b62..739212252b09 100644 --- a/drivers/input/keyboard/gpio_keys.c +++ b/drivers/input/keyboard/gpio_keys.c | |||
@@ -35,11 +35,14 @@ static irqreturn_t gpio_keys_isr(int irq, void *dev_id) | |||
35 | struct input_dev *input = platform_get_drvdata(pdev); | 35 | struct input_dev *input = platform_get_drvdata(pdev); |
36 | 36 | ||
37 | for (i = 0; i < pdata->nbuttons; i++) { | 37 | for (i = 0; i < pdata->nbuttons; i++) { |
38 | int gpio = pdata->buttons[i].gpio; | 38 | struct gpio_keys_button *button = &pdata->buttons[i]; |
39 | int gpio = button->gpio; | ||
40 | |||
39 | if (irq == gpio_to_irq(gpio)) { | 41 | if (irq == gpio_to_irq(gpio)) { |
40 | int state = (gpio_get_value(gpio) ? 1 : 0) ^ (pdata->buttons[i].active_low); | 42 | unsigned int type = button->type ?: EV_KEY; |
43 | int state = (gpio_get_value(gpio) ? 1 : 0) ^ button->active_low; | ||
41 | 44 | ||
42 | input_report_key(input, pdata->buttons[i].keycode, state); | 45 | input_event(input, type, button->code, !!state); |
43 | input_sync(input); | 46 | input_sync(input); |
44 | } | 47 | } |
45 | } | 48 | } |
@@ -63,8 +66,7 @@ static int __devinit gpio_keys_probe(struct platform_device *pdev) | |||
63 | 66 | ||
64 | input->name = pdev->name; | 67 | input->name = pdev->name; |
65 | input->phys = "gpio-keys/input0"; | 68 | input->phys = "gpio-keys/input0"; |
66 | input->cdev.dev = &pdev->dev; | 69 | input->dev.parent = &pdev->dev; |
67 | input->private = pdata; | ||
68 | 70 | ||
69 | input->id.bustype = BUS_HOST; | 71 | input->id.bustype = BUS_HOST; |
70 | input->id.vendor = 0x0001; | 72 | input->id.vendor = 0x0001; |
@@ -72,19 +74,21 @@ static int __devinit gpio_keys_probe(struct platform_device *pdev) | |||
72 | input->id.version = 0x0100; | 74 | input->id.version = 0x0100; |
73 | 75 | ||
74 | for (i = 0; i < pdata->nbuttons; i++) { | 76 | for (i = 0; i < pdata->nbuttons; i++) { |
75 | int code = pdata->buttons[i].keycode; | 77 | struct gpio_keys_button *button = &pdata->buttons[i]; |
76 | int irq = gpio_to_irq(pdata->buttons[i].gpio); | 78 | int irq = gpio_to_irq(button->gpio); |
79 | unsigned int type = button->type ?: EV_KEY; | ||
77 | 80 | ||
78 | set_irq_type(irq, IRQ_TYPE_EDGE_BOTH); | 81 | set_irq_type(irq, IRQ_TYPE_EDGE_BOTH); |
79 | error = request_irq(irq, gpio_keys_isr, IRQF_SAMPLE_RANDOM, | 82 | error = request_irq(irq, gpio_keys_isr, IRQF_SAMPLE_RANDOM, |
80 | pdata->buttons[i].desc ? pdata->buttons[i].desc : "gpio_keys", | 83 | button->desc ? button->desc : "gpio_keys", |
81 | pdev); | 84 | pdev); |
82 | if (error) { | 85 | if (error) { |
83 | printk(KERN_ERR "gpio-keys: unable to claim irq %d; error %d\n", | 86 | printk(KERN_ERR "gpio-keys: unable to claim irq %d; error %d\n", |
84 | irq, error); | 87 | irq, error); |
85 | goto fail; | 88 | goto fail; |
86 | } | 89 | } |
87 | set_bit(code, input->keybit); | 90 | |
91 | input_set_capability(input, type, button->code); | ||
88 | } | 92 | } |
89 | 93 | ||
90 | error = input_register_device(input); | 94 | error = input_register_device(input); |
diff --git a/drivers/input/keyboard/hil_kbd.c b/drivers/input/keyboard/hil_kbd.c index 7cc9728b04df..cdd254f2e6c7 100644 --- a/drivers/input/keyboard/hil_kbd.c +++ b/drivers/input/keyboard/hil_kbd.c | |||
@@ -51,7 +51,7 @@ MODULE_LICENSE("Dual BSD/GPL"); | |||
51 | 51 | ||
52 | #define HIL_KBD_SET1_UPBIT 0x01 | 52 | #define HIL_KBD_SET1_UPBIT 0x01 |
53 | #define HIL_KBD_SET1_SHIFT 1 | 53 | #define HIL_KBD_SET1_SHIFT 1 |
54 | static unsigned int hil_kbd_set1[HIL_KEYCODES_SET1_TBLSIZE] = | 54 | static unsigned int hil_kbd_set1[HIL_KEYCODES_SET1_TBLSIZE] __read_mostly = |
55 | { HIL_KEYCODES_SET1 }; | 55 | { HIL_KEYCODES_SET1 }; |
56 | 56 | ||
57 | #define HIL_KBD_SET2_UPBIT 0x01 | 57 | #define HIL_KBD_SET2_UPBIT 0x01 |
@@ -60,10 +60,10 @@ static unsigned int hil_kbd_set1[HIL_KEYCODES_SET1_TBLSIZE] = | |||
60 | 60 | ||
61 | #define HIL_KBD_SET3_UPBIT 0x80 | 61 | #define HIL_KBD_SET3_UPBIT 0x80 |
62 | #define HIL_KBD_SET3_SHIFT 0 | 62 | #define HIL_KBD_SET3_SHIFT 0 |
63 | static unsigned int hil_kbd_set3[HIL_KEYCODES_SET3_TBLSIZE] = | 63 | static unsigned int hil_kbd_set3[HIL_KEYCODES_SET3_TBLSIZE] __read_mostly = |
64 | { HIL_KEYCODES_SET3 }; | 64 | { HIL_KEYCODES_SET3 }; |
65 | 65 | ||
66 | static char hil_language[][16] = { HIL_LOCALE_MAP }; | 66 | static const char hil_language[][16] = { HIL_LOCALE_MAP }; |
67 | 67 | ||
68 | struct hil_kbd { | 68 | struct hil_kbd { |
69 | struct input_dev *dev; | 69 | struct input_dev *dev; |
@@ -94,10 +94,12 @@ static void hil_kbd_process_record(struct hil_kbd *kbd) | |||
94 | idx = kbd->idx4/4; | 94 | idx = kbd->idx4/4; |
95 | p = data[idx - 1]; | 95 | p = data[idx - 1]; |
96 | 96 | ||
97 | if ((p & ~HIL_CMDCT_POL) == | 97 | if ((p & ~HIL_CMDCT_POL) == |
98 | (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_POL)) goto report; | 98 | (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_POL)) |
99 | if ((p & ~HIL_CMDCT_RPL) == | 99 | goto report; |
100 | (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_RPL)) goto report; | 100 | if ((p & ~HIL_CMDCT_RPL) == |
101 | (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_RPL)) | ||
102 | goto report; | ||
101 | 103 | ||
102 | /* Not a poll response. See if we are loading config records. */ | 104 | /* Not a poll response. See if we are loading config records. */ |
103 | switch (p & HIL_PKT_DATA_MASK) { | 105 | switch (p & HIL_PKT_DATA_MASK) { |
@@ -107,27 +109,32 @@ static void hil_kbd_process_record(struct hil_kbd *kbd) | |||
107 | for (; i < HIL_KBD_MAX_LENGTH; i++) | 109 | for (; i < HIL_KBD_MAX_LENGTH; i++) |
108 | kbd->idd[i] = 0; | 110 | kbd->idd[i] = 0; |
109 | break; | 111 | break; |
112 | |||
110 | case HIL_CMD_RSC: | 113 | case HIL_CMD_RSC: |
111 | for (i = 0; i < idx; i++) | 114 | for (i = 0; i < idx; i++) |
112 | kbd->rsc[i] = kbd->data[i] & HIL_PKT_DATA_MASK; | 115 | kbd->rsc[i] = kbd->data[i] & HIL_PKT_DATA_MASK; |
113 | for (; i < HIL_KBD_MAX_LENGTH; i++) | 116 | for (; i < HIL_KBD_MAX_LENGTH; i++) |
114 | kbd->rsc[i] = 0; | 117 | kbd->rsc[i] = 0; |
115 | break; | 118 | break; |
119 | |||
116 | case HIL_CMD_EXD: | 120 | case HIL_CMD_EXD: |
117 | for (i = 0; i < idx; i++) | 121 | for (i = 0; i < idx; i++) |
118 | kbd->exd[i] = kbd->data[i] & HIL_PKT_DATA_MASK; | 122 | kbd->exd[i] = kbd->data[i] & HIL_PKT_DATA_MASK; |
119 | for (; i < HIL_KBD_MAX_LENGTH; i++) | 123 | for (; i < HIL_KBD_MAX_LENGTH; i++) |
120 | kbd->exd[i] = 0; | 124 | kbd->exd[i] = 0; |
121 | break; | 125 | break; |
126 | |||
122 | case HIL_CMD_RNM: | 127 | case HIL_CMD_RNM: |
123 | for (i = 0; i < idx; i++) | 128 | for (i = 0; i < idx; i++) |
124 | kbd->rnm[i] = kbd->data[i] & HIL_PKT_DATA_MASK; | 129 | kbd->rnm[i] = kbd->data[i] & HIL_PKT_DATA_MASK; |
125 | for (; i < HIL_KBD_MAX_LENGTH + 1; i++) | 130 | for (; i < HIL_KBD_MAX_LENGTH + 1; i++) |
126 | kbd->rnm[i] = '\0'; | 131 | kbd->rnm[i] = '\0'; |
127 | break; | 132 | break; |
133 | |||
128 | default: | 134 | default: |
129 | /* These occur when device isn't present */ | 135 | /* These occur when device isn't present */ |
130 | if (p == (HIL_ERR_INT | HIL_PKT_CMD)) break; | 136 | if (p == (HIL_ERR_INT | HIL_PKT_CMD)) |
137 | break; | ||
131 | /* Anything else we'd like to know about. */ | 138 | /* Anything else we'd like to know about. */ |
132 | printk(KERN_WARNING PREFIX "Device sent unknown record %x\n", p); | 139 | printk(KERN_WARNING PREFIX "Device sent unknown record %x\n", p); |
133 | break; | 140 | break; |
@@ -139,16 +146,19 @@ static void hil_kbd_process_record(struct hil_kbd *kbd) | |||
139 | switch (kbd->data[0] & HIL_POL_CHARTYPE_MASK) { | 146 | switch (kbd->data[0] & HIL_POL_CHARTYPE_MASK) { |
140 | case HIL_POL_CHARTYPE_NONE: | 147 | case HIL_POL_CHARTYPE_NONE: |
141 | break; | 148 | break; |
149 | |||
142 | case HIL_POL_CHARTYPE_ASCII: | 150 | case HIL_POL_CHARTYPE_ASCII: |
143 | while (cnt < idx - 1) | 151 | while (cnt < idx - 1) |
144 | input_report_key(dev, kbd->data[cnt++] & 0x7f, 1); | 152 | input_report_key(dev, kbd->data[cnt++] & 0x7f, 1); |
145 | break; | 153 | break; |
154 | |||
146 | case HIL_POL_CHARTYPE_RSVD1: | 155 | case HIL_POL_CHARTYPE_RSVD1: |
147 | case HIL_POL_CHARTYPE_RSVD2: | 156 | case HIL_POL_CHARTYPE_RSVD2: |
148 | case HIL_POL_CHARTYPE_BINARY: | 157 | case HIL_POL_CHARTYPE_BINARY: |
149 | while (cnt < idx - 1) | 158 | while (cnt < idx - 1) |
150 | input_report_key(dev, kbd->data[cnt++], 1); | 159 | input_report_key(dev, kbd->data[cnt++], 1); |
151 | break; | 160 | break; |
161 | |||
152 | case HIL_POL_CHARTYPE_SET1: | 162 | case HIL_POL_CHARTYPE_SET1: |
153 | while (cnt < idx - 1) { | 163 | while (cnt < idx - 1) { |
154 | unsigned int key; | 164 | unsigned int key; |
@@ -161,6 +171,7 @@ static void hil_kbd_process_record(struct hil_kbd *kbd) | |||
161 | input_report_key(dev, key, !up); | 171 | input_report_key(dev, key, !up); |
162 | } | 172 | } |
163 | break; | 173 | break; |
174 | |||
164 | case HIL_POL_CHARTYPE_SET2: | 175 | case HIL_POL_CHARTYPE_SET2: |
165 | while (cnt < idx - 1) { | 176 | while (cnt < idx - 1) { |
166 | unsigned int key; | 177 | unsigned int key; |
@@ -173,6 +184,7 @@ static void hil_kbd_process_record(struct hil_kbd *kbd) | |||
173 | input_report_key(dev, key, !up); | 184 | input_report_key(dev, key, !up); |
174 | } | 185 | } |
175 | break; | 186 | break; |
187 | |||
176 | case HIL_POL_CHARTYPE_SET3: | 188 | case HIL_POL_CHARTYPE_SET3: |
177 | while (cnt < idx - 1) { | 189 | while (cnt < idx - 1) { |
178 | unsigned int key; | 190 | unsigned int key; |
@@ -191,42 +203,43 @@ static void hil_kbd_process_record(struct hil_kbd *kbd) | |||
191 | up(&kbd->sem); | 203 | up(&kbd->sem); |
192 | } | 204 | } |
193 | 205 | ||
194 | static void hil_kbd_process_err(struct hil_kbd *kbd) { | 206 | static void hil_kbd_process_err(struct hil_kbd *kbd) |
207 | { | ||
195 | printk(KERN_WARNING PREFIX "errored HIL packet\n"); | 208 | printk(KERN_WARNING PREFIX "errored HIL packet\n"); |
196 | kbd->idx4 = 0; | 209 | kbd->idx4 = 0; |
197 | up(&kbd->sem); | 210 | up(&kbd->sem); |
198 | } | 211 | } |
199 | 212 | ||
200 | static irqreturn_t hil_kbd_interrupt(struct serio *serio, | 213 | static irqreturn_t hil_kbd_interrupt(struct serio *serio, |
201 | unsigned char data, unsigned int flags) | 214 | unsigned char data, unsigned int flags) |
202 | { | 215 | { |
203 | struct hil_kbd *kbd; | 216 | struct hil_kbd *kbd; |
204 | hil_packet packet; | 217 | hil_packet packet; |
205 | int idx; | 218 | int idx; |
206 | 219 | ||
207 | kbd = serio_get_drvdata(serio); | 220 | kbd = serio_get_drvdata(serio); |
208 | if (kbd == NULL) { | 221 | BUG_ON(kbd == NULL); |
209 | BUG(); | ||
210 | return IRQ_HANDLED; | ||
211 | } | ||
212 | 222 | ||
213 | if (kbd->idx4 >= (HIL_KBD_MAX_LENGTH * sizeof(hil_packet))) { | 223 | if (kbd->idx4 >= (HIL_KBD_MAX_LENGTH * sizeof(hil_packet))) { |
214 | hil_kbd_process_err(kbd); | 224 | hil_kbd_process_err(kbd); |
215 | return IRQ_HANDLED; | 225 | return IRQ_HANDLED; |
216 | } | 226 | } |
217 | idx = kbd->idx4/4; | 227 | idx = kbd->idx4/4; |
218 | if (!(kbd->idx4 % 4)) kbd->data[idx] = 0; | 228 | if (!(kbd->idx4 % 4)) |
229 | kbd->data[idx] = 0; | ||
219 | packet = kbd->data[idx]; | 230 | packet = kbd->data[idx]; |
220 | packet |= ((hil_packet)data) << ((3 - (kbd->idx4 % 4)) * 8); | 231 | packet |= ((hil_packet)data) << ((3 - (kbd->idx4 % 4)) * 8); |
221 | kbd->data[idx] = packet; | 232 | kbd->data[idx] = packet; |
222 | 233 | ||
223 | /* Records of N 4-byte hil_packets must terminate with a command. */ | 234 | /* Records of N 4-byte hil_packets must terminate with a command. */ |
224 | if ((++(kbd->idx4)) % 4) return IRQ_HANDLED; | 235 | if ((++(kbd->idx4)) % 4) |
236 | return IRQ_HANDLED; | ||
225 | if ((packet & 0xffff0000) != HIL_ERR_INT) { | 237 | if ((packet & 0xffff0000) != HIL_ERR_INT) { |
226 | hil_kbd_process_err(kbd); | 238 | hil_kbd_process_err(kbd); |
227 | return IRQ_HANDLED; | 239 | return IRQ_HANDLED; |
228 | } | 240 | } |
229 | if (packet & HIL_PKT_CMD) hil_kbd_process_record(kbd); | 241 | if (packet & HIL_PKT_CMD) |
242 | hil_kbd_process_record(kbd); | ||
230 | return IRQ_HANDLED; | 243 | return IRQ_HANDLED; |
231 | } | 244 | } |
232 | 245 | ||
@@ -235,10 +248,7 @@ static void hil_kbd_disconnect(struct serio *serio) | |||
235 | struct hil_kbd *kbd; | 248 | struct hil_kbd *kbd; |
236 | 249 | ||
237 | kbd = serio_get_drvdata(serio); | 250 | kbd = serio_get_drvdata(serio); |
238 | if (kbd == NULL) { | 251 | BUG_ON(kbd == NULL); |
239 | BUG(); | ||
240 | return; | ||
241 | } | ||
242 | 252 | ||
243 | serio_close(serio); | 253 | serio_close(serio); |
244 | input_unregister_device(kbd->dev); | 254 | input_unregister_device(kbd->dev); |
@@ -259,42 +269,40 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) | |||
259 | if (!kbd->dev) | 269 | if (!kbd->dev) |
260 | goto bail0; | 270 | goto bail0; |
261 | 271 | ||
262 | kbd->dev->private = kbd; | ||
263 | |||
264 | if (serio_open(serio, drv)) | 272 | if (serio_open(serio, drv)) |
265 | goto bail1; | 273 | goto bail1; |
266 | 274 | ||
267 | serio_set_drvdata(serio, kbd); | 275 | serio_set_drvdata(serio, kbd); |
268 | kbd->serio = serio; | 276 | kbd->serio = serio; |
269 | 277 | ||
270 | init_MUTEX_LOCKED(&(kbd->sem)); | 278 | init_MUTEX_LOCKED(&kbd->sem); |
271 | 279 | ||
272 | /* Get device info. MLC driver supplies devid/status/etc. */ | 280 | /* Get device info. MLC driver supplies devid/status/etc. */ |
273 | serio->write(serio, 0); | 281 | serio->write(serio, 0); |
274 | serio->write(serio, 0); | 282 | serio->write(serio, 0); |
275 | serio->write(serio, HIL_PKT_CMD >> 8); | 283 | serio->write(serio, HIL_PKT_CMD >> 8); |
276 | serio->write(serio, HIL_CMD_IDD); | 284 | serio->write(serio, HIL_CMD_IDD); |
277 | down(&(kbd->sem)); | 285 | down(&kbd->sem); |
278 | 286 | ||
279 | serio->write(serio, 0); | 287 | serio->write(serio, 0); |
280 | serio->write(serio, 0); | 288 | serio->write(serio, 0); |
281 | serio->write(serio, HIL_PKT_CMD >> 8); | 289 | serio->write(serio, HIL_PKT_CMD >> 8); |
282 | serio->write(serio, HIL_CMD_RSC); | 290 | serio->write(serio, HIL_CMD_RSC); |
283 | down(&(kbd->sem)); | 291 | down(&kbd->sem); |
284 | 292 | ||
285 | serio->write(serio, 0); | 293 | serio->write(serio, 0); |
286 | serio->write(serio, 0); | 294 | serio->write(serio, 0); |
287 | serio->write(serio, HIL_PKT_CMD >> 8); | 295 | serio->write(serio, HIL_PKT_CMD >> 8); |
288 | serio->write(serio, HIL_CMD_RNM); | 296 | serio->write(serio, HIL_CMD_RNM); |
289 | down(&(kbd->sem)); | 297 | down(&kbd->sem); |
290 | 298 | ||
291 | serio->write(serio, 0); | 299 | serio->write(serio, 0); |
292 | serio->write(serio, 0); | 300 | serio->write(serio, 0); |
293 | serio->write(serio, HIL_PKT_CMD >> 8); | 301 | serio->write(serio, HIL_PKT_CMD >> 8); |
294 | serio->write(serio, HIL_CMD_EXD); | 302 | serio->write(serio, HIL_CMD_EXD); |
295 | down(&(kbd->sem)); | 303 | down(&kbd->sem); |
296 | 304 | ||
297 | up(&(kbd->sem)); | 305 | up(&kbd->sem); |
298 | 306 | ||
299 | did = kbd->idd[0]; | 307 | did = kbd->idd[0]; |
300 | idd = kbd->idd + 1; | 308 | idd = kbd->idd + 1; |
@@ -310,12 +318,11 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) | |||
310 | goto bail2; | 318 | goto bail2; |
311 | } | 319 | } |
312 | 320 | ||
313 | if(HIL_IDD_NUM_BUTTONS(idd) || HIL_IDD_NUM_AXES_PER_SET(*idd)) { | 321 | if (HIL_IDD_NUM_BUTTONS(idd) || HIL_IDD_NUM_AXES_PER_SET(*idd)) { |
314 | printk(KERN_INFO PREFIX "keyboards only, no combo devices supported.\n"); | 322 | printk(KERN_INFO PREFIX "keyboards only, no combo devices supported.\n"); |
315 | goto bail2; | 323 | goto bail2; |
316 | } | 324 | } |
317 | 325 | ||
318 | |||
319 | kbd->dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); | 326 | kbd->dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); |
320 | kbd->dev->ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL); | 327 | kbd->dev->ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL); |
321 | kbd->dev->keycodemax = HIL_KEYCODES_SET1_TBLSIZE; | 328 | kbd->dev->keycodemax = HIL_KEYCODES_SET1_TBLSIZE; |
@@ -328,7 +335,7 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) | |||
328 | kbd->dev->id.vendor = PCI_VENDOR_ID_HP; | 335 | kbd->dev->id.vendor = PCI_VENDOR_ID_HP; |
329 | kbd->dev->id.product = 0x0001; /* TODO: get from kbd->rsc */ | 336 | kbd->dev->id.product = 0x0001; /* TODO: get from kbd->rsc */ |
330 | kbd->dev->id.version = 0x0100; /* TODO: get from kbd->rsc */ | 337 | kbd->dev->id.version = 0x0100; /* TODO: get from kbd->rsc */ |
331 | kbd->dev->cdev.dev = &serio->dev; | 338 | kbd->dev->dev.parent = &serio->dev; |
332 | 339 | ||
333 | for (i = 0; i < 128; i++) { | 340 | for (i = 0; i < 128; i++) { |
334 | set_bit(hil_kbd_set1[i], kbd->dev->keybit); | 341 | set_bit(hil_kbd_set1[i], kbd->dev->keybit); |
@@ -344,8 +351,8 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) | |||
344 | serio->write(serio, 0); | 351 | serio->write(serio, 0); |
345 | serio->write(serio, HIL_PKT_CMD >> 8); | 352 | serio->write(serio, HIL_PKT_CMD >> 8); |
346 | serio->write(serio, HIL_CMD_EK1); /* Enable Keyswitch Autorepeat 1 */ | 353 | serio->write(serio, HIL_CMD_EK1); /* Enable Keyswitch Autorepeat 1 */ |
347 | down(&(kbd->sem)); | 354 | down(&kbd->sem); |
348 | up(&(kbd->sem)); | 355 | up(&kbd->sem); |
349 | 356 | ||
350 | return 0; | 357 | return 0; |
351 | bail2: | 358 | bail2: |
@@ -368,26 +375,26 @@ static struct serio_device_id hil_kbd_ids[] = { | |||
368 | { 0 } | 375 | { 0 } |
369 | }; | 376 | }; |
370 | 377 | ||
371 | struct serio_driver hil_kbd_serio_drv = { | 378 | static struct serio_driver hil_kbd_serio_drv = { |
372 | .driver = { | 379 | .driver = { |
373 | .name = "hil_kbd", | 380 | .name = "hil_kbd", |
374 | }, | 381 | }, |
375 | .description = "HP HIL keyboard driver", | 382 | .description = "HP HIL keyboard driver", |
376 | .id_table = hil_kbd_ids, | 383 | .id_table = hil_kbd_ids, |
377 | .connect = hil_kbd_connect, | 384 | .connect = hil_kbd_connect, |
378 | .disconnect = hil_kbd_disconnect, | 385 | .disconnect = hil_kbd_disconnect, |
379 | .interrupt = hil_kbd_interrupt | 386 | .interrupt = hil_kbd_interrupt |
380 | }; | 387 | }; |
381 | 388 | ||
382 | static int __init hil_kbd_init(void) | 389 | static int __init hil_kbd_init(void) |
383 | { | 390 | { |
384 | return serio_register_driver(&hil_kbd_serio_drv); | 391 | return serio_register_driver(&hil_kbd_serio_drv); |
385 | } | 392 | } |
386 | 393 | ||
387 | static void __exit hil_kbd_exit(void) | 394 | static void __exit hil_kbd_exit(void) |
388 | { | 395 | { |
389 | serio_unregister_driver(&hil_kbd_serio_drv); | 396 | serio_unregister_driver(&hil_kbd_serio_drv); |
390 | } | 397 | } |
391 | 398 | ||
392 | module_init(hil_kbd_init); | 399 | module_init(hil_kbd_init); |
393 | module_exit(hil_kbd_exit); | 400 | module_exit(hil_kbd_exit); |
diff --git a/drivers/input/keyboard/hilkbd.c b/drivers/input/keyboard/hilkbd.c index 56277fb291cd..499b6974457f 100644 --- a/drivers/input/keyboard/hilkbd.c +++ b/drivers/input/keyboard/hilkbd.c | |||
@@ -3,7 +3,7 @@ | |||
3 | * | 3 | * |
4 | * Copyright (C) 1998 Philip Blundell <philb@gnu.org> | 4 | * Copyright (C) 1998 Philip Blundell <philb@gnu.org> |
5 | * Copyright (C) 1999 Matthew Wilcox <willy@bofh.ai> | 5 | * Copyright (C) 1999 Matthew Wilcox <willy@bofh.ai> |
6 | * Copyright (C) 1999-2006 Helge Deller <deller@gmx.de> | 6 | * Copyright (C) 1999-2007 Helge Deller <deller@gmx.de> |
7 | * | 7 | * |
8 | * Very basic HP Human Interface Loop (HIL) driver. | 8 | * Very basic HP Human Interface Loop (HIL) driver. |
9 | * This driver handles the keyboard on HP300 (m68k) and on some | 9 | * This driver handles the keyboard on HP300 (m68k) and on some |
@@ -89,7 +89,7 @@ MODULE_LICENSE("GPL v2"); | |||
89 | #define HIL_READKBDSADR 0xF9 | 89 | #define HIL_READKBDSADR 0xF9 |
90 | #define HIL_WRITEKBDSADR 0xE9 | 90 | #define HIL_WRITEKBDSADR 0xE9 |
91 | 91 | ||
92 | static unsigned int hphilkeyb_keycode[HIL_KEYCODES_SET1_TBLSIZE] = | 92 | static unsigned int hphilkeyb_keycode[HIL_KEYCODES_SET1_TBLSIZE] __read_mostly = |
93 | { HIL_KEYCODES_SET1 }; | 93 | { HIL_KEYCODES_SET1 }; |
94 | 94 | ||
95 | /* HIL structure */ | 95 | /* HIL structure */ |
@@ -211,10 +211,10 @@ hil_keyb_init(void) | |||
211 | return -ENODEV; /* already initialized */ | 211 | return -ENODEV; /* already initialized */ |
212 | } | 212 | } |
213 | 213 | ||
214 | spin_lock_init(&hil_dev.lock); | ||
214 | hil_dev.dev = input_allocate_device(); | 215 | hil_dev.dev = input_allocate_device(); |
215 | if (!hil_dev.dev) | 216 | if (!hil_dev.dev) |
216 | return -ENOMEM; | 217 | return -ENOMEM; |
217 | hil_dev.dev->private = &hil_dev; | ||
218 | 218 | ||
219 | #if defined(CONFIG_HP300) | 219 | #if defined(CONFIG_HP300) |
220 | if (!hwreg_present((void *)(HILBASE + HIL_DATA))) { | 220 | if (!hwreg_present((void *)(HILBASE + HIL_DATA))) { |
diff --git a/drivers/input/keyboard/lkkbd.c b/drivers/input/keyboard/lkkbd.c index 3d4d0a0ede28..1b08f4e79dd2 100644 --- a/drivers/input/keyboard/lkkbd.c +++ b/drivers/input/keyboard/lkkbd.c | |||
@@ -515,7 +515,7 @@ static int | |||
515 | lkkbd_event (struct input_dev *dev, unsigned int type, unsigned int code, | 515 | lkkbd_event (struct input_dev *dev, unsigned int type, unsigned int code, |
516 | int value) | 516 | int value) |
517 | { | 517 | { |
518 | struct lkkbd *lk = dev->private; | 518 | struct lkkbd *lk = input_get_drvdata (dev); |
519 | unsigned char leds_on = 0; | 519 | unsigned char leds_on = 0; |
520 | unsigned char leds_off = 0; | 520 | unsigned char leds_off = 0; |
521 | 521 | ||
@@ -666,9 +666,10 @@ lkkbd_connect (struct serio *serio, struct serio_driver *drv) | |||
666 | input_dev->id.vendor = SERIO_LKKBD; | 666 | input_dev->id.vendor = SERIO_LKKBD; |
667 | input_dev->id.product = 0; | 667 | input_dev->id.product = 0; |
668 | input_dev->id.version = 0x0100; | 668 | input_dev->id.version = 0x0100; |
669 | input_dev->cdev.dev = &serio->dev; | 669 | input_dev->dev.parent = &serio->dev; |
670 | input_dev->event = lkkbd_event; | 670 | input_dev->event = lkkbd_event; |
671 | input_dev->private = lk; | 671 | |
672 | input_set_drvdata (input_dev, lk); | ||
672 | 673 | ||
673 | set_bit (EV_KEY, input_dev->evbit); | 674 | set_bit (EV_KEY, input_dev->evbit); |
674 | set_bit (EV_LED, input_dev->evbit); | 675 | set_bit (EV_LED, input_dev->evbit); |
diff --git a/drivers/input/keyboard/locomokbd.c b/drivers/input/keyboard/locomokbd.c index 2ade5186cc41..7a41b271f222 100644 --- a/drivers/input/keyboard/locomokbd.c +++ b/drivers/input/keyboard/locomokbd.c | |||
@@ -231,7 +231,7 @@ static int locomokbd_probe(struct locomo_dev *dev) | |||
231 | input_dev->id.vendor = 0x0001; | 231 | input_dev->id.vendor = 0x0001; |
232 | input_dev->id.product = 0x0001; | 232 | input_dev->id.product = 0x0001; |
233 | input_dev->id.version = 0x0100; | 233 | input_dev->id.version = 0x0100; |
234 | input_dev->private = locomokbd; | 234 | input_dev->dev.parent = &dev->dev; |
235 | 235 | ||
236 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); | 236 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); |
237 | input_dev->keycode = locomokbd->keycode; | 237 | input_dev->keycode = locomokbd->keycode; |
diff --git a/drivers/input/keyboard/newtonkbd.c b/drivers/input/keyboard/newtonkbd.c index aa29b50765c9..b97a41e3ee56 100644 --- a/drivers/input/keyboard/newtonkbd.c +++ b/drivers/input/keyboard/newtonkbd.c | |||
@@ -104,8 +104,7 @@ static int nkbd_connect(struct serio *serio, struct serio_driver *drv) | |||
104 | input_dev->id.vendor = SERIO_NEWTON; | 104 | input_dev->id.vendor = SERIO_NEWTON; |
105 | input_dev->id.product = 0x0001; | 105 | input_dev->id.product = 0x0001; |
106 | input_dev->id.version = 0x0100; | 106 | input_dev->id.version = 0x0100; |
107 | input_dev->cdev.dev = &serio->dev; | 107 | input_dev->dev.parent = &serio->dev; |
108 | input_dev->private = nkbd; | ||
109 | 108 | ||
110 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); | 109 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); |
111 | input_dev->keycode = nkbd->keycode; | 110 | input_dev->keycode = nkbd->keycode; |
diff --git a/drivers/input/keyboard/omap-keypad.c b/drivers/input/keyboard/omap-keypad.c index 5680a6d95b2b..3a228634f101 100644 --- a/drivers/input/keyboard/omap-keypad.c +++ b/drivers/input/keyboard/omap-keypad.c | |||
@@ -370,8 +370,7 @@ static int __init omap_kp_probe(struct platform_device *pdev) | |||
370 | set_bit(keymap[i] & KEY_MAX, input_dev->keybit); | 370 | set_bit(keymap[i] & KEY_MAX, input_dev->keybit); |
371 | input_dev->name = "omap-keypad"; | 371 | input_dev->name = "omap-keypad"; |
372 | input_dev->phys = "omap-keypad/input0"; | 372 | input_dev->phys = "omap-keypad/input0"; |
373 | input_dev->cdev.dev = &pdev->dev; | 373 | input_dev->dev.parent = &pdev->dev; |
374 | input_dev->private = omap_kp; | ||
375 | 374 | ||
376 | input_dev->id.bustype = BUS_HOST; | 375 | input_dev->id.bustype = BUS_HOST; |
377 | input_dev->id.vendor = 0x0001; | 376 | input_dev->id.vendor = 0x0001; |
diff --git a/drivers/input/keyboard/pxa27x_keyboard.c b/drivers/input/keyboard/pxa27x_keyboard.c new file mode 100644 index 000000000000..06eaf766d9d2 --- /dev/null +++ b/drivers/input/keyboard/pxa27x_keyboard.c | |||
@@ -0,0 +1,258 @@ | |||
1 | /* | ||
2 | * linux/drivers/input/keyboard/pxa27x_keyboard.c | ||
3 | * | ||
4 | * Driver for the pxa27x matrix keyboard controller. | ||
5 | * | ||
6 | * Created: Feb 22, 2007 | ||
7 | * Author: Rodolfo Giometti <giometti@linux.it> | ||
8 | * | ||
9 | * Based on a previous implementations by Kevin O'Connor | ||
10 | * <kevin_at_koconnor.net> and Alex Osborne <bobofdoom@gmail.com> and | ||
11 | * on some suggestions by Nicolas Pitre <nico@cam.org>. | ||
12 | * | ||
13 | * This program is free software; you can redistribute it and/or modify | ||
14 | * it under the terms of the GNU General Public License version 2 as | ||
15 | * published by the Free Software Foundation. | ||
16 | */ | ||
17 | |||
18 | |||
19 | #include <linux/kernel.h> | ||
20 | #include <linux/module.h> | ||
21 | #include <linux/init.h> | ||
22 | #include <linux/interrupt.h> | ||
23 | #include <linux/input.h> | ||
24 | #include <linux/device.h> | ||
25 | #include <linux/platform_device.h> | ||
26 | |||
27 | #include <asm/mach-types.h> | ||
28 | #include <asm/mach/arch.h> | ||
29 | #include <asm/mach/map.h> | ||
30 | |||
31 | #include <asm/arch/hardware.h> | ||
32 | #include <asm/arch/pxa-regs.h> | ||
33 | #include <asm/arch/irqs.h> | ||
34 | #include <asm/arch/pxa27x_keyboard.h> | ||
35 | |||
36 | #define DRIVER_NAME "pxa27x-keyboard" | ||
37 | |||
38 | #define KPASMKP(col) (col/2 == 0 ? KPASMKP0 : \ | ||
39 | col/2 == 1 ? KPASMKP1 : \ | ||
40 | col/2 == 2 ? KPASMKP2 : KPASMKP3) | ||
41 | #define KPASMKPx_MKC(row, col) (1 << (row + 16 * (col % 2))) | ||
42 | |||
43 | static irqreturn_t pxakbd_irq_handler(int irq, void *dev_id) | ||
44 | { | ||
45 | struct platform_device *pdev = dev_id; | ||
46 | struct pxa27x_keyboard_platform_data *pdata = pdev->dev.platform_data; | ||
47 | struct input_dev *input_dev = platform_get_drvdata(pdev); | ||
48 | unsigned long kpc = KPC; | ||
49 | int p, row, col, rel; | ||
50 | |||
51 | if (kpc & KPC_DI) { | ||
52 | unsigned long kpdk = KPDK; | ||
53 | |||
54 | if (!(kpdk & KPDK_DKP)) { | ||
55 | /* better luck next time */ | ||
56 | } else if (kpc & KPC_REE0) { | ||
57 | unsigned long kprec = KPREC; | ||
58 | KPREC = 0x7f; | ||
59 | |||
60 | if (kprec & KPREC_OF0) | ||
61 | rel = (kprec & 0xff) + 0x7f; | ||
62 | else if (kprec & KPREC_UF0) | ||
63 | rel = (kprec & 0xff) - 0x7f - 0xff; | ||
64 | else | ||
65 | rel = (kprec & 0xff) - 0x7f; | ||
66 | |||
67 | if (rel) { | ||
68 | input_report_rel(input_dev, REL_WHEEL, rel); | ||
69 | input_sync(input_dev); | ||
70 | } | ||
71 | } | ||
72 | } | ||
73 | |||
74 | if (kpc & KPC_MI) { | ||
75 | /* report the status of every button */ | ||
76 | for (row = 0; row < pdata->nr_rows; row++) { | ||
77 | for (col = 0; col < pdata->nr_cols; col++) { | ||
78 | p = KPASMKP(col) & KPASMKPx_MKC(row, col) ? | ||
79 | 1 : 0; | ||
80 | pr_debug("keycode %x - pressed %x\n", | ||
81 | pdata->keycodes[row][col], p); | ||
82 | input_report_key(input_dev, | ||
83 | pdata->keycodes[row][col], p); | ||
84 | } | ||
85 | } | ||
86 | input_sync(input_dev); | ||
87 | } | ||
88 | |||
89 | return IRQ_HANDLED; | ||
90 | } | ||
91 | |||
92 | static int pxakbd_open(struct input_dev *dev) | ||
93 | { | ||
94 | /* Set keypad control register */ | ||
95 | KPC |= (KPC_ASACT | | ||
96 | KPC_MS_ALL | | ||
97 | (2 << 6) | KPC_REE0 | KPC_DK_DEB_SEL | | ||
98 | KPC_ME | KPC_MIE | KPC_DE | KPC_DIE); | ||
99 | |||
100 | KPC &= ~KPC_AS; /* disable automatic scan */ | ||
101 | KPC &= ~KPC_IMKP; /* do not ignore multiple keypresses */ | ||
102 | |||
103 | /* Set rotary count to mid-point value */ | ||
104 | KPREC = 0x7F; | ||
105 | |||
106 | /* Enable unit clock */ | ||
107 | pxa_set_cken(CKEN19_KEYPAD, 1); | ||
108 | |||
109 | return 0; | ||
110 | } | ||
111 | |||
112 | static void pxakbd_close(struct input_dev *dev) | ||
113 | { | ||
114 | /* Disable clock unit */ | ||
115 | pxa_set_cken(CKEN19_KEYPAD, 0); | ||
116 | } | ||
117 | |||
118 | #ifdef CONFIG_PM | ||
119 | static int pxakbd_suspend(struct platform_device *pdev, pm_message_t state) | ||
120 | { | ||
121 | struct pxa27x_keyboard_platform_data *pdata = pdev->dev.platform_data; | ||
122 | |||
123 | /* Save controller status */ | ||
124 | pdata->reg_kpc = KPC; | ||
125 | pdata->reg_kprec = KPREC; | ||
126 | |||
127 | return 0; | ||
128 | } | ||
129 | |||
130 | static int pxakbd_resume(struct platform_device *pdev) | ||
131 | { | ||
132 | struct pxa27x_keyboard_platform_data *pdata = pdev->dev.platform_data; | ||
133 | struct input_dev *input_dev = platform_get_drvdata(pdev); | ||
134 | |||
135 | mutex_lock(&input_dev->mutex); | ||
136 | |||
137 | if (input_dev->users) { | ||
138 | /* Restore controller status */ | ||
139 | KPC = pdata->reg_kpc; | ||
140 | KPREC = pdata->reg_kprec; | ||
141 | |||
142 | /* Enable unit clock */ | ||
143 | pxa_set_cken(CKEN19_KEYPAD, 1); | ||
144 | } | ||
145 | |||
146 | mutex_unlock(&input_dev->mutex); | ||
147 | |||
148 | return 0; | ||
149 | } | ||
150 | #else | ||
151 | #define pxakbd_suspend NULL | ||
152 | #define pxakbd_resume NULL | ||
153 | #endif | ||
154 | |||
155 | static int __devinit pxakbd_probe(struct platform_device *pdev) | ||
156 | { | ||
157 | struct pxa27x_keyboard_platform_data *pdata = pdev->dev.platform_data; | ||
158 | struct input_dev *input_dev; | ||
159 | int i, row, col, error; | ||
160 | |||
161 | /* Create and register the input driver. */ | ||
162 | input_dev = input_allocate_device(); | ||
163 | if (!input_dev) { | ||
164 | printk(KERN_ERR "Cannot request keypad device\n"); | ||
165 | return -ENOMEM; | ||
166 | } | ||
167 | |||
168 | input_dev->name = DRIVER_NAME; | ||
169 | input_dev->id.bustype = BUS_HOST; | ||
170 | input_dev->open = pxakbd_open; | ||
171 | input_dev->close = pxakbd_close; | ||
172 | input_dev->dev.parent = &pdev->dev; | ||
173 | |||
174 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_REL); | ||
175 | input_dev->relbit[LONG(REL_WHEEL)] = BIT(REL_WHEEL); | ||
176 | for (row = 0; row < pdata->nr_rows; row++) { | ||
177 | for (col = 0; col < pdata->nr_cols; col++) { | ||
178 | int code = pdata->keycodes[row][col]; | ||
179 | if (code > 0) | ||
180 | set_bit(code, input_dev->keybit); | ||
181 | } | ||
182 | } | ||
183 | |||
184 | error = request_irq(IRQ_KEYPAD, pxakbd_irq_handler, IRQF_DISABLED, | ||
185 | DRIVER_NAME, pdev); | ||
186 | if (error) { | ||
187 | printk(KERN_ERR "Cannot request keypad IRQ\n"); | ||
188 | pxa_set_cken(CKEN19_KEYPAD, 0); | ||
189 | goto err_free_dev; | ||
190 | } | ||
191 | |||
192 | platform_set_drvdata(pdev, input_dev); | ||
193 | |||
194 | /* Register the input device */ | ||
195 | error = input_register_device(input_dev); | ||
196 | if (error) | ||
197 | goto err_free_irq; | ||
198 | |||
199 | /* Setup GPIOs. */ | ||
200 | for (i = 0; i < pdata->nr_rows + pdata->nr_cols; i++) | ||
201 | pxa_gpio_mode(pdata->gpio_modes[i]); | ||
202 | |||
203 | /* | ||
204 | * Store rows/cols info into keyboard registers. | ||
205 | */ | ||
206 | |||
207 | KPC |= (pdata->nr_rows - 1) << 26; | ||
208 | KPC |= (pdata->nr_cols - 1) << 23; | ||
209 | |||
210 | for (col = 0; col < pdata->nr_cols; col++) | ||
211 | KPC |= KPC_MS0 << col; | ||
212 | |||
213 | return 0; | ||
214 | |||
215 | err_free_irq: | ||
216 | platform_set_drvdata(pdev, NULL); | ||
217 | free_irq(IRQ_KEYPAD, pdev); | ||
218 | err_free_dev: | ||
219 | input_free_device(input_dev); | ||
220 | return error; | ||
221 | } | ||
222 | |||
223 | static int __devexit pxakbd_remove(struct platform_device *pdev) | ||
224 | { | ||
225 | struct input_dev *input_dev = platform_get_drvdata(pdev); | ||
226 | |||
227 | input_unregister_device(input_dev); | ||
228 | free_irq(IRQ_KEYPAD, pdev); | ||
229 | platform_set_drvdata(pdev, NULL); | ||
230 | |||
231 | return 0; | ||
232 | } | ||
233 | |||
234 | static struct platform_driver pxakbd_driver = { | ||
235 | .probe = pxakbd_probe, | ||
236 | .remove = __devexit_p(pxakbd_remove), | ||
237 | .suspend = pxakbd_suspend, | ||
238 | .resume = pxakbd_resume, | ||
239 | .driver = { | ||
240 | .name = DRIVER_NAME, | ||
241 | }, | ||
242 | }; | ||
243 | |||
244 | static int __init pxakbd_init(void) | ||
245 | { | ||
246 | return platform_driver_register(&pxakbd_driver); | ||
247 | } | ||
248 | |||
249 | static void __exit pxakbd_exit(void) | ||
250 | { | ||
251 | platform_driver_unregister(&pxakbd_driver); | ||
252 | } | ||
253 | |||
254 | module_init(pxakbd_init); | ||
255 | module_exit(pxakbd_exit); | ||
256 | |||
257 | MODULE_DESCRIPTION("PXA27x Matrix Keyboard Driver"); | ||
258 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/input/keyboard/spitzkbd.c b/drivers/input/keyboard/spitzkbd.c index 8a2166c77ff4..41b80385476c 100644 --- a/drivers/input/keyboard/spitzkbd.c +++ b/drivers/input/keyboard/spitzkbd.c | |||
@@ -372,10 +372,9 @@ static int __init spitzkbd_probe(struct platform_device *dev) | |||
372 | 372 | ||
373 | spitzkbd->input = input_dev; | 373 | spitzkbd->input = input_dev; |
374 | 374 | ||
375 | input_dev->private = spitzkbd; | ||
376 | input_dev->name = "Spitz Keyboard"; | 375 | input_dev->name = "Spitz Keyboard"; |
377 | input_dev->phys = spitzkbd->phys; | 376 | input_dev->phys = spitzkbd->phys; |
378 | input_dev->cdev.dev = &dev->dev; | 377 | input_dev->dev.parent = &dev->dev; |
379 | 378 | ||
380 | input_dev->id.bustype = BUS_HOST; | 379 | input_dev->id.bustype = BUS_HOST; |
381 | input_dev->id.vendor = 0x0001; | 380 | input_dev->id.vendor = 0x0001; |
diff --git a/drivers/input/keyboard/stowaway.c b/drivers/input/keyboard/stowaway.c index f7b5c5b81451..b44b0684d543 100644 --- a/drivers/input/keyboard/stowaway.c +++ b/drivers/input/keyboard/stowaway.c | |||
@@ -108,8 +108,7 @@ static int skbd_connect(struct serio *serio, struct serio_driver *drv) | |||
108 | input_dev->id.vendor = SERIO_STOWAWAY; | 108 | input_dev->id.vendor = SERIO_STOWAWAY; |
109 | input_dev->id.product = 0x0001; | 109 | input_dev->id.product = 0x0001; |
110 | input_dev->id.version = 0x0100; | 110 | input_dev->id.version = 0x0100; |
111 | input_dev->cdev.dev = &serio->dev; | 111 | input_dev->dev.parent = &serio->dev; |
112 | input_dev->private = skbd; | ||
113 | 112 | ||
114 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); | 113 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); |
115 | input_dev->keycode = skbd->keycode; | 114 | input_dev->keycode = skbd->keycode; |
diff --git a/drivers/input/keyboard/sunkbd.c b/drivers/input/keyboard/sunkbd.c index cc0238366414..1d4e39624cfe 100644 --- a/drivers/input/keyboard/sunkbd.c +++ b/drivers/input/keyboard/sunkbd.c | |||
@@ -146,7 +146,7 @@ out: | |||
146 | 146 | ||
147 | static int sunkbd_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) | 147 | static int sunkbd_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) |
148 | { | 148 | { |
149 | struct sunkbd *sunkbd = dev->private; | 149 | struct sunkbd *sunkbd = input_get_drvdata(dev); |
150 | 150 | ||
151 | switch (type) { | 151 | switch (type) { |
152 | 152 | ||
@@ -271,8 +271,10 @@ static int sunkbd_connect(struct serio *serio, struct serio_driver *drv) | |||
271 | input_dev->id.vendor = SERIO_SUNKBD; | 271 | input_dev->id.vendor = SERIO_SUNKBD; |
272 | input_dev->id.product = sunkbd->type; | 272 | input_dev->id.product = sunkbd->type; |
273 | input_dev->id.version = 0x0100; | 273 | input_dev->id.version = 0x0100; |
274 | input_dev->cdev.dev = &serio->dev; | 274 | input_dev->dev.parent = &serio->dev; |
275 | input_dev->private = sunkbd; | 275 | |
276 | input_set_drvdata(input_dev, sunkbd); | ||
277 | |||
276 | input_dev->event = sunkbd_event; | 278 | input_dev->event = sunkbd_event; |
277 | 279 | ||
278 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_LED) | BIT(EV_SND) | BIT(EV_REP); | 280 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_LED) | BIT(EV_SND) | BIT(EV_REP); |
diff --git a/drivers/input/keyboard/xtkbd.c b/drivers/input/keyboard/xtkbd.c index a82093432138..f3a56eb58ed1 100644 --- a/drivers/input/keyboard/xtkbd.c +++ b/drivers/input/keyboard/xtkbd.c | |||
@@ -108,8 +108,7 @@ static int xtkbd_connect(struct serio *serio, struct serio_driver *drv) | |||
108 | input_dev->id.vendor = 0x0001; | 108 | input_dev->id.vendor = 0x0001; |
109 | input_dev->id.product = 0x0001; | 109 | input_dev->id.product = 0x0001; |
110 | input_dev->id.version = 0x0100; | 110 | input_dev->id.version = 0x0100; |
111 | input_dev->cdev.dev = &serio->dev; | 111 | input_dev->dev.parent = &serio->dev; |
112 | input_dev->private = xtkbd; | ||
113 | 112 | ||
114 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); | 113 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); |
115 | input_dev->keycode = xtkbd->keycode; | 114 | input_dev->keycode = xtkbd->keycode; |
diff --git a/drivers/input/misc/Kconfig b/drivers/input/misc/Kconfig index 41b42587f5e9..1d0d3e765db6 100644 --- a/drivers/input/misc/Kconfig +++ b/drivers/input/misc/Kconfig | |||
@@ -40,6 +40,16 @@ config INPUT_M68K_BEEP | |||
40 | tristate "M68k Beeper support" | 40 | tristate "M68k Beeper support" |
41 | depends on M68K | 41 | depends on M68K |
42 | 42 | ||
43 | config INPUT_COBALT_BTNS | ||
44 | tristate "Cobalt button interface" | ||
45 | depends on MIPS_COBALT | ||
46 | select INPUT_POLLDEV | ||
47 | help | ||
48 | Say Y here if you want to support MIPS Cobalt button interface. | ||
49 | |||
50 | To compile this driver as a module, choose M here: the | ||
51 | module will be called cobalt_btns. | ||
52 | |||
43 | config INPUT_WISTRON_BTNS | 53 | config INPUT_WISTRON_BTNS |
44 | tristate "x86 Wistron laptop button interface" | 54 | tristate "x86 Wistron laptop button interface" |
45 | depends on X86 && !X86_64 | 55 | depends on X86 && !X86_64 |
@@ -81,8 +91,19 @@ config INPUT_UINPUT | |||
81 | To compile this driver as a module, choose M here: the | 91 | To compile this driver as a module, choose M here: the |
82 | module will be called uinput. | 92 | module will be called uinput. |
83 | 93 | ||
94 | config INPUT_POLLDEV | ||
95 | tristate "Polled input device skeleton" | ||
96 | help | ||
97 | Say Y here if you are using a driver for an input | ||
98 | device that periodically polls hardware state. This | ||
99 | option is only useful for out-of-tree drivers since | ||
100 | in-tree drivers select it automatically. | ||
101 | |||
102 | To compile this driver as a module, choose M here: the | ||
103 | module will be called input-polldev. | ||
104 | |||
84 | config HP_SDC_RTC | 105 | config HP_SDC_RTC |
85 | tristate "HP SDC Real Time Clock" | 106 | tristate "HP SDC Real Time Clock" |
86 | depends on GSC || HP300 | 107 | depends on GSC || HP300 |
87 | select HP_SDC | 108 | select HP_SDC |
88 | help | 109 | help |
diff --git a/drivers/input/misc/Makefile b/drivers/input/misc/Makefile index e0a8d58c9e9b..21e3cca0d33e 100644 --- a/drivers/input/misc/Makefile +++ b/drivers/input/misc/Makefile | |||
@@ -4,10 +4,12 @@ | |||
4 | 4 | ||
5 | # Each configuration option enables a list of files. | 5 | # Each configuration option enables a list of files. |
6 | 6 | ||
7 | obj-$(CONFIG_INPUT_POLLDEV) += input-polldev.o | ||
7 | obj-$(CONFIG_INPUT_SPARCSPKR) += sparcspkr.o | 8 | obj-$(CONFIG_INPUT_SPARCSPKR) += sparcspkr.o |
8 | obj-$(CONFIG_INPUT_PCSPKR) += pcspkr.o | 9 | obj-$(CONFIG_INPUT_PCSPKR) += pcspkr.o |
9 | obj-$(CONFIG_INPUT_M68K_BEEP) += m68kspkr.o | 10 | obj-$(CONFIG_INPUT_M68K_BEEP) += m68kspkr.o |
10 | obj-$(CONFIG_INPUT_UINPUT) += uinput.o | 11 | obj-$(CONFIG_INPUT_UINPUT) += uinput.o |
12 | obj-$(CONFIG_INPUT_COBALT_BTNS) += cobalt_btns.o | ||
11 | obj-$(CONFIG_INPUT_WISTRON_BTNS) += wistron_btns.o | 13 | obj-$(CONFIG_INPUT_WISTRON_BTNS) += wistron_btns.o |
12 | obj-$(CONFIG_INPUT_ATLAS_BTNS) += atlas_btns.o | 14 | obj-$(CONFIG_INPUT_ATLAS_BTNS) += atlas_btns.o |
13 | obj-$(CONFIG_HP_SDC_RTC) += hp_sdc_rtc.o | 15 | obj-$(CONFIG_HP_SDC_RTC) += hp_sdc_rtc.o |
diff --git a/drivers/input/misc/cobalt_btns.c b/drivers/input/misc/cobalt_btns.c new file mode 100644 index 000000000000..064b07936019 --- /dev/null +++ b/drivers/input/misc/cobalt_btns.c | |||
@@ -0,0 +1,172 @@ | |||
1 | /* | ||
2 | * Cobalt button interface driver. | ||
3 | * | ||
4 | * Copyright (C) 2007 Yoichi Yuasa <yoichi_yuasa@tripeaks.co.jp> | ||
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 | ||
18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA | ||
19 | */ | ||
20 | #include <linux/init.h> | ||
21 | #include <linux/input-polldev.h> | ||
22 | #include <linux/ioport.h> | ||
23 | #include <linux/module.h> | ||
24 | #include <linux/platform_device.h> | ||
25 | |||
26 | #define BUTTONS_POLL_INTERVAL 30 /* msec */ | ||
27 | #define BUTTONS_COUNT_THRESHOLD 3 | ||
28 | #define BUTTONS_STATUS_MASK 0xfe000000 | ||
29 | |||
30 | struct buttons_dev { | ||
31 | struct input_polled_dev *poll_dev; | ||
32 | void __iomem *reg; | ||
33 | }; | ||
34 | |||
35 | struct buttons_map { | ||
36 | uint32_t mask; | ||
37 | int keycode; | ||
38 | int count; | ||
39 | }; | ||
40 | |||
41 | static struct buttons_map buttons_map[] = { | ||
42 | { 0x02000000, KEY_RESTART, }, | ||
43 | { 0x04000000, KEY_LEFT, }, | ||
44 | { 0x08000000, KEY_UP, }, | ||
45 | { 0x10000000, KEY_DOWN, }, | ||
46 | { 0x20000000, KEY_RIGHT, }, | ||
47 | { 0x40000000, KEY_ENTER, }, | ||
48 | { 0x80000000, KEY_SELECT, }, | ||
49 | }; | ||
50 | |||
51 | static void handle_buttons(struct input_polled_dev *dev) | ||
52 | { | ||
53 | struct buttons_map *button = buttons_map; | ||
54 | struct buttons_dev *bdev = dev->private; | ||
55 | struct input_dev *input = dev->input; | ||
56 | uint32_t status; | ||
57 | int i; | ||
58 | |||
59 | status = readl(bdev->reg); | ||
60 | status = ~status & BUTTONS_STATUS_MASK; | ||
61 | |||
62 | for (i = 0; i < ARRAY_SIZE(buttons_map); i++) { | ||
63 | if (status & button->mask) { | ||
64 | button->count++; | ||
65 | } else { | ||
66 | if (button->count >= BUTTONS_COUNT_THRESHOLD) { | ||
67 | input_report_key(input, button->keycode, 0); | ||
68 | input_sync(input); | ||
69 | } | ||
70 | button->count = 0; | ||
71 | } | ||
72 | |||
73 | if (button->count == BUTTONS_COUNT_THRESHOLD) { | ||
74 | input_report_key(input, button->keycode, 1); | ||
75 | input_sync(input); | ||
76 | } | ||
77 | |||
78 | button++; | ||
79 | } | ||
80 | } | ||
81 | |||
82 | static int __devinit cobalt_buttons_probe(struct platform_device *pdev) | ||
83 | { | ||
84 | struct buttons_dev *bdev; | ||
85 | struct input_polled_dev *poll_dev; | ||
86 | struct input_dev *input; | ||
87 | struct resource *res; | ||
88 | int error, i; | ||
89 | |||
90 | bdev = kzalloc(sizeof(struct buttons_dev), GFP_KERNEL); | ||
91 | poll_dev = input_allocate_polled_device(); | ||
92 | if (!bdev || !poll_dev) { | ||
93 | error = -ENOMEM; | ||
94 | goto err_free_mem; | ||
95 | } | ||
96 | |||
97 | poll_dev->private = bdev; | ||
98 | poll_dev->poll = handle_buttons; | ||
99 | poll_dev->poll_interval = BUTTONS_POLL_INTERVAL; | ||
100 | |||
101 | input = poll_dev->input; | ||
102 | input->name = "Cobalt buttons"; | ||
103 | input->phys = "cobalt/input0"; | ||
104 | input->id.bustype = BUS_HOST; | ||
105 | input->cdev.dev = &pdev->dev; | ||
106 | |||
107 | input->evbit[0] = BIT(EV_KEY); | ||
108 | for (i = 0; i < ARRAY_SIZE(buttons_map); i++) { | ||
109 | set_bit(buttons_map[i].keycode, input->keybit); | ||
110 | buttons_map[i].count = 0; | ||
111 | } | ||
112 | |||
113 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
114 | if (!res) { | ||
115 | error = -EBUSY; | ||
116 | goto err_free_mem; | ||
117 | } | ||
118 | |||
119 | bdev->poll_dev = poll_dev; | ||
120 | bdev->reg = ioremap(res->start, res->end - res->start + 1); | ||
121 | dev_set_drvdata(&pdev->dev, bdev); | ||
122 | |||
123 | error = input_register_polled_device(poll_dev); | ||
124 | if (error) | ||
125 | goto err_iounmap; | ||
126 | |||
127 | return 0; | ||
128 | |||
129 | err_iounmap: | ||
130 | iounmap(bdev->reg); | ||
131 | err_free_mem: | ||
132 | input_free_polled_device(poll_dev); | ||
133 | kfree(bdev); | ||
134 | dev_set_drvdata(&pdev->dev, NULL); | ||
135 | return error; | ||
136 | } | ||
137 | |||
138 | static int __devexit cobalt_buttons_remove(struct platform_device *pdev) | ||
139 | { | ||
140 | struct device *dev = &pdev->dev; | ||
141 | struct buttons_dev *bdev = dev_get_drvdata(dev); | ||
142 | |||
143 | input_unregister_polled_device(bdev->poll_dev); | ||
144 | input_free_polled_device(bdev->poll_dev); | ||
145 | iounmap(bdev->reg); | ||
146 | kfree(bdev); | ||
147 | dev_set_drvdata(dev, NULL); | ||
148 | |||
149 | return 0; | ||
150 | } | ||
151 | |||
152 | static struct platform_driver cobalt_buttons_driver = { | ||
153 | .probe = cobalt_buttons_probe, | ||
154 | .remove = __devexit_p(cobalt_buttons_remove), | ||
155 | .driver = { | ||
156 | .name = "Cobalt buttons", | ||
157 | .owner = THIS_MODULE, | ||
158 | }, | ||
159 | }; | ||
160 | |||
161 | static int __init cobalt_buttons_init(void) | ||
162 | { | ||
163 | return platform_driver_register(&cobalt_buttons_driver); | ||
164 | } | ||
165 | |||
166 | static void __exit cobalt_buttons_exit(void) | ||
167 | { | ||
168 | platform_driver_unregister(&cobalt_buttons_driver); | ||
169 | } | ||
170 | |||
171 | module_init(cobalt_buttons_init); | ||
172 | module_exit(cobalt_buttons_exit); | ||
diff --git a/drivers/input/misc/input-polldev.c b/drivers/input/misc/input-polldev.c new file mode 100644 index 000000000000..1b2b9c9c5d88 --- /dev/null +++ b/drivers/input/misc/input-polldev.c | |||
@@ -0,0 +1,171 @@ | |||
1 | /* | ||
2 | * Generic implementation of a polled input device | ||
3 | |||
4 | * Copyright (c) 2007 Dmitry Torokhov | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or modify it | ||
7 | * under the terms of the GNU General Public License version 2 as published by | ||
8 | * the Free Software Foundation. | ||
9 | */ | ||
10 | |||
11 | #include <linux/jiffies.h> | ||
12 | #include <linux/mutex.h> | ||
13 | #include <linux/input-polldev.h> | ||
14 | |||
15 | static DEFINE_MUTEX(polldev_mutex); | ||
16 | static int polldev_users; | ||
17 | static struct workqueue_struct *polldev_wq; | ||
18 | |||
19 | static int input_polldev_start_workqueue(void) | ||
20 | { | ||
21 | int retval; | ||
22 | |||
23 | retval = mutex_lock_interruptible(&polldev_mutex); | ||
24 | if (retval) | ||
25 | return retval; | ||
26 | |||
27 | if (!polldev_users) { | ||
28 | polldev_wq = create_singlethread_workqueue("ipolldevd"); | ||
29 | if (!polldev_wq) { | ||
30 | printk(KERN_ERR "input-polldev: failed to create " | ||
31 | "ipolldevd workqueue\n"); | ||
32 | retval = -ENOMEM; | ||
33 | goto out; | ||
34 | } | ||
35 | } | ||
36 | |||
37 | polldev_users++; | ||
38 | |||
39 | out: | ||
40 | mutex_unlock(&polldev_mutex); | ||
41 | return retval; | ||
42 | } | ||
43 | |||
44 | static void input_polldev_stop_workqueue(void) | ||
45 | { | ||
46 | mutex_lock(&polldev_mutex); | ||
47 | |||
48 | if (!--polldev_users) | ||
49 | destroy_workqueue(polldev_wq); | ||
50 | |||
51 | mutex_unlock(&polldev_mutex); | ||
52 | } | ||
53 | |||
54 | static void input_polled_device_work(struct work_struct *work) | ||
55 | { | ||
56 | struct input_polled_dev *dev = | ||
57 | container_of(work, struct input_polled_dev, work.work); | ||
58 | |||
59 | dev->poll(dev); | ||
60 | queue_delayed_work(polldev_wq, &dev->work, | ||
61 | msecs_to_jiffies(dev->poll_interval)); | ||
62 | } | ||
63 | |||
64 | static int input_open_polled_device(struct input_dev *input) | ||
65 | { | ||
66 | struct input_polled_dev *dev = input->private; | ||
67 | int error; | ||
68 | |||
69 | error = input_polldev_start_workqueue(); | ||
70 | if (error) | ||
71 | return error; | ||
72 | |||
73 | if (dev->flush) | ||
74 | dev->flush(dev); | ||
75 | |||
76 | queue_delayed_work(polldev_wq, &dev->work, | ||
77 | msecs_to_jiffies(dev->poll_interval)); | ||
78 | |||
79 | return 0; | ||
80 | } | ||
81 | |||
82 | static void input_close_polled_device(struct input_dev *input) | ||
83 | { | ||
84 | struct input_polled_dev *dev = input->private; | ||
85 | |||
86 | cancel_rearming_delayed_workqueue(polldev_wq, &dev->work); | ||
87 | input_polldev_stop_workqueue(); | ||
88 | } | ||
89 | |||
90 | /** | ||
91 | * input_allocate_polled_device - allocated memory polled device | ||
92 | * | ||
93 | * The function allocates memory for a polled device and also | ||
94 | * for an input device associated with this polled device. | ||
95 | */ | ||
96 | struct input_polled_dev *input_allocate_polled_device(void) | ||
97 | { | ||
98 | struct input_polled_dev *dev; | ||
99 | |||
100 | dev = kzalloc(sizeof(struct input_polled_dev), GFP_KERNEL); | ||
101 | if (!dev) | ||
102 | return NULL; | ||
103 | |||
104 | dev->input = input_allocate_device(); | ||
105 | if (!dev->input) { | ||
106 | kfree(dev); | ||
107 | return NULL; | ||
108 | } | ||
109 | |||
110 | return dev; | ||
111 | } | ||
112 | EXPORT_SYMBOL(input_allocate_polled_device); | ||
113 | |||
114 | /** | ||
115 | * input_free_polled_device - free memory allocated for polled device | ||
116 | * @dev: device to free | ||
117 | * | ||
118 | * The function frees memory allocated for polling device and drops | ||
119 | * reference to the associated input device (if present). | ||
120 | */ | ||
121 | void input_free_polled_device(struct input_polled_dev *dev) | ||
122 | { | ||
123 | if (dev) { | ||
124 | input_free_device(dev->input); | ||
125 | kfree(dev); | ||
126 | } | ||
127 | } | ||
128 | EXPORT_SYMBOL(input_free_polled_device); | ||
129 | |||
130 | /** | ||
131 | * input_register_polled_device - register polled device | ||
132 | * @dev: device to register | ||
133 | * | ||
134 | * The function registers previously initialized polled input device | ||
135 | * with input layer. The device should be allocated with call to | ||
136 | * input_allocate_polled_device(). Callers should also set up poll() | ||
137 | * method and set up capabilities (id, name, phys, bits) of the | ||
138 | * corresponing input_dev structure. | ||
139 | */ | ||
140 | int input_register_polled_device(struct input_polled_dev *dev) | ||
141 | { | ||
142 | struct input_dev *input = dev->input; | ||
143 | |||
144 | INIT_DELAYED_WORK(&dev->work, input_polled_device_work); | ||
145 | if (!dev->poll_interval) | ||
146 | dev->poll_interval = 500; | ||
147 | input->private = dev; | ||
148 | input->open = input_open_polled_device; | ||
149 | input->close = input_close_polled_device; | ||
150 | |||
151 | return input_register_device(input); | ||
152 | } | ||
153 | EXPORT_SYMBOL(input_register_polled_device); | ||
154 | |||
155 | /** | ||
156 | * input_unregister_polled_device - unregister polled device | ||
157 | * @dev: device to unregister | ||
158 | * | ||
159 | * The function unregisters previously registered polled input | ||
160 | * device from input layer. Polling is stopped and device is | ||
161 | * ready to be freed with call to input_free_polled_device(). | ||
162 | * Callers should not attempt to access dev->input pointer | ||
163 | * after calling this function. | ||
164 | */ | ||
165 | void input_unregister_polled_device(struct input_polled_dev *dev) | ||
166 | { | ||
167 | input_unregister_device(dev->input); | ||
168 | dev->input = NULL; | ||
169 | } | ||
170 | EXPORT_SYMBOL(input_unregister_polled_device); | ||
171 | |||
diff --git a/drivers/input/misc/ixp4xx-beeper.c b/drivers/input/misc/ixp4xx-beeper.c index 105c6fc27823..3d4b619dadab 100644 --- a/drivers/input/misc/ixp4xx-beeper.c +++ b/drivers/input/misc/ixp4xx-beeper.c | |||
@@ -51,7 +51,7 @@ static void ixp4xx_spkr_control(unsigned int pin, unsigned int count) | |||
51 | 51 | ||
52 | static int ixp4xx_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) | 52 | static int ixp4xx_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) |
53 | { | 53 | { |
54 | unsigned int pin = (unsigned int) dev->private; | 54 | unsigned int pin = (unsigned int) input_get_drvdata(input_dev); |
55 | unsigned int count = 0; | 55 | unsigned int count = 0; |
56 | 56 | ||
57 | if (type != EV_SND) | 57 | if (type != EV_SND) |
@@ -99,14 +99,15 @@ static int __devinit ixp4xx_spkr_probe(struct platform_device *dev) | |||
99 | if (!input_dev) | 99 | if (!input_dev) |
100 | return -ENOMEM; | 100 | return -ENOMEM; |
101 | 101 | ||
102 | input_dev->private = (void *) dev->id; | 102 | input_set_drvdata(input_dev, (void *) dev->id); |
103 | |||
103 | input_dev->name = "ixp4xx beeper", | 104 | input_dev->name = "ixp4xx beeper", |
104 | input_dev->phys = "ixp4xx/gpio"; | 105 | input_dev->phys = "ixp4xx/gpio"; |
105 | input_dev->id.bustype = BUS_HOST; | 106 | input_dev->id.bustype = BUS_HOST; |
106 | input_dev->id.vendor = 0x001f; | 107 | input_dev->id.vendor = 0x001f; |
107 | input_dev->id.product = 0x0001; | 108 | input_dev->id.product = 0x0001; |
108 | input_dev->id.version = 0x0100; | 109 | input_dev->id.version = 0x0100; |
109 | input_dev->cdev.dev = &dev->dev; | 110 | input_dev->dev.parent = &dev->dev; |
110 | 111 | ||
111 | input_dev->evbit[0] = BIT(EV_SND); | 112 | input_dev->evbit[0] = BIT(EV_SND); |
112 | input_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE); | 113 | input_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE); |
@@ -136,7 +137,7 @@ static int __devinit ixp4xx_spkr_probe(struct platform_device *dev) | |||
136 | static int __devexit ixp4xx_spkr_remove(struct platform_device *dev) | 137 | static int __devexit ixp4xx_spkr_remove(struct platform_device *dev) |
137 | { | 138 | { |
138 | struct input_dev *input_dev = platform_get_drvdata(dev); | 139 | struct input_dev *input_dev = platform_get_drvdata(dev); |
139 | unsigned int pin = (unsigned int) input_dev->private; | 140 | unsigned int pin = (unsigned int) input_get_drvdata(input_dev); |
140 | 141 | ||
141 | input_unregister_device(input_dev); | 142 | input_unregister_device(input_dev); |
142 | platform_set_drvdata(dev, NULL); | 143 | platform_set_drvdata(dev, NULL); |
@@ -153,7 +154,7 @@ static int __devexit ixp4xx_spkr_remove(struct platform_device *dev) | |||
153 | static void ixp4xx_spkr_shutdown(struct platform_device *dev) | 154 | static void ixp4xx_spkr_shutdown(struct platform_device *dev) |
154 | { | 155 | { |
155 | struct input_dev *input_dev = platform_get_drvdata(dev); | 156 | struct input_dev *input_dev = platform_get_drvdata(dev); |
156 | unsigned int pin = (unsigned int) input_dev->private; | 157 | unsigned int pin = (unsigned int) input_get_drvdata(input_dev); |
157 | 158 | ||
158 | /* turn off the speaker */ | 159 | /* turn off the speaker */ |
159 | disable_irq(IRQ_IXP4XX_TIMER2); | 160 | disable_irq(IRQ_IXP4XX_TIMER2); |
diff --git a/drivers/input/misc/m68kspkr.c b/drivers/input/misc/m68kspkr.c index 8d6c3837badb..e9f26e766b4d 100644 --- a/drivers/input/misc/m68kspkr.c +++ b/drivers/input/misc/m68kspkr.c | |||
@@ -63,7 +63,7 @@ static int __devinit m68kspkr_probe(struct platform_device *dev) | |||
63 | input_dev->id.vendor = 0x001f; | 63 | input_dev->id.vendor = 0x001f; |
64 | input_dev->id.product = 0x0001; | 64 | input_dev->id.product = 0x0001; |
65 | input_dev->id.version = 0x0100; | 65 | input_dev->id.version = 0x0100; |
66 | input_dev->cdev.dev = &dev->dev; | 66 | input_dev->dev.parent = &dev->dev; |
67 | 67 | ||
68 | input_dev->evbit[0] = BIT(EV_SND); | 68 | input_dev->evbit[0] = BIT(EV_SND); |
69 | input_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE); | 69 | input_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE); |
diff --git a/drivers/input/misc/pcspkr.c b/drivers/input/misc/pcspkr.c index afd322185bbf..31989dcd922c 100644 --- a/drivers/input/misc/pcspkr.c +++ b/drivers/input/misc/pcspkr.c | |||
@@ -78,7 +78,7 @@ static int __devinit pcspkr_probe(struct platform_device *dev) | |||
78 | pcspkr_dev->id.vendor = 0x001f; | 78 | pcspkr_dev->id.vendor = 0x001f; |
79 | pcspkr_dev->id.product = 0x0001; | 79 | pcspkr_dev->id.product = 0x0001; |
80 | pcspkr_dev->id.version = 0x0100; | 80 | pcspkr_dev->id.version = 0x0100; |
81 | pcspkr_dev->cdev.dev = &dev->dev; | 81 | pcspkr_dev->dev.parent = &dev->dev; |
82 | 82 | ||
83 | pcspkr_dev->evbit[0] = BIT(EV_SND); | 83 | pcspkr_dev->evbit[0] = BIT(EV_SND); |
84 | pcspkr_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE); | 84 | pcspkr_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE); |
diff --git a/drivers/input/misc/sparcspkr.c b/drivers/input/misc/sparcspkr.c index 106c94f33b93..e36ec1d92be8 100644 --- a/drivers/input/misc/sparcspkr.c +++ b/drivers/input/misc/sparcspkr.c | |||
@@ -28,7 +28,7 @@ struct sparcspkr_state { | |||
28 | 28 | ||
29 | static int ebus_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) | 29 | static int ebus_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) |
30 | { | 30 | { |
31 | struct sparcspkr_state *state = dev_get_drvdata(dev->cdev.dev); | 31 | struct sparcspkr_state *state = dev_get_drvdata(dev->dev.parent); |
32 | unsigned int count = 0; | 32 | unsigned int count = 0; |
33 | unsigned long flags; | 33 | unsigned long flags; |
34 | 34 | ||
@@ -61,7 +61,7 @@ static int ebus_spkr_event(struct input_dev *dev, unsigned int type, unsigned in | |||
61 | 61 | ||
62 | static int isa_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) | 62 | static int isa_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) |
63 | { | 63 | { |
64 | struct sparcspkr_state *state = dev_get_drvdata(dev->cdev.dev); | 64 | struct sparcspkr_state *state = dev_get_drvdata(dev->dev.parent); |
65 | unsigned int count = 0; | 65 | unsigned int count = 0; |
66 | unsigned long flags; | 66 | unsigned long flags; |
67 | 67 | ||
@@ -113,7 +113,7 @@ static int __devinit sparcspkr_probe(struct device *dev) | |||
113 | input_dev->id.vendor = 0x001f; | 113 | input_dev->id.vendor = 0x001f; |
114 | input_dev->id.product = 0x0001; | 114 | input_dev->id.product = 0x0001; |
115 | input_dev->id.version = 0x0100; | 115 | input_dev->id.version = 0x0100; |
116 | input_dev->cdev.dev = dev; | 116 | input_dev->dev.parent = dev; |
117 | 117 | ||
118 | input_dev->evbit[0] = BIT(EV_SND); | 118 | input_dev->evbit[0] = BIT(EV_SND); |
119 | input_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE); | 119 | input_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE); |
diff --git a/drivers/input/misc/uinput.c b/drivers/input/misc/uinput.c index 42556232c523..031467eadd31 100644 --- a/drivers/input/misc/uinput.c +++ b/drivers/input/misc/uinput.c | |||
@@ -41,9 +41,7 @@ | |||
41 | 41 | ||
42 | static int uinput_dev_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) | 42 | static int uinput_dev_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) |
43 | { | 43 | { |
44 | struct uinput_device *udev; | 44 | struct uinput_device *udev = input_get_drvdata(dev); |
45 | |||
46 | udev = dev->private; | ||
47 | 45 | ||
48 | udev->buff[udev->head].type = type; | 46 | udev->buff[udev->head].type = type; |
49 | udev->buff[udev->head].code = code; | 47 | udev->buff[udev->head].code = code; |
@@ -136,7 +134,7 @@ static int uinput_dev_upload_effect(struct input_dev *dev, struct ff_effect *eff | |||
136 | request.u.upload.effect = effect; | 134 | request.u.upload.effect = effect; |
137 | request.u.upload.old = old; | 135 | request.u.upload.old = old; |
138 | 136 | ||
139 | retval = uinput_request_reserve_slot(dev->private, &request); | 137 | retval = uinput_request_reserve_slot(input_get_drvdata(dev), &request); |
140 | if (!retval) | 138 | if (!retval) |
141 | retval = uinput_request_submit(dev, &request); | 139 | retval = uinput_request_submit(dev, &request); |
142 | 140 | ||
@@ -156,7 +154,7 @@ static int uinput_dev_erase_effect(struct input_dev *dev, int effect_id) | |||
156 | request.code = UI_FF_ERASE; | 154 | request.code = UI_FF_ERASE; |
157 | request.u.effect_id = effect_id; | 155 | request.u.effect_id = effect_id; |
158 | 156 | ||
159 | retval = uinput_request_reserve_slot(dev->private, &request); | 157 | retval = uinput_request_reserve_slot(input_get_drvdata(dev), &request); |
160 | if (!retval) | 158 | if (!retval) |
161 | retval = uinput_request_submit(dev, &request); | 159 | retval = uinput_request_submit(dev, &request); |
162 | 160 | ||
@@ -274,7 +272,7 @@ static int uinput_allocate_device(struct uinput_device *udev) | |||
274 | return -ENOMEM; | 272 | return -ENOMEM; |
275 | 273 | ||
276 | udev->dev->event = uinput_dev_event; | 274 | udev->dev->event = uinput_dev_event; |
277 | udev->dev->private = udev; | 275 | input_set_drvdata(udev->dev, udev); |
278 | 276 | ||
279 | return 0; | 277 | return 0; |
280 | } | 278 | } |
diff --git a/drivers/input/misc/wistron_btns.c b/drivers/input/misc/wistron_btns.c index e1183aeb8ed5..961aad7a0476 100644 --- a/drivers/input/misc/wistron_btns.c +++ b/drivers/input/misc/wistron_btns.c | |||
@@ -50,7 +50,7 @@ | |||
50 | MODULE_AUTHOR("Miloslav Trmac <mitr@volny.cz>"); | 50 | MODULE_AUTHOR("Miloslav Trmac <mitr@volny.cz>"); |
51 | MODULE_DESCRIPTION("Wistron laptop button driver"); | 51 | MODULE_DESCRIPTION("Wistron laptop button driver"); |
52 | MODULE_LICENSE("GPL v2"); | 52 | MODULE_LICENSE("GPL v2"); |
53 | MODULE_VERSION("0.1"); | 53 | MODULE_VERSION("0.2"); |
54 | 54 | ||
55 | static int force; /* = 0; */ | 55 | static int force; /* = 0; */ |
56 | module_param(force, bool, 0); | 56 | module_param(force, bool, 0); |
@@ -58,7 +58,7 @@ MODULE_PARM_DESC(force, "Load even if computer is not in database"); | |||
58 | 58 | ||
59 | static char *keymap_name; /* = NULL; */ | 59 | static char *keymap_name; /* = NULL; */ |
60 | module_param_named(keymap, keymap_name, charp, 0); | 60 | module_param_named(keymap, keymap_name, charp, 0); |
61 | MODULE_PARM_DESC(keymap, "Keymap name, if it can't be autodetected"); | 61 | MODULE_PARM_DESC(keymap, "Keymap name, if it can't be autodetected [generic, 1557/MS2141]"); |
62 | 62 | ||
63 | static struct platform_device *wistron_device; | 63 | static struct platform_device *wistron_device; |
64 | 64 | ||
@@ -233,10 +233,20 @@ static void bios_set_state(u8 subsys, int enable) | |||
233 | struct key_entry { | 233 | struct key_entry { |
234 | char type; /* See KE_* below */ | 234 | char type; /* See KE_* below */ |
235 | u8 code; | 235 | u8 code; |
236 | unsigned keycode; /* For KE_KEY */ | 236 | union { |
237 | u16 keycode; /* For KE_KEY */ | ||
238 | struct { /* For KE_SW */ | ||
239 | u8 code; | ||
240 | u8 value; | ||
241 | } sw; | ||
242 | }; | ||
237 | }; | 243 | }; |
238 | 244 | ||
239 | enum { KE_END, KE_KEY, KE_WIFI, KE_BLUETOOTH }; | 245 | enum { KE_END, KE_KEY, KE_SW, KE_WIFI, KE_BLUETOOTH }; |
246 | |||
247 | #define FE_MAIL_LED 0x01 | ||
248 | #define FE_WIFI_LED 0x02 | ||
249 | #define FE_UNTESTED 0x80 | ||
240 | 250 | ||
241 | static const struct key_entry *keymap; /* = NULL; Current key map */ | 251 | static const struct key_entry *keymap; /* = NULL; Current key map */ |
242 | static int have_wifi; | 252 | static int have_wifi; |
@@ -256,93 +266,341 @@ static int __init dmi_matched(struct dmi_system_id *dmi) | |||
256 | return 1; | 266 | return 1; |
257 | } | 267 | } |
258 | 268 | ||
259 | static struct key_entry keymap_empty[] = { | 269 | static struct key_entry keymap_empty[] __initdata = { |
260 | { KE_END, 0 } | 270 | { KE_END, 0 } |
261 | }; | 271 | }; |
262 | 272 | ||
263 | static struct key_entry keymap_fs_amilo_pro_v2000[] = { | 273 | static struct key_entry keymap_fs_amilo_pro_v2000[] __initdata = { |
264 | { KE_KEY, 0x01, KEY_HELP }, | 274 | { KE_KEY, 0x01, {KEY_HELP} }, |
265 | { KE_KEY, 0x11, KEY_PROG1 }, | 275 | { KE_KEY, 0x11, {KEY_PROG1} }, |
266 | { KE_KEY, 0x12, KEY_PROG2 }, | 276 | { KE_KEY, 0x12, {KEY_PROG2} }, |
267 | { KE_WIFI, 0x30, 0 }, | 277 | { KE_WIFI, 0x30 }, |
268 | { KE_KEY, 0x31, KEY_MAIL }, | 278 | { KE_KEY, 0x31, {KEY_MAIL} }, |
269 | { KE_KEY, 0x36, KEY_WWW }, | 279 | { KE_KEY, 0x36, {KEY_WWW} }, |
270 | { KE_END, 0 } | 280 | { KE_END, 0 } |
271 | }; | 281 | }; |
272 | 282 | ||
273 | static struct key_entry keymap_fujitsu_n3510[] = { | 283 | static struct key_entry keymap_fujitsu_n3510[] __initdata = { |
274 | { KE_KEY, 0x11, KEY_PROG1 }, | 284 | { KE_KEY, 0x11, {KEY_PROG1} }, |
275 | { KE_KEY, 0x12, KEY_PROG2 }, | 285 | { KE_KEY, 0x12, {KEY_PROG2} }, |
276 | { KE_KEY, 0x36, KEY_WWW }, | 286 | { KE_KEY, 0x36, {KEY_WWW} }, |
277 | { KE_KEY, 0x31, KEY_MAIL }, | 287 | { KE_KEY, 0x31, {KEY_MAIL} }, |
278 | { KE_KEY, 0x71, KEY_STOPCD }, | 288 | { KE_KEY, 0x71, {KEY_STOPCD} }, |
279 | { KE_KEY, 0x72, KEY_PLAYPAUSE }, | 289 | { KE_KEY, 0x72, {KEY_PLAYPAUSE} }, |
280 | { KE_KEY, 0x74, KEY_REWIND }, | 290 | { KE_KEY, 0x74, {KEY_REWIND} }, |
281 | { KE_KEY, 0x78, KEY_FORWARD }, | 291 | { KE_KEY, 0x78, {KEY_FORWARD} }, |
282 | { KE_END, 0 } | 292 | { KE_END, 0 } |
283 | }; | 293 | }; |
284 | 294 | ||
285 | static struct key_entry keymap_wistron_ms2111[] = { | 295 | static struct key_entry keymap_wistron_ms2111[] __initdata = { |
286 | { KE_KEY, 0x11, KEY_PROG1 }, | 296 | { KE_KEY, 0x11, {KEY_PROG1} }, |
287 | { KE_KEY, 0x12, KEY_PROG2 }, | 297 | { KE_KEY, 0x12, {KEY_PROG2} }, |
288 | { KE_KEY, 0x13, KEY_PROG3 }, | 298 | { KE_KEY, 0x13, {KEY_PROG3} }, |
289 | { KE_KEY, 0x31, KEY_MAIL }, | 299 | { KE_KEY, 0x31, {KEY_MAIL} }, |
290 | { KE_KEY, 0x36, KEY_WWW }, | 300 | { KE_KEY, 0x36, {KEY_WWW} }, |
291 | { KE_END, 0 } | 301 | { KE_END, FE_MAIL_LED } |
302 | }; | ||
303 | |||
304 | static struct key_entry keymap_wistron_md40100[] __initdata = { | ||
305 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
306 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
307 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
308 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
309 | { KE_KEY, 0x37, {KEY_DISPLAYTOGGLE} }, /* Display on/off */ | ||
310 | { KE_END, FE_MAIL_LED | FE_WIFI_LED | FE_UNTESTED } | ||
292 | }; | 311 | }; |
293 | 312 | ||
294 | static struct key_entry keymap_wistron_ms2141[] = { | 313 | static struct key_entry keymap_wistron_ms2141[] __initdata = { |
295 | { KE_KEY, 0x11, KEY_PROG1 }, | 314 | { KE_KEY, 0x11, {KEY_PROG1} }, |
296 | { KE_KEY, 0x12, KEY_PROG2 }, | 315 | { KE_KEY, 0x12, {KEY_PROG2} }, |
297 | { KE_WIFI, 0x30, 0 }, | 316 | { KE_WIFI, 0x30 }, |
298 | { KE_KEY, 0x22, KEY_REWIND }, | 317 | { KE_KEY, 0x22, {KEY_REWIND} }, |
299 | { KE_KEY, 0x23, KEY_FORWARD }, | 318 | { KE_KEY, 0x23, {KEY_FORWARD} }, |
300 | { KE_KEY, 0x24, KEY_PLAYPAUSE }, | 319 | { KE_KEY, 0x24, {KEY_PLAYPAUSE} }, |
301 | { KE_KEY, 0x25, KEY_STOPCD }, | 320 | { KE_KEY, 0x25, {KEY_STOPCD} }, |
302 | { KE_KEY, 0x31, KEY_MAIL }, | 321 | { KE_KEY, 0x31, {KEY_MAIL} }, |
303 | { KE_KEY, 0x36, KEY_WWW }, | 322 | { KE_KEY, 0x36, {KEY_WWW} }, |
304 | { KE_END, 0 } | 323 | { KE_END, 0 } |
305 | }; | 324 | }; |
306 | 325 | ||
307 | static struct key_entry keymap_acer_aspire_1500[] = { | 326 | static struct key_entry keymap_acer_aspire_1500[] __initdata = { |
308 | { KE_KEY, 0x11, KEY_PROG1 }, | 327 | { KE_KEY, 0x01, {KEY_HELP} }, |
309 | { KE_KEY, 0x12, KEY_PROG2 }, | 328 | { KE_KEY, 0x03, {KEY_POWER} }, |
310 | { KE_WIFI, 0x30, 0 }, | 329 | { KE_KEY, 0x11, {KEY_PROG1} }, |
311 | { KE_KEY, 0x31, KEY_MAIL }, | 330 | { KE_KEY, 0x12, {KEY_PROG2} }, |
312 | { KE_KEY, 0x36, KEY_WWW }, | 331 | { KE_WIFI, 0x30 }, |
313 | { KE_BLUETOOTH, 0x44, 0 }, | 332 | { KE_KEY, 0x31, {KEY_MAIL} }, |
314 | { KE_END, 0 } | 333 | { KE_KEY, 0x36, {KEY_WWW} }, |
334 | { KE_KEY, 0x49, {KEY_CONFIG} }, | ||
335 | { KE_BLUETOOTH, 0x44 }, | ||
336 | { KE_END, FE_UNTESTED } | ||
315 | }; | 337 | }; |
316 | 338 | ||
317 | static struct key_entry keymap_acer_travelmate_240[] = { | 339 | static struct key_entry keymap_acer_aspire_1600[] __initdata = { |
318 | { KE_KEY, 0x31, KEY_MAIL }, | 340 | { KE_KEY, 0x01, {KEY_HELP} }, |
319 | { KE_KEY, 0x36, KEY_WWW }, | 341 | { KE_KEY, 0x03, {KEY_POWER} }, |
320 | { KE_KEY, 0x11, KEY_PROG1 }, | 342 | { KE_KEY, 0x08, {KEY_MUTE} }, |
321 | { KE_KEY, 0x12, KEY_PROG2 }, | 343 | { KE_KEY, 0x11, {KEY_PROG1} }, |
322 | { KE_BLUETOOTH, 0x44, 0 }, | 344 | { KE_KEY, 0x12, {KEY_PROG2} }, |
323 | { KE_WIFI, 0x30, 0 }, | 345 | { KE_KEY, 0x13, {KEY_PROG3} }, |
324 | { KE_END, 0 } | 346 | { KE_KEY, 0x31, {KEY_MAIL} }, |
347 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
348 | { KE_KEY, 0x49, {KEY_CONFIG} }, | ||
349 | { KE_WIFI, 0x30 }, | ||
350 | { KE_BLUETOOTH, 0x44 }, | ||
351 | { KE_END, FE_MAIL_LED | FE_UNTESTED } | ||
352 | }; | ||
353 | |||
354 | /* 3020 has been tested */ | ||
355 | static struct key_entry keymap_acer_aspire_5020[] __initdata = { | ||
356 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
357 | { KE_KEY, 0x03, {KEY_POWER} }, | ||
358 | { KE_KEY, 0x05, {KEY_SWITCHVIDEOMODE} }, /* Display selection */ | ||
359 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
360 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
361 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
362 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
363 | { KE_KEY, 0x6a, {KEY_CONFIG} }, | ||
364 | { KE_WIFI, 0x30 }, | ||
365 | { KE_BLUETOOTH, 0x44 }, | ||
366 | { KE_END, FE_MAIL_LED | FE_UNTESTED } | ||
367 | }; | ||
368 | |||
369 | static struct key_entry keymap_acer_travelmate_2410[] __initdata = { | ||
370 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
371 | { KE_KEY, 0x6d, {KEY_POWER} }, | ||
372 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
373 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
374 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
375 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
376 | { KE_KEY, 0x6a, {KEY_CONFIG} }, | ||
377 | { KE_WIFI, 0x30 }, | ||
378 | { KE_BLUETOOTH, 0x44 }, | ||
379 | { KE_END, FE_MAIL_LED | FE_UNTESTED } | ||
380 | }; | ||
381 | |||
382 | static struct key_entry keymap_acer_travelmate_110[] __initdata = { | ||
383 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
384 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
385 | { KE_KEY, 0x03, {KEY_POWER} }, | ||
386 | { KE_KEY, 0x08, {KEY_MUTE} }, | ||
387 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
388 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
389 | { KE_KEY, 0x20, {KEY_VOLUMEUP} }, | ||
390 | { KE_KEY, 0x21, {KEY_VOLUMEDOWN} }, | ||
391 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
392 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
393 | { KE_SW, 0x4a, {.sw = {SW_LID, 1}} }, /* lid close */ | ||
394 | { KE_SW, 0x4b, {.sw = {SW_LID, 0}} }, /* lid open */ | ||
395 | { KE_WIFI, 0x30 }, | ||
396 | { KE_END, FE_MAIL_LED | FE_UNTESTED } | ||
397 | }; | ||
398 | |||
399 | static struct key_entry keymap_acer_travelmate_300[] __initdata = { | ||
400 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
401 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
402 | { KE_KEY, 0x03, {KEY_POWER} }, | ||
403 | { KE_KEY, 0x08, {KEY_MUTE} }, | ||
404 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
405 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
406 | { KE_KEY, 0x20, {KEY_VOLUMEUP} }, | ||
407 | { KE_KEY, 0x21, {KEY_VOLUMEDOWN} }, | ||
408 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
409 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
410 | { KE_WIFI, 0x30 }, | ||
411 | { KE_BLUETOOTH, 0x44 }, | ||
412 | { KE_END, FE_MAIL_LED | FE_UNTESTED } | ||
325 | }; | 413 | }; |
326 | 414 | ||
327 | static struct key_entry keymap_aopen_1559as[] = { | 415 | static struct key_entry keymap_acer_travelmate_380[] __initdata = { |
328 | { KE_KEY, 0x01, KEY_HELP }, | 416 | { KE_KEY, 0x01, {KEY_HELP} }, |
329 | { KE_KEY, 0x06, KEY_PROG3 }, | 417 | { KE_KEY, 0x02, {KEY_CONFIG} }, |
330 | { KE_KEY, 0x11, KEY_PROG1 }, | 418 | { KE_KEY, 0x03, {KEY_POWER} }, /* not 370 */ |
331 | { KE_KEY, 0x12, KEY_PROG2 }, | 419 | { KE_KEY, 0x11, {KEY_PROG1} }, |
332 | { KE_WIFI, 0x30, 0 }, | 420 | { KE_KEY, 0x12, {KEY_PROG2} }, |
333 | { KE_KEY, 0x31, KEY_MAIL }, | 421 | { KE_KEY, 0x13, {KEY_PROG3} }, |
334 | { KE_KEY, 0x36, KEY_WWW }, | 422 | { KE_KEY, 0x31, {KEY_MAIL} }, |
423 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
424 | { KE_WIFI, 0x30 }, | ||
425 | { KE_END, FE_MAIL_LED | FE_UNTESTED } | ||
426 | }; | ||
427 | |||
428 | /* unusual map */ | ||
429 | static struct key_entry keymap_acer_travelmate_220[] __initdata = { | ||
430 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
431 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
432 | { KE_KEY, 0x11, {KEY_MAIL} }, | ||
433 | { KE_KEY, 0x12, {KEY_WWW} }, | ||
434 | { KE_KEY, 0x13, {KEY_PROG2} }, | ||
435 | { KE_KEY, 0x31, {KEY_PROG1} }, | ||
436 | { KE_END, FE_WIFI_LED | FE_UNTESTED } | ||
437 | }; | ||
438 | |||
439 | static struct key_entry keymap_acer_travelmate_230[] __initdata = { | ||
440 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
441 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
442 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
443 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
444 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
445 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
446 | { KE_END, FE_WIFI_LED | FE_UNTESTED } | ||
447 | }; | ||
448 | |||
449 | static struct key_entry keymap_acer_travelmate_240[] __initdata = { | ||
450 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
451 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
452 | { KE_KEY, 0x03, {KEY_POWER} }, | ||
453 | { KE_KEY, 0x08, {KEY_MUTE} }, | ||
454 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
455 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
456 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
457 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
458 | { KE_BLUETOOTH, 0x44 }, | ||
459 | { KE_WIFI, 0x30 }, | ||
460 | { KE_END, FE_UNTESTED } | ||
461 | }; | ||
462 | |||
463 | static struct key_entry keymap_acer_travelmate_350[] __initdata = { | ||
464 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
465 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
466 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
467 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
468 | { KE_KEY, 0x13, {KEY_MAIL} }, | ||
469 | { KE_KEY, 0x14, {KEY_PROG3} }, | ||
470 | { KE_KEY, 0x15, {KEY_WWW} }, | ||
471 | { KE_END, FE_MAIL_LED | FE_WIFI_LED | FE_UNTESTED } | ||
472 | }; | ||
473 | |||
474 | static struct key_entry keymap_acer_travelmate_360[] __initdata = { | ||
475 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
476 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
477 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
478 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
479 | { KE_KEY, 0x13, {KEY_MAIL} }, | ||
480 | { KE_KEY, 0x14, {KEY_PROG3} }, | ||
481 | { KE_KEY, 0x15, {KEY_WWW} }, | ||
482 | { KE_KEY, 0x40, {KEY_WLAN} }, | ||
483 | { KE_END, FE_WIFI_LED | FE_UNTESTED } /* no mail led */ | ||
484 | }; | ||
485 | |||
486 | /* Wifi subsystem only activates the led. Therefore we need to pass | ||
487 | * wifi event as a normal key, then userspace can really change the wifi state. | ||
488 | * TODO we need to export led state to userspace (wifi and mail) */ | ||
489 | static struct key_entry keymap_acer_travelmate_610[] __initdata = { | ||
490 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
491 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
492 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
493 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
494 | { KE_KEY, 0x13, {KEY_PROG3} }, | ||
495 | { KE_KEY, 0x14, {KEY_MAIL} }, | ||
496 | { KE_KEY, 0x15, {KEY_WWW} }, | ||
497 | { KE_KEY, 0x40, {KEY_WLAN} }, | ||
498 | { KE_END, FE_MAIL_LED | FE_WIFI_LED } | ||
499 | }; | ||
500 | |||
501 | static struct key_entry keymap_acer_travelmate_630[] __initdata = { | ||
502 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
503 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
504 | { KE_KEY, 0x03, {KEY_POWER} }, | ||
505 | { KE_KEY, 0x08, {KEY_MUTE} }, /* not 620 */ | ||
506 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
507 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
508 | { KE_KEY, 0x13, {KEY_PROG3} }, | ||
509 | { KE_KEY, 0x20, {KEY_VOLUMEUP} }, | ||
510 | { KE_KEY, 0x21, {KEY_VOLUMEDOWN} }, | ||
511 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
512 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
513 | { KE_WIFI, 0x30 }, | ||
514 | { KE_END, FE_MAIL_LED | FE_UNTESTED } | ||
515 | }; | ||
516 | |||
517 | static struct key_entry keymap_aopen_1559as[] __initdata = { | ||
518 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
519 | { KE_KEY, 0x06, {KEY_PROG3} }, | ||
520 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
521 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
522 | { KE_WIFI, 0x30 }, | ||
523 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
524 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
335 | { KE_END, 0 }, | 525 | { KE_END, 0 }, |
336 | }; | 526 | }; |
337 | 527 | ||
338 | static struct key_entry keymap_fs_amilo_d88x0[] = { | 528 | static struct key_entry keymap_fs_amilo_d88x0[] __initdata = { |
339 | { KE_KEY, 0x01, KEY_HELP }, | 529 | { KE_KEY, 0x01, {KEY_HELP} }, |
340 | { KE_KEY, 0x08, KEY_MUTE }, | 530 | { KE_KEY, 0x08, {KEY_MUTE} }, |
341 | { KE_KEY, 0x31, KEY_MAIL }, | 531 | { KE_KEY, 0x31, {KEY_MAIL} }, |
342 | { KE_KEY, 0x36, KEY_WWW }, | 532 | { KE_KEY, 0x36, {KEY_WWW} }, |
343 | { KE_KEY, 0x11, KEY_PROG1 }, | 533 | { KE_KEY, 0x11, {KEY_PROG1} }, |
344 | { KE_KEY, 0x12, KEY_PROG2 }, | 534 | { KE_KEY, 0x12, {KEY_PROG2} }, |
345 | { KE_KEY, 0x13, KEY_PROG3 }, | 535 | { KE_KEY, 0x13, {KEY_PROG3} }, |
536 | { KE_END, FE_MAIL_LED | FE_WIFI_LED | FE_UNTESTED } | ||
537 | }; | ||
538 | |||
539 | static struct key_entry keymap_wistron_md2900[] __initdata = { | ||
540 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
541 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
542 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
543 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
544 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
545 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
546 | { KE_WIFI, 0x30 }, | ||
547 | { KE_END, FE_MAIL_LED | FE_UNTESTED } | ||
548 | }; | ||
549 | |||
550 | static struct key_entry keymap_wistron_md96500[] __initdata = { | ||
551 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
552 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
553 | { KE_KEY, 0x05, {KEY_SWITCHVIDEOMODE} }, /* Display selection */ | ||
554 | { KE_KEY, 0x06, {KEY_DISPLAYTOGGLE} }, /* Display on/off */ | ||
555 | { KE_KEY, 0x08, {KEY_MUTE} }, | ||
556 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
557 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
558 | { KE_KEY, 0x20, {KEY_VOLUMEUP} }, | ||
559 | { KE_KEY, 0x21, {KEY_VOLUMEDOWN} }, | ||
560 | { KE_KEY, 0x22, {KEY_REWIND} }, | ||
561 | { KE_KEY, 0x23, {KEY_FORWARD} }, | ||
562 | { KE_KEY, 0x24, {KEY_PLAYPAUSE} }, | ||
563 | { KE_KEY, 0x25, {KEY_STOPCD} }, | ||
564 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
565 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
566 | { KE_WIFI, 0x30 }, | ||
567 | { KE_BLUETOOTH, 0x44 }, | ||
568 | { KE_END, FE_UNTESTED } | ||
569 | }; | ||
570 | |||
571 | static struct key_entry keymap_wistron_generic[] __initdata = { | ||
572 | { KE_KEY, 0x01, {KEY_HELP} }, | ||
573 | { KE_KEY, 0x02, {KEY_CONFIG} }, | ||
574 | { KE_KEY, 0x03, {KEY_POWER} }, | ||
575 | { KE_KEY, 0x05, {KEY_SWITCHVIDEOMODE} }, /* Display selection */ | ||
576 | { KE_KEY, 0x06, {KEY_DISPLAYTOGGLE} }, /* Display on/off */ | ||
577 | { KE_KEY, 0x08, {KEY_MUTE} }, | ||
578 | { KE_KEY, 0x11, {KEY_PROG1} }, | ||
579 | { KE_KEY, 0x12, {KEY_PROG2} }, | ||
580 | { KE_KEY, 0x13, {KEY_PROG3} }, | ||
581 | { KE_KEY, 0x14, {KEY_MAIL} }, | ||
582 | { KE_KEY, 0x15, {KEY_WWW} }, | ||
583 | { KE_KEY, 0x20, {KEY_VOLUMEUP} }, | ||
584 | { KE_KEY, 0x21, {KEY_VOLUMEDOWN} }, | ||
585 | { KE_KEY, 0x22, {KEY_REWIND} }, | ||
586 | { KE_KEY, 0x23, {KEY_FORWARD} }, | ||
587 | { KE_KEY, 0x24, {KEY_PLAYPAUSE} }, | ||
588 | { KE_KEY, 0x25, {KEY_STOPCD} }, | ||
589 | { KE_KEY, 0x31, {KEY_MAIL} }, | ||
590 | { KE_KEY, 0x36, {KEY_WWW} }, | ||
591 | { KE_KEY, 0x37, {KEY_DISPLAYTOGGLE} }, /* Display on/off */ | ||
592 | { KE_KEY, 0x40, {KEY_WLAN} }, | ||
593 | { KE_KEY, 0x49, {KEY_CONFIG} }, | ||
594 | { KE_SW, 0x4a, {.sw = {SW_LID, 1}} }, /* lid close */ | ||
595 | { KE_SW, 0x4b, {.sw = {SW_LID, 0}} }, /* lid open */ | ||
596 | { KE_KEY, 0x6a, {KEY_CONFIG} }, | ||
597 | { KE_KEY, 0x6d, {KEY_POWER} }, | ||
598 | { KE_KEY, 0x71, {KEY_STOPCD} }, | ||
599 | { KE_KEY, 0x72, {KEY_PLAYPAUSE} }, | ||
600 | { KE_KEY, 0x74, {KEY_REWIND} }, | ||
601 | { KE_KEY, 0x78, {KEY_FORWARD} }, | ||
602 | { KE_WIFI, 0x30 }, | ||
603 | { KE_BLUETOOTH, 0x44 }, | ||
346 | { KE_END, 0 } | 604 | { KE_END, 0 } |
347 | }; | 605 | }; |
348 | 606 | ||
@@ -390,6 +648,133 @@ static struct dmi_system_id dmi_ids[] __initdata = { | |||
390 | }, | 648 | }, |
391 | { | 649 | { |
392 | .callback = dmi_matched, | 650 | .callback = dmi_matched, |
651 | .ident = "Acer Aspire 1600", | ||
652 | .matches = { | ||
653 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
654 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 1600"), | ||
655 | }, | ||
656 | .driver_data = keymap_acer_aspire_1600 | ||
657 | }, | ||
658 | { | ||
659 | .callback = dmi_matched, | ||
660 | .ident = "Acer Aspire 3020", | ||
661 | .matches = { | ||
662 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
663 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 3020"), | ||
664 | }, | ||
665 | .driver_data = keymap_acer_aspire_5020 | ||
666 | }, | ||
667 | { | ||
668 | .callback = dmi_matched, | ||
669 | .ident = "Acer Aspire 5020", | ||
670 | .matches = { | ||
671 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
672 | DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5020"), | ||
673 | }, | ||
674 | .driver_data = keymap_acer_aspire_5020 | ||
675 | }, | ||
676 | { | ||
677 | .callback = dmi_matched, | ||
678 | .ident = "Acer TravelMate 2100", | ||
679 | .matches = { | ||
680 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
681 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 2100"), | ||
682 | }, | ||
683 | .driver_data = keymap_acer_aspire_5020 | ||
684 | }, | ||
685 | { | ||
686 | .callback = dmi_matched, | ||
687 | .ident = "Acer TravelMate 2410", | ||
688 | .matches = { | ||
689 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
690 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 2410"), | ||
691 | }, | ||
692 | .driver_data = keymap_acer_travelmate_2410 | ||
693 | }, | ||
694 | { | ||
695 | .callback = dmi_matched, | ||
696 | .ident = "Acer TravelMate C300", | ||
697 | .matches = { | ||
698 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
699 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate C300"), | ||
700 | }, | ||
701 | .driver_data = keymap_acer_travelmate_300 | ||
702 | }, | ||
703 | { | ||
704 | .callback = dmi_matched, | ||
705 | .ident = "Acer TravelMate C100", | ||
706 | .matches = { | ||
707 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
708 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate C100"), | ||
709 | }, | ||
710 | .driver_data = keymap_acer_travelmate_300 | ||
711 | }, | ||
712 | { | ||
713 | .callback = dmi_matched, | ||
714 | .ident = "Acer TravelMate C110", | ||
715 | .matches = { | ||
716 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
717 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate C110"), | ||
718 | }, | ||
719 | .driver_data = keymap_acer_travelmate_110 | ||
720 | }, | ||
721 | { | ||
722 | .callback = dmi_matched, | ||
723 | .ident = "Acer TravelMate 380", | ||
724 | .matches = { | ||
725 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
726 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 380"), | ||
727 | }, | ||
728 | .driver_data = keymap_acer_travelmate_380 | ||
729 | }, | ||
730 | { | ||
731 | .callback = dmi_matched, | ||
732 | .ident = "Acer TravelMate 370", | ||
733 | .matches = { | ||
734 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
735 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 370"), | ||
736 | }, | ||
737 | .driver_data = keymap_acer_travelmate_380 /* keyboard minus 1 key */ | ||
738 | }, | ||
739 | { | ||
740 | .callback = dmi_matched, | ||
741 | .ident = "Acer TravelMate 220", | ||
742 | .matches = { | ||
743 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
744 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 220"), | ||
745 | }, | ||
746 | .driver_data = keymap_acer_travelmate_220 | ||
747 | }, | ||
748 | { | ||
749 | .callback = dmi_matched, | ||
750 | .ident = "Acer TravelMate 260", | ||
751 | .matches = { | ||
752 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
753 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 260"), | ||
754 | }, | ||
755 | .driver_data = keymap_acer_travelmate_220 | ||
756 | }, | ||
757 | { | ||
758 | .callback = dmi_matched, | ||
759 | .ident = "Acer TravelMate 230", | ||
760 | .matches = { | ||
761 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
762 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 230"), | ||
763 | /* acerhk looks for "TravelMate F4..." ?! */ | ||
764 | }, | ||
765 | .driver_data = keymap_acer_travelmate_230 | ||
766 | }, | ||
767 | { | ||
768 | .callback = dmi_matched, | ||
769 | .ident = "Acer TravelMate 280", | ||
770 | .matches = { | ||
771 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
772 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 280"), | ||
773 | }, | ||
774 | .driver_data = keymap_acer_travelmate_230 | ||
775 | }, | ||
776 | { | ||
777 | .callback = dmi_matched, | ||
393 | .ident = "Acer TravelMate 240", | 778 | .ident = "Acer TravelMate 240", |
394 | .matches = { | 779 | .matches = { |
395 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | 780 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), |
@@ -399,6 +784,15 @@ static struct dmi_system_id dmi_ids[] __initdata = { | |||
399 | }, | 784 | }, |
400 | { | 785 | { |
401 | .callback = dmi_matched, | 786 | .callback = dmi_matched, |
787 | .ident = "Acer TravelMate 250", | ||
788 | .matches = { | ||
789 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
790 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 250"), | ||
791 | }, | ||
792 | .driver_data = keymap_acer_travelmate_240 | ||
793 | }, | ||
794 | { | ||
795 | .callback = dmi_matched, | ||
402 | .ident = "Acer TravelMate 2424NWXCi", | 796 | .ident = "Acer TravelMate 2424NWXCi", |
403 | .matches = { | 797 | .matches = { |
404 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | 798 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), |
@@ -408,6 +802,51 @@ static struct dmi_system_id dmi_ids[] __initdata = { | |||
408 | }, | 802 | }, |
409 | { | 803 | { |
410 | .callback = dmi_matched, | 804 | .callback = dmi_matched, |
805 | .ident = "Acer TravelMate 350", | ||
806 | .matches = { | ||
807 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
808 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 350"), | ||
809 | }, | ||
810 | .driver_data = keymap_acer_travelmate_350 | ||
811 | }, | ||
812 | { | ||
813 | .callback = dmi_matched, | ||
814 | .ident = "Acer TravelMate 360", | ||
815 | .matches = { | ||
816 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
817 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 360"), | ||
818 | }, | ||
819 | .driver_data = keymap_acer_travelmate_360 | ||
820 | }, | ||
821 | { | ||
822 | .callback = dmi_matched, | ||
823 | .ident = "Acer TravelMate 610", | ||
824 | .matches = { | ||
825 | DMI_MATCH(DMI_SYS_VENDOR, "ACER"), | ||
826 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 610"), | ||
827 | }, | ||
828 | .driver_data = keymap_acer_travelmate_610 | ||
829 | }, | ||
830 | { | ||
831 | .callback = dmi_matched, | ||
832 | .ident = "Acer TravelMate 620", | ||
833 | .matches = { | ||
834 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
835 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 620"), | ||
836 | }, | ||
837 | .driver_data = keymap_acer_travelmate_630 | ||
838 | }, | ||
839 | { | ||
840 | .callback = dmi_matched, | ||
841 | .ident = "Acer TravelMate 630", | ||
842 | .matches = { | ||
843 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | ||
844 | DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 630"), | ||
845 | }, | ||
846 | .driver_data = keymap_acer_travelmate_630 | ||
847 | }, | ||
848 | { | ||
849 | .callback = dmi_matched, | ||
411 | .ident = "AOpen 1559AS", | 850 | .ident = "AOpen 1559AS", |
412 | .matches = { | 851 | .matches = { |
413 | DMI_MATCH(DMI_PRODUCT_NAME, "E2U"), | 852 | DMI_MATCH(DMI_PRODUCT_NAME, "E2U"), |
@@ -426,6 +865,51 @@ static struct dmi_system_id dmi_ids[] __initdata = { | |||
426 | }, | 865 | }, |
427 | { | 866 | { |
428 | .callback = dmi_matched, | 867 | .callback = dmi_matched, |
868 | .ident = "Medion MD 40100", | ||
869 | .matches = { | ||
870 | DMI_MATCH(DMI_SYS_VENDOR, "MEDIONNB"), | ||
871 | DMI_MATCH(DMI_PRODUCT_NAME, "WID2000"), | ||
872 | }, | ||
873 | .driver_data = keymap_wistron_md40100 | ||
874 | }, | ||
875 | { | ||
876 | .callback = dmi_matched, | ||
877 | .ident = "Medion MD 2900", | ||
878 | .matches = { | ||
879 | DMI_MATCH(DMI_SYS_VENDOR, "MEDIONNB"), | ||
880 | DMI_MATCH(DMI_PRODUCT_NAME, "WIM 2000"), | ||
881 | }, | ||
882 | .driver_data = keymap_wistron_md2900 | ||
883 | }, | ||
884 | { | ||
885 | .callback = dmi_matched, | ||
886 | .ident = "Medion MD 96500", | ||
887 | .matches = { | ||
888 | DMI_MATCH(DMI_SYS_VENDOR, "MEDIONPC"), | ||
889 | DMI_MATCH(DMI_PRODUCT_NAME, "WIM 2040"), | ||
890 | }, | ||
891 | .driver_data = keymap_wistron_md96500 | ||
892 | }, | ||
893 | { | ||
894 | .callback = dmi_matched, | ||
895 | .ident = "Medion MD 95400", | ||
896 | .matches = { | ||
897 | DMI_MATCH(DMI_SYS_VENDOR, "MEDIONPC"), | ||
898 | DMI_MATCH(DMI_PRODUCT_NAME, "WIM 2050"), | ||
899 | }, | ||
900 | .driver_data = keymap_wistron_md96500 | ||
901 | }, | ||
902 | { | ||
903 | .callback = dmi_matched, | ||
904 | .ident = "Fujitsu Siemens Amilo D7820", | ||
905 | .matches = { | ||
906 | DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"), /* not sure */ | ||
907 | DMI_MATCH(DMI_PRODUCT_NAME, "Amilo D"), | ||
908 | }, | ||
909 | .driver_data = keymap_fs_amilo_d88x0 | ||
910 | }, | ||
911 | { | ||
912 | .callback = dmi_matched, | ||
429 | .ident = "Fujitsu Siemens Amilo D88x0", | 913 | .ident = "Fujitsu Siemens Amilo D88x0", |
430 | .matches = { | 914 | .matches = { |
431 | DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"), | 915 | DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"), |
@@ -436,17 +920,39 @@ static struct dmi_system_id dmi_ids[] __initdata = { | |||
436 | { NULL, } | 920 | { NULL, } |
437 | }; | 921 | }; |
438 | 922 | ||
923 | /* Copy the good keymap, as the original ones are free'd */ | ||
924 | static int __init copy_keymap(void) | ||
925 | { | ||
926 | const struct key_entry *key; | ||
927 | struct key_entry *new_keymap; | ||
928 | unsigned int length = 1; | ||
929 | |||
930 | for (key = keymap; key->type != KE_END; key++) | ||
931 | length++; | ||
932 | |||
933 | new_keymap = kmalloc(length * sizeof(struct key_entry), GFP_KERNEL); | ||
934 | if (!new_keymap) | ||
935 | return -ENOMEM; | ||
936 | |||
937 | memcpy(new_keymap, keymap, length * sizeof(struct key_entry)); | ||
938 | keymap = new_keymap; | ||
939 | |||
940 | return 0; | ||
941 | } | ||
942 | |||
439 | static int __init select_keymap(void) | 943 | static int __init select_keymap(void) |
440 | { | 944 | { |
945 | dmi_check_system(dmi_ids); | ||
441 | if (keymap_name != NULL) { | 946 | if (keymap_name != NULL) { |
442 | if (strcmp (keymap_name, "1557/MS2141") == 0) | 947 | if (strcmp (keymap_name, "1557/MS2141") == 0) |
443 | keymap = keymap_wistron_ms2141; | 948 | keymap = keymap_wistron_ms2141; |
949 | else if (strcmp (keymap_name, "generic") == 0) | ||
950 | keymap = keymap_wistron_generic; | ||
444 | else { | 951 | else { |
445 | printk(KERN_ERR "wistron_btns: Keymap unknown\n"); | 952 | printk(KERN_ERR "wistron_btns: Keymap unknown\n"); |
446 | return -EINVAL; | 953 | return -EINVAL; |
447 | } | 954 | } |
448 | } | 955 | } |
449 | dmi_check_system(dmi_ids); | ||
450 | if (keymap == NULL) { | 956 | if (keymap == NULL) { |
451 | if (!force) { | 957 | if (!force) { |
452 | printk(KERN_ERR "wistron_btns: System unknown\n"); | 958 | printk(KERN_ERR "wistron_btns: System unknown\n"); |
@@ -454,7 +960,8 @@ static int __init select_keymap(void) | |||
454 | } | 960 | } |
455 | keymap = keymap_empty; | 961 | keymap = keymap_empty; |
456 | } | 962 | } |
457 | return 0; | 963 | |
964 | return copy_keymap(); | ||
458 | } | 965 | } |
459 | 966 | ||
460 | /* Input layer interface */ | 967 | /* Input layer interface */ |
@@ -476,12 +983,28 @@ static int __devinit setup_input_dev(void) | |||
476 | input_dev->cdev.dev = &wistron_device->dev; | 983 | input_dev->cdev.dev = &wistron_device->dev; |
477 | 984 | ||
478 | for (key = keymap; key->type != KE_END; key++) { | 985 | for (key = keymap; key->type != KE_END; key++) { |
479 | if (key->type == KE_KEY) { | 986 | switch (key->type) { |
480 | input_dev->evbit[LONG(EV_KEY)] = BIT(EV_KEY); | 987 | case KE_KEY: |
481 | set_bit(key->keycode, input_dev->keybit); | 988 | set_bit(EV_KEY, input_dev->evbit); |
989 | set_bit(key->keycode, input_dev->keybit); | ||
990 | break; | ||
991 | |||
992 | case KE_SW: | ||
993 | set_bit(EV_SW, input_dev->evbit); | ||
994 | set_bit(key->sw.code, input_dev->swbit); | ||
995 | break; | ||
996 | |||
997 | default: | ||
998 | ; | ||
482 | } | 999 | } |
483 | } | 1000 | } |
484 | 1001 | ||
1002 | /* reads information flags on KE_END */ | ||
1003 | if (key->code & FE_UNTESTED) | ||
1004 | printk(KERN_WARNING "Untested laptop multimedia keys, " | ||
1005 | "please report success or failure to eric.piel" | ||
1006 | "@tremplin-utc.net\n"); | ||
1007 | |||
485 | error = input_register_device(input_dev); | 1008 | error = input_register_device(input_dev); |
486 | if (error) { | 1009 | if (error) { |
487 | input_free_device(input_dev); | 1010 | input_free_device(input_dev); |
@@ -499,6 +1022,12 @@ static void report_key(unsigned keycode) | |||
499 | input_sync(input_dev); | 1022 | input_sync(input_dev); |
500 | } | 1023 | } |
501 | 1024 | ||
1025 | static void report_switch(unsigned code, int value) | ||
1026 | { | ||
1027 | input_report_switch(input_dev, code, value); | ||
1028 | input_sync(input_dev); | ||
1029 | } | ||
1030 | |||
502 | /* Driver core */ | 1031 | /* Driver core */ |
503 | 1032 | ||
504 | static int wifi_enabled; | 1033 | static int wifi_enabled; |
@@ -519,6 +1048,10 @@ static void handle_key(u8 code) | |||
519 | report_key(key->keycode); | 1048 | report_key(key->keycode); |
520 | break; | 1049 | break; |
521 | 1050 | ||
1051 | case KE_SW: | ||
1052 | report_switch(key->sw.code, key->sw.value); | ||
1053 | break; | ||
1054 | |||
522 | case KE_WIFI: | 1055 | case KE_WIFI: |
523 | if (have_wifi) { | 1056 | if (have_wifi) { |
524 | wifi_enabled = !wifi_enabled; | 1057 | wifi_enabled = !wifi_enabled; |
@@ -534,6 +1067,7 @@ static void handle_key(u8 code) | |||
534 | break; | 1067 | break; |
535 | 1068 | ||
536 | case KE_END: | 1069 | case KE_END: |
1070 | break; | ||
537 | default: | 1071 | default: |
538 | BUG(); | 1072 | BUG(); |
539 | } | 1073 | } |
@@ -690,6 +1224,7 @@ static void __exit wb_module_exit(void) | |||
690 | platform_device_unregister(wistron_device); | 1224 | platform_device_unregister(wistron_device); |
691 | platform_driver_unregister(&wistron_driver); | 1225 | platform_driver_unregister(&wistron_driver); |
692 | unmap_bios(); | 1226 | unmap_bios(); |
1227 | kfree(keymap); | ||
693 | } | 1228 | } |
694 | 1229 | ||
695 | module_init(wb_module_init); | 1230 | module_init(wb_module_init); |
diff --git a/drivers/input/mouse/Kconfig b/drivers/input/mouse/Kconfig index b40784a60aa1..81dd8c7211a7 100644 --- a/drivers/input/mouse/Kconfig +++ b/drivers/input/mouse/Kconfig | |||
@@ -37,6 +37,65 @@ config MOUSE_PS2 | |||
37 | To compile this driver as a module, choose M here: the | 37 | To compile this driver as a module, choose M here: the |
38 | module will be called psmouse. | 38 | module will be called psmouse. |
39 | 39 | ||
40 | config MOUSE_PS2_ALPS | ||
41 | bool "ALPS PS/2 mouse protocol extension" if EMBEDDED | ||
42 | default y | ||
43 | depends on MOUSE_PS2 | ||
44 | ---help--- | ||
45 | Say Y here if you have an ALPS PS/2 touchpad connected to | ||
46 | your system. | ||
47 | |||
48 | If unsure, say Y. | ||
49 | |||
50 | config MOUSE_PS2_LOGIPS2PP | ||
51 | bool "Logictech PS/2++ mouse protocol extension" if EMBEDDED | ||
52 | default y | ||
53 | depends on MOUSE_PS2 | ||
54 | ---help--- | ||
55 | Say Y here if you have a Logictech PS/2++ mouse connected to | ||
56 | your system. | ||
57 | |||
58 | If unsure, say Y. | ||
59 | |||
60 | config MOUSE_PS2_SYNAPTICS | ||
61 | bool "Synaptics PS/2 mouse protocol extension" if EMBEDDED | ||
62 | default y | ||
63 | depends on MOUSE_PS2 | ||
64 | ---help--- | ||
65 | Say Y here if you have a Synaptics PS/2 TouchPad connected to | ||
66 | your system. | ||
67 | |||
68 | If unsure, say Y. | ||
69 | |||
70 | config MOUSE_PS2_LIFEBOOK | ||
71 | bool "Fujitsu Lifebook PS/2 mouse protocol extension" if EMBEDDED | ||
72 | default y | ||
73 | depends on MOUSE_PS2 | ||
74 | ---help--- | ||
75 | Say Y here if you have a Fujitsu B-series Lifebook PS/2 | ||
76 | TouchScreen connected to your system. | ||
77 | |||
78 | If unsure, say Y. | ||
79 | |||
80 | config MOUSE_PS2_TRACKPOINT | ||
81 | bool "IBM Trackpoint PS/2 mouse protocol extension" if EMBEDDED | ||
82 | default y | ||
83 | depends on MOUSE_PS2 | ||
84 | ---help--- | ||
85 | Say Y here if you have an IBM Trackpoint PS/2 mouse connected | ||
86 | to your system. | ||
87 | |||
88 | If unsure, say Y. | ||
89 | |||
90 | config MOUSE_PS2_TOUCHKIT | ||
91 | bool "eGalax TouchKit PS/2 protocol extension" | ||
92 | depends on MOUSE_PS2 | ||
93 | ---help--- | ||
94 | Say Y here if you have an eGalax TouchKit PS/2 touchscreen | ||
95 | connected to your system. | ||
96 | |||
97 | If unsure, say N. | ||
98 | |||
40 | config MOUSE_SERIAL | 99 | config MOUSE_SERIAL |
41 | tristate "Serial mouse" | 100 | tristate "Serial mouse" |
42 | select SERIO | 101 | select SERIO |
@@ -129,7 +188,7 @@ config MOUSE_VSXXXAA | |||
129 | digitizer (VSXXX-AB) DEC produced. | 188 | digitizer (VSXXX-AB) DEC produced. |
130 | 189 | ||
131 | config MOUSE_HIL | 190 | config MOUSE_HIL |
132 | tristate "HIL pointers (mice etc)." | 191 | tristate "HIL pointers (mice etc)." |
133 | depends on GSC || HP300 | 192 | depends on GSC || HP300 |
134 | select HP_SDC | 193 | select HP_SDC |
135 | select HIL_MLC | 194 | select HIL_MLC |
diff --git a/drivers/input/mouse/Makefile b/drivers/input/mouse/Makefile index 700f61200dfc..6a8f622927f2 100644 --- a/drivers/input/mouse/Makefile +++ b/drivers/input/mouse/Makefile | |||
@@ -15,4 +15,10 @@ obj-$(CONFIG_MOUSE_SERIAL) += sermouse.o | |||
15 | obj-$(CONFIG_MOUSE_HIL) += hil_ptr.o | 15 | obj-$(CONFIG_MOUSE_HIL) += hil_ptr.o |
16 | obj-$(CONFIG_MOUSE_VSXXXAA) += vsxxxaa.o | 16 | obj-$(CONFIG_MOUSE_VSXXXAA) += vsxxxaa.o |
17 | 17 | ||
18 | psmouse-objs := psmouse-base.o alps.o logips2pp.o synaptics.o lifebook.o trackpoint.o | 18 | psmouse-objs := psmouse-base.o synaptics.o |
19 | |||
20 | psmouse-$(CONFIG_MOUSE_PS2_ALPS) += alps.o | ||
21 | psmouse-$(CONFIG_MOUSE_PS2_LOGIPS2PP) += logips2pp.o | ||
22 | psmouse-$(CONFIG_MOUSE_PS2_LIFEBOOK) += lifebook.o | ||
23 | psmouse-$(CONFIG_MOUSE_PS2_TRACKPOINT) += trackpoint.o | ||
24 | psmouse-$(CONFIG_MOUSE_PS2_TOUCHKIT) += touchkit_ps2.o | ||
diff --git a/drivers/input/mouse/alps.c b/drivers/input/mouse/alps.c index 4e71a66fc7fc..cf3e4664e72b 100644 --- a/drivers/input/mouse/alps.c +++ b/drivers/input/mouse/alps.c | |||
@@ -424,14 +424,15 @@ int alps_init(struct psmouse *psmouse) | |||
424 | struct input_dev *dev1 = psmouse->dev, *dev2; | 424 | struct input_dev *dev1 = psmouse->dev, *dev2; |
425 | int version; | 425 | int version; |
426 | 426 | ||
427 | psmouse->private = priv = kzalloc(sizeof(struct alps_data), GFP_KERNEL); | 427 | priv = kzalloc(sizeof(struct alps_data), GFP_KERNEL); |
428 | dev2 = input_allocate_device(); | 428 | dev2 = input_allocate_device(); |
429 | if (!priv || !dev2) | 429 | if (!priv || !dev2) |
430 | goto init_fail; | 430 | goto init_fail; |
431 | 431 | ||
432 | priv->dev2 = dev2; | 432 | priv->dev2 = dev2; |
433 | 433 | ||
434 | if (!(priv->i = alps_get_model(psmouse, &version))) | 434 | priv->i = alps_get_model(psmouse, &version); |
435 | if (!priv->i) | ||
435 | goto init_fail; | 436 | goto init_fail; |
436 | 437 | ||
437 | if ((priv->i->flags & ALPS_PASS) && alps_passthrough_mode(psmouse, 1)) | 438 | if ((priv->i->flags & ALPS_PASS) && alps_passthrough_mode(psmouse, 1)) |
@@ -480,7 +481,8 @@ int alps_init(struct psmouse *psmouse) | |||
480 | dev2->relbit[LONG(REL_X)] |= BIT(REL_X) | BIT(REL_Y); | 481 | dev2->relbit[LONG(REL_X)] |= BIT(REL_X) | BIT(REL_Y); |
481 | dev2->keybit[LONG(BTN_LEFT)] |= BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT); | 482 | dev2->keybit[LONG(BTN_LEFT)] |= BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT); |
482 | 483 | ||
483 | input_register_device(priv->dev2); | 484 | if (input_register_device(priv->dev2)) |
485 | goto init_fail; | ||
484 | 486 | ||
485 | psmouse->protocol_handler = alps_process_byte; | 487 | psmouse->protocol_handler = alps_process_byte; |
486 | psmouse->poll = alps_poll; | 488 | psmouse->poll = alps_poll; |
@@ -491,9 +493,11 @@ int alps_init(struct psmouse *psmouse) | |||
491 | /* We are having trouble resyncing ALPS touchpads so disable it for now */ | 493 | /* We are having trouble resyncing ALPS touchpads so disable it for now */ |
492 | psmouse->resync_time = 0; | 494 | psmouse->resync_time = 0; |
493 | 495 | ||
496 | psmouse->private = priv; | ||
494 | return 0; | 497 | return 0; |
495 | 498 | ||
496 | init_fail: | 499 | init_fail: |
500 | psmouse_reset(psmouse); | ||
497 | input_free_device(dev2); | 501 | input_free_device(dev2); |
498 | kfree(priv); | 502 | kfree(priv); |
499 | return -1; | 503 | return -1; |
@@ -504,7 +508,8 @@ int alps_detect(struct psmouse *psmouse, int set_properties) | |||
504 | int version; | 508 | int version; |
505 | const struct alps_model_info *model; | 509 | const struct alps_model_info *model; |
506 | 510 | ||
507 | if (!(model = alps_get_model(psmouse, &version))) | 511 | model = alps_get_model(psmouse, &version); |
512 | if (!model) | ||
508 | return -1; | 513 | return -1; |
509 | 514 | ||
510 | if (set_properties) { | 515 | if (set_properties) { |
diff --git a/drivers/input/mouse/alps.h b/drivers/input/mouse/alps.h index 69db7325a494..4bbddc99962b 100644 --- a/drivers/input/mouse/alps.h +++ b/drivers/input/mouse/alps.h | |||
@@ -12,9 +12,6 @@ | |||
12 | #ifndef _ALPS_H | 12 | #ifndef _ALPS_H |
13 | #define _ALPS_H | 13 | #define _ALPS_H |
14 | 14 | ||
15 | int alps_detect(struct psmouse *psmouse, int set_properties); | ||
16 | int alps_init(struct psmouse *psmouse); | ||
17 | |||
18 | struct alps_model_info { | 15 | struct alps_model_info { |
19 | unsigned char signature[3]; | 16 | unsigned char signature[3]; |
20 | unsigned char byte0, mask0; | 17 | unsigned char byte0, mask0; |
@@ -23,10 +20,23 @@ struct alps_model_info { | |||
23 | 20 | ||
24 | struct alps_data { | 21 | struct alps_data { |
25 | struct input_dev *dev2; /* Relative device */ | 22 | struct input_dev *dev2; /* Relative device */ |
26 | char name[32]; /* Name */ | ||
27 | char phys[32]; /* Phys */ | 23 | char phys[32]; /* Phys */ |
28 | const struct alps_model_info *i;/* Info */ | 24 | const struct alps_model_info *i;/* Info */ |
29 | int prev_fin; /* Finger bit from previous packet */ | 25 | int prev_fin; /* Finger bit from previous packet */ |
30 | }; | 26 | }; |
31 | 27 | ||
28 | #ifdef CONFIG_MOUSE_PS2_ALPS | ||
29 | int alps_detect(struct psmouse *psmouse, int set_properties); | ||
30 | int alps_init(struct psmouse *psmouse); | ||
31 | #else | ||
32 | inline int alps_detect(struct psmouse *psmouse, int set_properties) | ||
33 | { | ||
34 | return -ENOSYS; | ||
35 | } | ||
36 | inline int alps_init(struct psmouse *psmouse) | ||
37 | { | ||
38 | return -ENOSYS; | ||
39 | } | ||
40 | #endif /* CONFIG_MOUSE_PS2_ALPS */ | ||
41 | |||
32 | #endif | 42 | #endif |
diff --git a/drivers/input/mouse/hil_ptr.c b/drivers/input/mouse/hil_ptr.c index bfb174fe3230..449bf4dcbbcc 100644 --- a/drivers/input/mouse/hil_ptr.c +++ b/drivers/input/mouse/hil_ptr.c | |||
@@ -88,10 +88,12 @@ static void hil_ptr_process_record(struct hil_ptr *ptr) | |||
88 | idx = ptr->idx4/4; | 88 | idx = ptr->idx4/4; |
89 | p = data[idx - 1]; | 89 | p = data[idx - 1]; |
90 | 90 | ||
91 | if ((p & ~HIL_CMDCT_POL) == | 91 | if ((p & ~HIL_CMDCT_POL) == |
92 | (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_POL)) goto report; | 92 | (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_POL)) |
93 | if ((p & ~HIL_CMDCT_RPL) == | 93 | goto report; |
94 | (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_RPL)) goto report; | 94 | if ((p & ~HIL_CMDCT_RPL) == |
95 | (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_RPL)) | ||
96 | goto report; | ||
95 | 97 | ||
96 | /* Not a poll response. See if we are loading config records. */ | 98 | /* Not a poll response. See if we are loading config records. */ |
97 | switch (p & HIL_PKT_DATA_MASK) { | 99 | switch (p & HIL_PKT_DATA_MASK) { |
@@ -101,27 +103,32 @@ static void hil_ptr_process_record(struct hil_ptr *ptr) | |||
101 | for (; i < HIL_PTR_MAX_LENGTH; i++) | 103 | for (; i < HIL_PTR_MAX_LENGTH; i++) |
102 | ptr->idd[i] = 0; | 104 | ptr->idd[i] = 0; |
103 | break; | 105 | break; |
106 | |||
104 | case HIL_CMD_RSC: | 107 | case HIL_CMD_RSC: |
105 | for (i = 0; i < idx; i++) | 108 | for (i = 0; i < idx; i++) |
106 | ptr->rsc[i] = ptr->data[i] & HIL_PKT_DATA_MASK; | 109 | ptr->rsc[i] = ptr->data[i] & HIL_PKT_DATA_MASK; |
107 | for (; i < HIL_PTR_MAX_LENGTH; i++) | 110 | for (; i < HIL_PTR_MAX_LENGTH; i++) |
108 | ptr->rsc[i] = 0; | 111 | ptr->rsc[i] = 0; |
109 | break; | 112 | break; |
113 | |||
110 | case HIL_CMD_EXD: | 114 | case HIL_CMD_EXD: |
111 | for (i = 0; i < idx; i++) | 115 | for (i = 0; i < idx; i++) |
112 | ptr->exd[i] = ptr->data[i] & HIL_PKT_DATA_MASK; | 116 | ptr->exd[i] = ptr->data[i] & HIL_PKT_DATA_MASK; |
113 | for (; i < HIL_PTR_MAX_LENGTH; i++) | 117 | for (; i < HIL_PTR_MAX_LENGTH; i++) |
114 | ptr->exd[i] = 0; | 118 | ptr->exd[i] = 0; |
115 | break; | 119 | break; |
120 | |||
116 | case HIL_CMD_RNM: | 121 | case HIL_CMD_RNM: |
117 | for (i = 0; i < idx; i++) | 122 | for (i = 0; i < idx; i++) |
118 | ptr->rnm[i] = ptr->data[i] & HIL_PKT_DATA_MASK; | 123 | ptr->rnm[i] = ptr->data[i] & HIL_PKT_DATA_MASK; |
119 | for (; i < HIL_PTR_MAX_LENGTH + 1; i++) | 124 | for (; i < HIL_PTR_MAX_LENGTH + 1; i++) |
120 | ptr->rnm[i] = '\0'; | 125 | ptr->rnm[i] = 0; |
121 | break; | 126 | break; |
127 | |||
122 | default: | 128 | default: |
123 | /* These occur when device isn't present */ | 129 | /* These occur when device isn't present */ |
124 | if (p == (HIL_ERR_INT | HIL_PKT_CMD)) break; | 130 | if (p == (HIL_ERR_INT | HIL_PKT_CMD)) |
131 | break; | ||
125 | /* Anything else we'd like to know about. */ | 132 | /* Anything else we'd like to know about. */ |
126 | printk(KERN_WARNING PREFIX "Device sent unknown record %x\n", p); | 133 | printk(KERN_WARNING PREFIX "Device sent unknown record %x\n", p); |
127 | break; | 134 | break; |
@@ -130,7 +137,8 @@ static void hil_ptr_process_record(struct hil_ptr *ptr) | |||
130 | 137 | ||
131 | report: | 138 | report: |
132 | if ((p & HIL_CMDCT_POL) != idx - 1) { | 139 | if ((p & HIL_CMDCT_POL) != idx - 1) { |
133 | printk(KERN_WARNING PREFIX "Malformed poll packet %x (idx = %i)\n", p, idx); | 140 | printk(KERN_WARNING PREFIX |
141 | "Malformed poll packet %x (idx = %i)\n", p, idx); | ||
134 | goto out; | 142 | goto out; |
135 | } | 143 | } |
136 | 144 | ||
@@ -139,7 +147,7 @@ static void hil_ptr_process_record(struct hil_ptr *ptr) | |||
139 | laxis += i; | 147 | laxis += i; |
140 | 148 | ||
141 | ax16 = ptr->idd[1] & HIL_IDD_HEADER_16BIT; /* 8 or 16bit resolution */ | 149 | ax16 = ptr->idd[1] & HIL_IDD_HEADER_16BIT; /* 8 or 16bit resolution */ |
142 | absdev = ptr->idd[1] & HIL_IDD_HEADER_ABS; | 150 | absdev = ptr->idd[1] & HIL_IDD_HEADER_ABS; |
143 | 151 | ||
144 | for (cnt = 1; i < laxis; i++) { | 152 | for (cnt = 1; i < laxis; i++) { |
145 | unsigned int lo,hi,val; | 153 | unsigned int lo,hi,val; |
@@ -157,7 +165,8 @@ static void hil_ptr_process_record(struct hil_ptr *ptr) | |||
157 | input_report_abs(dev, ABS_X + i, val); | 165 | input_report_abs(dev, ABS_X + i, val); |
158 | } else { | 166 | } else { |
159 | val = (int) (((int8_t)lo) | ((int8_t)hi<<8)); | 167 | val = (int) (((int8_t)lo) | ((int8_t)hi<<8)); |
160 | if (i%3) val *= -1; | 168 | if (i%3) |
169 | val *= -1; | ||
161 | input_report_rel(dev, REL_X + i, val); | 170 | input_report_rel(dev, REL_X + i, val); |
162 | } | 171 | } |
163 | } | 172 | } |
@@ -168,10 +177,11 @@ static void hil_ptr_process_record(struct hil_ptr *ptr) | |||
168 | btn = ptr->data[cnt++]; | 177 | btn = ptr->data[cnt++]; |
169 | up = btn & 1; | 178 | up = btn & 1; |
170 | btn &= 0xfe; | 179 | btn &= 0xfe; |
171 | if (btn == 0x8e) { | 180 | if (btn == 0x8e) |
172 | continue; /* TODO: proximity == touch? */ | 181 | continue; /* TODO: proximity == touch? */ |
173 | } | 182 | else |
174 | else if ((btn > 0x8c) || (btn < 0x80)) continue; | 183 | if ((btn > 0x8c) || (btn < 0x80)) |
184 | continue; | ||
175 | btn = (btn - 0x80) >> 1; | 185 | btn = (btn - 0x80) >> 1; |
176 | btn = ptr->btnmap[btn]; | 186 | btn = ptr->btnmap[btn]; |
177 | input_report_key(dev, btn, !up); | 187 | input_report_key(dev, btn, !up); |
@@ -182,14 +192,14 @@ static void hil_ptr_process_record(struct hil_ptr *ptr) | |||
182 | up(&ptr->sem); | 192 | up(&ptr->sem); |
183 | } | 193 | } |
184 | 194 | ||
185 | static void hil_ptr_process_err(struct hil_ptr *ptr) { | 195 | static void hil_ptr_process_err(struct hil_ptr *ptr) |
196 | { | ||
186 | printk(KERN_WARNING PREFIX "errored HIL packet\n"); | 197 | printk(KERN_WARNING PREFIX "errored HIL packet\n"); |
187 | ptr->idx4 = 0; | 198 | ptr->idx4 = 0; |
188 | up(&ptr->sem); | 199 | up(&ptr->sem); |
189 | return; | ||
190 | } | 200 | } |
191 | 201 | ||
192 | static irqreturn_t hil_ptr_interrupt(struct serio *serio, | 202 | static irqreturn_t hil_ptr_interrupt(struct serio *serio, |
193 | unsigned char data, unsigned int flags) | 203 | unsigned char data, unsigned int flags) |
194 | { | 204 | { |
195 | struct hil_ptr *ptr; | 205 | struct hil_ptr *ptr; |
@@ -197,29 +207,29 @@ static irqreturn_t hil_ptr_interrupt(struct serio *serio, | |||
197 | int idx; | 207 | int idx; |
198 | 208 | ||
199 | ptr = serio_get_drvdata(serio); | 209 | ptr = serio_get_drvdata(serio); |
200 | if (ptr == NULL) { | 210 | BUG_ON(ptr == NULL); |
201 | BUG(); | ||
202 | return IRQ_HANDLED; | ||
203 | } | ||
204 | 211 | ||
205 | if (ptr->idx4 >= (HIL_PTR_MAX_LENGTH * sizeof(hil_packet))) { | 212 | if (ptr->idx4 >= (HIL_PTR_MAX_LENGTH * sizeof(hil_packet))) { |
206 | hil_ptr_process_err(ptr); | 213 | hil_ptr_process_err(ptr); |
207 | return IRQ_HANDLED; | 214 | return IRQ_HANDLED; |
208 | } | 215 | } |
209 | idx = ptr->idx4/4; | 216 | idx = ptr->idx4/4; |
210 | if (!(ptr->idx4 % 4)) ptr->data[idx] = 0; | 217 | if (!(ptr->idx4 % 4)) |
218 | ptr->data[idx] = 0; | ||
211 | packet = ptr->data[idx]; | 219 | packet = ptr->data[idx]; |
212 | packet |= ((hil_packet)data) << ((3 - (ptr->idx4 % 4)) * 8); | 220 | packet |= ((hil_packet)data) << ((3 - (ptr->idx4 % 4)) * 8); |
213 | ptr->data[idx] = packet; | 221 | ptr->data[idx] = packet; |
214 | 222 | ||
215 | /* Records of N 4-byte hil_packets must terminate with a command. */ | 223 | /* Records of N 4-byte hil_packets must terminate with a command. */ |
216 | if ((++(ptr->idx4)) % 4) return IRQ_HANDLED; | 224 | if ((++(ptr->idx4)) % 4) |
225 | return IRQ_HANDLED; | ||
217 | if ((packet & 0xffff0000) != HIL_ERR_INT) { | 226 | if ((packet & 0xffff0000) != HIL_ERR_INT) { |
218 | hil_ptr_process_err(ptr); | 227 | hil_ptr_process_err(ptr); |
219 | return IRQ_HANDLED; | 228 | return IRQ_HANDLED; |
220 | } | 229 | } |
221 | if (packet & HIL_PKT_CMD) | 230 | if (packet & HIL_PKT_CMD) |
222 | hil_ptr_process_record(ptr); | 231 | hil_ptr_process_record(ptr); |
232 | |||
223 | return IRQ_HANDLED; | 233 | return IRQ_HANDLED; |
224 | } | 234 | } |
225 | 235 | ||
@@ -228,10 +238,7 @@ static void hil_ptr_disconnect(struct serio *serio) | |||
228 | struct hil_ptr *ptr; | 238 | struct hil_ptr *ptr; |
229 | 239 | ||
230 | ptr = serio_get_drvdata(serio); | 240 | ptr = serio_get_drvdata(serio); |
231 | if (ptr == NULL) { | 241 | BUG_ON(ptr == NULL); |
232 | BUG(); | ||
233 | return; | ||
234 | } | ||
235 | 242 | ||
236 | serio_close(serio); | 243 | serio_close(serio); |
237 | input_unregister_device(ptr->dev); | 244 | input_unregister_device(ptr->dev); |
@@ -241,7 +248,7 @@ static void hil_ptr_disconnect(struct serio *serio) | |||
241 | static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | 248 | static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) |
242 | { | 249 | { |
243 | struct hil_ptr *ptr; | 250 | struct hil_ptr *ptr; |
244 | char *txt; | 251 | const char *txt; |
245 | unsigned int i, naxsets, btntype; | 252 | unsigned int i, naxsets, btntype; |
246 | uint8_t did, *idd; | 253 | uint8_t did, *idd; |
247 | 254 | ||
@@ -252,42 +259,40 @@ static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | |||
252 | if (!ptr->dev) | 259 | if (!ptr->dev) |
253 | goto bail0; | 260 | goto bail0; |
254 | 261 | ||
255 | ptr->dev->private = ptr; | ||
256 | |||
257 | if (serio_open(serio, driver)) | 262 | if (serio_open(serio, driver)) |
258 | goto bail1; | 263 | goto bail1; |
259 | 264 | ||
260 | serio_set_drvdata(serio, ptr); | 265 | serio_set_drvdata(serio, ptr); |
261 | ptr->serio = serio; | 266 | ptr->serio = serio; |
262 | 267 | ||
263 | init_MUTEX_LOCKED(&(ptr->sem)); | 268 | init_MUTEX_LOCKED(&ptr->sem); |
264 | 269 | ||
265 | /* Get device info. MLC driver supplies devid/status/etc. */ | 270 | /* Get device info. MLC driver supplies devid/status/etc. */ |
266 | serio->write(serio, 0); | 271 | serio->write(serio, 0); |
267 | serio->write(serio, 0); | 272 | serio->write(serio, 0); |
268 | serio->write(serio, HIL_PKT_CMD >> 8); | 273 | serio->write(serio, HIL_PKT_CMD >> 8); |
269 | serio->write(serio, HIL_CMD_IDD); | 274 | serio->write(serio, HIL_CMD_IDD); |
270 | down(&(ptr->sem)); | 275 | down(&ptr->sem); |
271 | 276 | ||
272 | serio->write(serio, 0); | 277 | serio->write(serio, 0); |
273 | serio->write(serio, 0); | 278 | serio->write(serio, 0); |
274 | serio->write(serio, HIL_PKT_CMD >> 8); | 279 | serio->write(serio, HIL_PKT_CMD >> 8); |
275 | serio->write(serio, HIL_CMD_RSC); | 280 | serio->write(serio, HIL_CMD_RSC); |
276 | down(&(ptr->sem)); | 281 | down(&ptr->sem); |
277 | 282 | ||
278 | serio->write(serio, 0); | 283 | serio->write(serio, 0); |
279 | serio->write(serio, 0); | 284 | serio->write(serio, 0); |
280 | serio->write(serio, HIL_PKT_CMD >> 8); | 285 | serio->write(serio, HIL_PKT_CMD >> 8); |
281 | serio->write(serio, HIL_CMD_RNM); | 286 | serio->write(serio, HIL_CMD_RNM); |
282 | down(&(ptr->sem)); | 287 | down(&ptr->sem); |
283 | 288 | ||
284 | serio->write(serio, 0); | 289 | serio->write(serio, 0); |
285 | serio->write(serio, 0); | 290 | serio->write(serio, 0); |
286 | serio->write(serio, HIL_PKT_CMD >> 8); | 291 | serio->write(serio, HIL_PKT_CMD >> 8); |
287 | serio->write(serio, HIL_CMD_EXD); | 292 | serio->write(serio, HIL_CMD_EXD); |
288 | down(&(ptr->sem)); | 293 | down(&ptr->sem); |
289 | 294 | ||
290 | up(&(ptr->sem)); | 295 | up(&ptr->sem); |
291 | 296 | ||
292 | did = ptr->idd[0]; | 297 | did = ptr->idd[0]; |
293 | idd = ptr->idd + 1; | 298 | idd = ptr->idd + 1; |
@@ -301,12 +306,12 @@ static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | |||
301 | ptr->dev->evbit[0] = BIT(EV_ABS); | 306 | ptr->dev->evbit[0] = BIT(EV_ABS); |
302 | txt = "absolute"; | 307 | txt = "absolute"; |
303 | } | 308 | } |
304 | if (!ptr->dev->evbit[0]) { | 309 | if (!ptr->dev->evbit[0]) |
305 | goto bail2; | 310 | goto bail2; |
306 | } | ||
307 | 311 | ||
308 | ptr->nbtn = HIL_IDD_NUM_BUTTONS(idd); | 312 | ptr->nbtn = HIL_IDD_NUM_BUTTONS(idd); |
309 | if (ptr->nbtn) ptr->dev->evbit[0] |= BIT(EV_KEY); | 313 | if (ptr->nbtn) |
314 | ptr->dev->evbit[0] |= BIT(EV_KEY); | ||
310 | 315 | ||
311 | naxsets = HIL_IDD_NUM_AXSETS(*idd); | 316 | naxsets = HIL_IDD_NUM_AXSETS(*idd); |
312 | ptr->naxes = HIL_IDD_NUM_AXES_PER_SET(*idd); | 317 | ptr->naxes = HIL_IDD_NUM_AXES_PER_SET(*idd); |
@@ -315,7 +320,7 @@ static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | |||
315 | did, txt); | 320 | did, txt); |
316 | printk(KERN_INFO PREFIX "HIL pointer has %i buttons and %i sets of %i axes\n", | 321 | printk(KERN_INFO PREFIX "HIL pointer has %i buttons and %i sets of %i axes\n", |
317 | ptr->nbtn, naxsets, ptr->naxes); | 322 | ptr->nbtn, naxsets, ptr->naxes); |
318 | 323 | ||
319 | btntype = BTN_MISC; | 324 | btntype = BTN_MISC; |
320 | if ((did & HIL_IDD_DID_ABS_TABLET_MASK) == HIL_IDD_DID_ABS_TABLET) | 325 | if ((did & HIL_IDD_DID_ABS_TABLET_MASK) == HIL_IDD_DID_ABS_TABLET) |
321 | #ifdef TABLET_SIMULATES_MOUSE | 326 | #ifdef TABLET_SIMULATES_MOUSE |
@@ -325,7 +330,7 @@ static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | |||
325 | #endif | 330 | #endif |
326 | if ((did & HIL_IDD_DID_ABS_TSCREEN_MASK) == HIL_IDD_DID_ABS_TSCREEN) | 331 | if ((did & HIL_IDD_DID_ABS_TSCREEN_MASK) == HIL_IDD_DID_ABS_TSCREEN) |
327 | btntype = BTN_TOUCH; | 332 | btntype = BTN_TOUCH; |
328 | 333 | ||
329 | if ((did & HIL_IDD_DID_REL_MOUSE_MASK) == HIL_IDD_DID_REL_MOUSE) | 334 | if ((did & HIL_IDD_DID_REL_MOUSE_MASK) == HIL_IDD_DID_REL_MOUSE) |
330 | btntype = BTN_MOUSE; | 335 | btntype = BTN_MOUSE; |
331 | 336 | ||
@@ -341,12 +346,10 @@ static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | |||
341 | } | 346 | } |
342 | 347 | ||
343 | if ((did & HIL_IDD_DID_TYPE_MASK) == HIL_IDD_DID_TYPE_REL) { | 348 | if ((did & HIL_IDD_DID_TYPE_MASK) == HIL_IDD_DID_TYPE_REL) { |
344 | for (i = 0; i < ptr->naxes; i++) { | 349 | for (i = 0; i < ptr->naxes; i++) |
345 | set_bit(REL_X + i, ptr->dev->relbit); | 350 | set_bit(REL_X + i, ptr->dev->relbit); |
346 | } | 351 | for (i = 3; (i < ptr->naxes + 3) && (naxsets > 1); i++) |
347 | for (i = 3; (i < ptr->naxes + 3) && (naxsets > 1); i++) { | ||
348 | set_bit(REL_X + i, ptr->dev->relbit); | 352 | set_bit(REL_X + i, ptr->dev->relbit); |
349 | } | ||
350 | } else { | 353 | } else { |
351 | for (i = 0; i < ptr->naxes; i++) { | 354 | for (i = 0; i < ptr->naxes; i++) { |
352 | set_bit(ABS_X + i, ptr->dev->absbit); | 355 | set_bit(ABS_X + i, ptr->dev->absbit); |
@@ -375,7 +378,7 @@ static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | |||
375 | ptr->dev->id.vendor = PCI_VENDOR_ID_HP; | 378 | ptr->dev->id.vendor = PCI_VENDOR_ID_HP; |
376 | ptr->dev->id.product = 0x0001; /* TODO: get from ptr->rsc */ | 379 | ptr->dev->id.product = 0x0001; /* TODO: get from ptr->rsc */ |
377 | ptr->dev->id.version = 0x0100; /* TODO: get from ptr->rsc */ | 380 | ptr->dev->id.version = 0x0100; /* TODO: get from ptr->rsc */ |
378 | ptr->dev->cdev.dev = &serio->dev; | 381 | ptr->dev->dev.parent = &serio->dev; |
379 | 382 | ||
380 | input_register_device(ptr->dev); | 383 | input_register_device(ptr->dev); |
381 | printk(KERN_INFO "input: %s (%s), ID: %d\n", | 384 | printk(KERN_INFO "input: %s (%s), ID: %d\n", |
@@ -419,11 +422,11 @@ static int __init hil_ptr_init(void) | |||
419 | { | 422 | { |
420 | return serio_register_driver(&hil_ptr_serio_driver); | 423 | return serio_register_driver(&hil_ptr_serio_driver); |
421 | } | 424 | } |
422 | 425 | ||
423 | static void __exit hil_ptr_exit(void) | 426 | static void __exit hil_ptr_exit(void) |
424 | { | 427 | { |
425 | serio_unregister_driver(&hil_ptr_serio_driver); | 428 | serio_unregister_driver(&hil_ptr_serio_driver); |
426 | } | 429 | } |
427 | 430 | ||
428 | module_init(hil_ptr_init); | 431 | module_init(hil_ptr_init); |
429 | module_exit(hil_ptr_exit); | 432 | module_exit(hil_ptr_exit); |
diff --git a/drivers/input/mouse/lifebook.c b/drivers/input/mouse/lifebook.c index 29542f0631cb..1740cadd9594 100644 --- a/drivers/input/mouse/lifebook.c +++ b/drivers/input/mouse/lifebook.c | |||
@@ -20,6 +20,27 @@ | |||
20 | #include "psmouse.h" | 20 | #include "psmouse.h" |
21 | #include "lifebook.h" | 21 | #include "lifebook.h" |
22 | 22 | ||
23 | struct lifebook_data { | ||
24 | struct input_dev *dev2; /* Relative device */ | ||
25 | char phys[32]; | ||
26 | }; | ||
27 | |||
28 | static const char *desired_serio_phys; | ||
29 | |||
30 | static int lifebook_set_serio_phys(struct dmi_system_id *d) | ||
31 | { | ||
32 | desired_serio_phys = d->driver_data; | ||
33 | return 0; | ||
34 | } | ||
35 | |||
36 | static unsigned char lifebook_use_6byte_proto; | ||
37 | |||
38 | static int lifebook_set_6byte_proto(struct dmi_system_id *d) | ||
39 | { | ||
40 | lifebook_use_6byte_proto = 1; | ||
41 | return 0; | ||
42 | } | ||
43 | |||
23 | static struct dmi_system_id lifebook_dmi_table[] = { | 44 | static struct dmi_system_id lifebook_dmi_table[] = { |
24 | { | 45 | { |
25 | .ident = "FLORA-ie 55mi", | 46 | .ident = "FLORA-ie 55mi", |
@@ -56,6 +77,24 @@ static struct dmi_system_id lifebook_dmi_table[] = { | |||
56 | .matches = { | 77 | .matches = { |
57 | DMI_MATCH(DMI_PRODUCT_NAME, "CF-18"), | 78 | DMI_MATCH(DMI_PRODUCT_NAME, "CF-18"), |
58 | }, | 79 | }, |
80 | .callback = lifebook_set_serio_phys, | ||
81 | .driver_data = "isa0060/serio3", | ||
82 | }, | ||
83 | { | ||
84 | .ident = "Panasonic CF-28", | ||
85 | .matches = { | ||
86 | DMI_MATCH(DMI_SYS_VENDOR, "Matsushita"), | ||
87 | DMI_MATCH(DMI_PRODUCT_NAME, "CF-28"), | ||
88 | }, | ||
89 | .callback = lifebook_set_6byte_proto, | ||
90 | }, | ||
91 | { | ||
92 | .ident = "Panasonic CF-29", | ||
93 | .matches = { | ||
94 | DMI_MATCH(DMI_SYS_VENDOR, "Matsushita"), | ||
95 | DMI_MATCH(DMI_PRODUCT_NAME, "CF-29"), | ||
96 | }, | ||
97 | .callback = lifebook_set_6byte_proto, | ||
59 | }, | 98 | }, |
60 | { | 99 | { |
61 | .ident = "Lifebook B142", | 100 | .ident = "Lifebook B142", |
@@ -68,30 +107,70 @@ static struct dmi_system_id lifebook_dmi_table[] = { | |||
68 | 107 | ||
69 | static psmouse_ret_t lifebook_process_byte(struct psmouse *psmouse) | 108 | static psmouse_ret_t lifebook_process_byte(struct psmouse *psmouse) |
70 | { | 109 | { |
110 | struct lifebook_data *priv = psmouse->private; | ||
111 | struct input_dev *dev1 = psmouse->dev; | ||
112 | struct input_dev *dev2 = priv->dev2; | ||
71 | unsigned char *packet = psmouse->packet; | 113 | unsigned char *packet = psmouse->packet; |
72 | struct input_dev *dev = psmouse->dev; | 114 | int relative_packet = packet[0] & 0x08; |
73 | 115 | ||
74 | if (psmouse->pktcnt != 3) | 116 | if (relative_packet || !lifebook_use_6byte_proto) { |
75 | return PSMOUSE_GOOD_DATA; | 117 | if (psmouse->pktcnt != 3) |
118 | return PSMOUSE_GOOD_DATA; | ||
119 | } else { | ||
120 | switch (psmouse->pktcnt) { | ||
121 | case 1: | ||
122 | return (packet[0] & 0xf8) == 0x00 ? | ||
123 | PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA; | ||
124 | case 2: | ||
125 | return PSMOUSE_GOOD_DATA; | ||
126 | case 3: | ||
127 | return ((packet[2] & 0x30) << 2) == (packet[2] & 0xc0) ? | ||
128 | PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA; | ||
129 | case 4: | ||
130 | return (packet[3] & 0xf8) == 0xc0 ? | ||
131 | PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA; | ||
132 | case 5: | ||
133 | return (packet[4] & 0xc0) == (packet[2] & 0xc0) ? | ||
134 | PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA; | ||
135 | case 6: | ||
136 | if (((packet[5] & 0x30) << 2) != (packet[5] & 0xc0)) | ||
137 | return PSMOUSE_BAD_DATA; | ||
138 | if ((packet[5] & 0xc0) != (packet[1] & 0xc0)) | ||
139 | return PSMOUSE_BAD_DATA; | ||
140 | break; /* report data */ | ||
141 | } | ||
142 | } | ||
76 | 143 | ||
77 | /* calculate X and Y */ | 144 | if (relative_packet) { |
78 | if ((packet[0] & 0x08) == 0x00) { | 145 | if (!dev2) |
79 | input_report_abs(dev, ABS_X, | 146 | printk(KERN_WARNING "lifebook.c: got relative packet " |
147 | "but no relative device set up\n"); | ||
148 | } else if (lifebook_use_6byte_proto) { | ||
149 | input_report_abs(dev1, ABS_X, | ||
150 | ((packet[1] & 0x3f) << 6) | (packet[2] & 0x3f)); | ||
151 | input_report_abs(dev1, ABS_Y, | ||
152 | 4096 - (((packet[4] & 0x3f) << 6) | (packet[5] & 0x3f))); | ||
153 | } else { | ||
154 | input_report_abs(dev1, ABS_X, | ||
80 | (packet[1] | ((packet[0] & 0x30) << 4))); | 155 | (packet[1] | ((packet[0] & 0x30) << 4))); |
81 | input_report_abs(dev, ABS_Y, | 156 | input_report_abs(dev1, ABS_Y, |
82 | 1024 - (packet[2] | ((packet[0] & 0xC0) << 2))); | 157 | 1024 - (packet[2] | ((packet[0] & 0xC0) << 2))); |
83 | } else { | ||
84 | input_report_rel(dev, REL_X, | ||
85 | ((packet[0] & 0x10) ? packet[1] - 256 : packet[1])); | ||
86 | input_report_rel(dev, REL_Y, | ||
87 | -(int)((packet[0] & 0x20) ? packet[2] - 256 : packet[2])); | ||
88 | } | 158 | } |
89 | 159 | ||
90 | input_report_key(dev, BTN_LEFT, packet[0] & 0x01); | 160 | input_report_key(dev1, BTN_TOUCH, packet[0] & 0x04); |
91 | input_report_key(dev, BTN_RIGHT, packet[0] & 0x02); | 161 | input_sync(dev1); |
92 | input_report_key(dev, BTN_TOUCH, packet[0] & 0x04); | ||
93 | 162 | ||
94 | input_sync(dev); | 163 | if (dev2) { |
164 | if (relative_packet) { | ||
165 | input_report_rel(dev2, REL_X, | ||
166 | ((packet[0] & 0x10) ? packet[1] - 256 : packet[1])); | ||
167 | input_report_rel(dev2, REL_Y, | ||
168 | -(int)((packet[0] & 0x20) ? packet[2] - 256 : packet[2])); | ||
169 | } | ||
170 | input_report_key(dev2, BTN_LEFT, packet[0] & 0x01); | ||
171 | input_report_key(dev2, BTN_RIGHT, packet[0] & 0x02); | ||
172 | input_sync(dev2); | ||
173 | } | ||
95 | 174 | ||
96 | return PSMOUSE_FULL_PACKET; | 175 | return PSMOUSE_FULL_PACKET; |
97 | } | 176 | } |
@@ -109,12 +188,20 @@ static int lifebook_absolute_mode(struct psmouse *psmouse) | |||
109 | you leave this call out the touchsreen will never send | 188 | you leave this call out the touchsreen will never send |
110 | absolute coordinates | 189 | absolute coordinates |
111 | */ | 190 | */ |
112 | param = 0x07; | 191 | param = lifebook_use_6byte_proto ? 0x08 : 0x07; |
113 | ps2_command(ps2dev, ¶m, PSMOUSE_CMD_SETRES); | 192 | ps2_command(ps2dev, ¶m, PSMOUSE_CMD_SETRES); |
114 | 193 | ||
115 | return 0; | 194 | return 0; |
116 | } | 195 | } |
117 | 196 | ||
197 | static void lifebook_relative_mode(struct psmouse *psmouse) | ||
198 | { | ||
199 | struct ps2dev *ps2dev = &psmouse->ps2dev; | ||
200 | unsigned char param = 0x06; | ||
201 | |||
202 | ps2_command(ps2dev, ¶m, PSMOUSE_CMD_SETRES); | ||
203 | } | ||
204 | |||
118 | static void lifebook_set_resolution(struct psmouse *psmouse, unsigned int resolution) | 205 | static void lifebook_set_resolution(struct psmouse *psmouse, unsigned int resolution) |
119 | { | 206 | { |
120 | static const unsigned char params[] = { 0, 1, 2, 2, 3 }; | 207 | static const unsigned char params[] = { 0, 1, 2, 2, 3 }; |
@@ -131,6 +218,8 @@ static void lifebook_set_resolution(struct psmouse *psmouse, unsigned int resolu | |||
131 | static void lifebook_disconnect(struct psmouse *psmouse) | 218 | static void lifebook_disconnect(struct psmouse *psmouse) |
132 | { | 219 | { |
133 | psmouse_reset(psmouse); | 220 | psmouse_reset(psmouse); |
221 | kfree(psmouse->private); | ||
222 | psmouse->private = NULL; | ||
134 | } | 223 | } |
135 | 224 | ||
136 | int lifebook_detect(struct psmouse *psmouse, int set_properties) | 225 | int lifebook_detect(struct psmouse *psmouse, int set_properties) |
@@ -138,6 +227,10 @@ int lifebook_detect(struct psmouse *psmouse, int set_properties) | |||
138 | if (!dmi_check_system(lifebook_dmi_table)) | 227 | if (!dmi_check_system(lifebook_dmi_table)) |
139 | return -1; | 228 | return -1; |
140 | 229 | ||
230 | if (desired_serio_phys && | ||
231 | strcmp(psmouse->ps2dev.serio->phys, desired_serio_phys)) | ||
232 | return -1; | ||
233 | |||
141 | if (set_properties) { | 234 | if (set_properties) { |
142 | psmouse->vendor = "Fujitsu"; | 235 | psmouse->vendor = "Fujitsu"; |
143 | psmouse->name = "Lifebook TouchScreen"; | 236 | psmouse->name = "Lifebook TouchScreen"; |
@@ -146,24 +239,78 @@ int lifebook_detect(struct psmouse *psmouse, int set_properties) | |||
146 | return 0; | 239 | return 0; |
147 | } | 240 | } |
148 | 241 | ||
242 | static int lifebook_create_relative_device(struct psmouse *psmouse) | ||
243 | { | ||
244 | struct input_dev *dev2; | ||
245 | struct lifebook_data *priv; | ||
246 | int error = -ENOMEM; | ||
247 | |||
248 | priv = kzalloc(sizeof(struct lifebook_data), GFP_KERNEL); | ||
249 | dev2 = input_allocate_device(); | ||
250 | if (!priv || !dev2) | ||
251 | goto err_out; | ||
252 | |||
253 | priv->dev2 = dev2; | ||
254 | snprintf(priv->phys, sizeof(priv->phys), | ||
255 | "%s/input1", psmouse->ps2dev.serio->phys); | ||
256 | |||
257 | dev2->phys = priv->phys; | ||
258 | dev2->name = "PS/2 Touchpad"; | ||
259 | dev2->id.bustype = BUS_I8042; | ||
260 | dev2->id.vendor = 0x0002; | ||
261 | dev2->id.product = PSMOUSE_LIFEBOOK; | ||
262 | dev2->id.version = 0x0000; | ||
263 | dev2->dev.parent = &psmouse->ps2dev.serio->dev; | ||
264 | |||
265 | dev2->evbit[0] = BIT(EV_KEY) | BIT(EV_REL); | ||
266 | dev2->relbit[LONG(REL_X)] = BIT(REL_X) | BIT(REL_Y); | ||
267 | dev2->keybit[LONG(BTN_LEFT)] = BIT(BTN_LEFT) | BIT(BTN_RIGHT); | ||
268 | |||
269 | error = input_register_device(priv->dev2); | ||
270 | if (error) | ||
271 | goto err_out; | ||
272 | |||
273 | psmouse->private = priv; | ||
274 | return 0; | ||
275 | |||
276 | err_out: | ||
277 | input_free_device(dev2); | ||
278 | kfree(priv); | ||
279 | return error; | ||
280 | } | ||
281 | |||
149 | int lifebook_init(struct psmouse *psmouse) | 282 | int lifebook_init(struct psmouse *psmouse) |
150 | { | 283 | { |
151 | struct input_dev *input_dev = psmouse->dev; | 284 | struct input_dev *dev1 = psmouse->dev; |
285 | int max_coord = lifebook_use_6byte_proto ? 1024 : 4096; | ||
152 | 286 | ||
153 | if (lifebook_absolute_mode(psmouse)) | 287 | if (lifebook_absolute_mode(psmouse)) |
154 | return -1; | 288 | return -1; |
155 | 289 | ||
156 | input_dev->evbit[0] = BIT(EV_ABS) | BIT(EV_KEY) | BIT(EV_REL); | 290 | dev1->evbit[0] = BIT(EV_ABS) | BIT(EV_KEY); |
157 | input_dev->keybit[LONG(BTN_LEFT)] = BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT); | 291 | dev1->relbit[0] = 0; |
158 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | 292 | dev1->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); |
159 | input_dev->relbit[0] = BIT(REL_X) | BIT(REL_Y); | 293 | input_set_abs_params(dev1, ABS_X, 0, max_coord, 0, 0); |
160 | input_set_abs_params(input_dev, ABS_X, 0, 1024, 0, 0); | 294 | input_set_abs_params(dev1, ABS_Y, 0, max_coord, 0, 0); |
161 | input_set_abs_params(input_dev, ABS_Y, 0, 1024, 0, 0); | 295 | |
296 | if (!desired_serio_phys) { | ||
297 | if (lifebook_create_relative_device(psmouse)) { | ||
298 | lifebook_relative_mode(psmouse); | ||
299 | return -1; | ||
300 | } | ||
301 | } | ||
162 | 302 | ||
163 | psmouse->protocol_handler = lifebook_process_byte; | 303 | psmouse->protocol_handler = lifebook_process_byte; |
164 | psmouse->set_resolution = lifebook_set_resolution; | 304 | psmouse->set_resolution = lifebook_set_resolution; |
165 | psmouse->disconnect = lifebook_disconnect; | 305 | psmouse->disconnect = lifebook_disconnect; |
166 | psmouse->reconnect = lifebook_absolute_mode; | 306 | psmouse->reconnect = lifebook_absolute_mode; |
307 | |||
308 | psmouse->model = lifebook_use_6byte_proto ? 6 : 3; | ||
309 | |||
310 | /* | ||
311 | * Use packet size = 3 even when using 6-byte protocol because | ||
312 | * that's what POLL will return on Lifebooks (according to spec). | ||
313 | */ | ||
167 | psmouse->pktsize = 3; | 314 | psmouse->pktsize = 3; |
168 | 315 | ||
169 | return 0; | 316 | return 0; |
diff --git a/drivers/input/mouse/lifebook.h b/drivers/input/mouse/lifebook.h index be1c0943825d..c1647cf036c2 100644 --- a/drivers/input/mouse/lifebook.h +++ b/drivers/input/mouse/lifebook.h | |||
@@ -11,7 +11,18 @@ | |||
11 | #ifndef _LIFEBOOK_H | 11 | #ifndef _LIFEBOOK_H |
12 | #define _LIFEBOOK_H | 12 | #define _LIFEBOOK_H |
13 | 13 | ||
14 | #ifdef CONFIG_MOUSE_PS2_LIFEBOOK | ||
14 | int lifebook_detect(struct psmouse *psmouse, int set_properties); | 15 | int lifebook_detect(struct psmouse *psmouse, int set_properties); |
15 | int lifebook_init(struct psmouse *psmouse); | 16 | int lifebook_init(struct psmouse *psmouse); |
17 | #else | ||
18 | inline int lifebook_detect(struct psmouse *psmouse, int set_properties) | ||
19 | { | ||
20 | return -ENOSYS; | ||
21 | } | ||
22 | inline int lifebook_init(struct psmouse *psmouse) | ||
23 | { | ||
24 | return -ENOSYS; | ||
25 | } | ||
26 | #endif | ||
16 | 27 | ||
17 | #endif | 28 | #endif |
diff --git a/drivers/input/mouse/logips2pp.c b/drivers/input/mouse/logips2pp.c index d3ddea26b8ca..9df74b72e6c4 100644 --- a/drivers/input/mouse/logips2pp.c +++ b/drivers/input/mouse/logips2pp.c | |||
@@ -200,6 +200,7 @@ static void ps2pp_disconnect(struct psmouse *psmouse) | |||
200 | static const struct ps2pp_info *get_model_info(unsigned char model) | 200 | static const struct ps2pp_info *get_model_info(unsigned char model) |
201 | { | 201 | { |
202 | static const struct ps2pp_info ps2pp_list[] = { | 202 | static const struct ps2pp_info ps2pp_list[] = { |
203 | { 1, 0, 0 }, /* Simple 2-button mouse */ | ||
203 | { 12, 0, PS2PP_SIDE_BTN}, | 204 | { 12, 0, PS2PP_SIDE_BTN}, |
204 | { 13, 0, 0 }, | 205 | { 13, 0, 0 }, |
205 | { 15, PS2PP_KIND_MX, /* MX1000 */ | 206 | { 15, PS2PP_KIND_MX, /* MX1000 */ |
@@ -338,12 +339,12 @@ int ps2pp_init(struct psmouse *psmouse, int set_properties) | |||
338 | param[1] = 0; | 339 | param[1] = 0; |
339 | ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); | 340 | ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); |
340 | 341 | ||
341 | if (!param[1]) | ||
342 | return -1; | ||
343 | |||
344 | model = ((param[0] >> 4) & 0x07) | ((param[0] << 3) & 0x78); | 342 | model = ((param[0] >> 4) & 0x07) | ((param[0] << 3) & 0x78); |
345 | buttons = param[1]; | 343 | buttons = param[1]; |
346 | 344 | ||
345 | if (!model || !buttons) | ||
346 | return -1; | ||
347 | |||
347 | if ((model_info = get_model_info(model)) != NULL) { | 348 | if ((model_info = get_model_info(model)) != NULL) { |
348 | 349 | ||
349 | /* | 350 | /* |
diff --git a/drivers/input/mouse/logips2pp.h b/drivers/input/mouse/logips2pp.h index 64a8ec52ea6d..6e5712525fd6 100644 --- a/drivers/input/mouse/logips2pp.h +++ b/drivers/input/mouse/logips2pp.h | |||
@@ -11,6 +11,13 @@ | |||
11 | #ifndef _LOGIPS2PP_H | 11 | #ifndef _LOGIPS2PP_H |
12 | #define _LOGIPS2PP_H | 12 | #define _LOGIPS2PP_H |
13 | 13 | ||
14 | #ifdef CONFIG_MOUSE_PS2_LOGIPS2PP | ||
14 | int ps2pp_init(struct psmouse *psmouse, int set_properties); | 15 | int ps2pp_init(struct psmouse *psmouse, int set_properties); |
16 | #else | ||
17 | inline int ps2pp_init(struct psmouse *psmouse, int set_properties) | ||
18 | { | ||
19 | return -ENOSYS; | ||
20 | } | ||
21 | #endif /* CONFIG_MOUSE_PS2_LOGIPS2PP */ | ||
15 | 22 | ||
16 | #endif | 23 | #endif |
diff --git a/drivers/input/mouse/psmouse-base.c b/drivers/input/mouse/psmouse-base.c index 0fe5869d7d4c..f15f695777f8 100644 --- a/drivers/input/mouse/psmouse-base.c +++ b/drivers/input/mouse/psmouse-base.c | |||
@@ -28,6 +28,7 @@ | |||
28 | #include "alps.h" | 28 | #include "alps.h" |
29 | #include "lifebook.h" | 29 | #include "lifebook.h" |
30 | #include "trackpoint.h" | 30 | #include "trackpoint.h" |
31 | #include "touchkit_ps2.h" | ||
31 | 32 | ||
32 | #define DRIVER_DESC "PS/2 mouse driver" | 33 | #define DRIVER_DESC "PS/2 mouse driver" |
33 | 34 | ||
@@ -569,7 +570,9 @@ static int psmouse_extensions(struct psmouse *psmouse, | |||
569 | return PSMOUSE_THINKPS; | 570 | return PSMOUSE_THINKPS; |
570 | 571 | ||
571 | /* | 572 | /* |
572 | * Try Synaptics TouchPad | 573 | * Try Synaptics TouchPad. Note that probing is done even if Synaptics protocol |
574 | * support is disabled in config - we need to know if it is synaptics so we | ||
575 | * can reset it properly after probing for intellimouse. | ||
573 | */ | 576 | */ |
574 | if (max_proto > PSMOUSE_PS2 && synaptics_detect(psmouse, set_properties) == 0) { | 577 | if (max_proto > PSMOUSE_PS2 && synaptics_detect(psmouse, set_properties) == 0) { |
575 | synaptics_hardware = 1; | 578 | synaptics_hardware = 1; |
@@ -605,14 +608,20 @@ static int psmouse_extensions(struct psmouse *psmouse, | |||
605 | } | 608 | } |
606 | } | 609 | } |
607 | 610 | ||
608 | if (max_proto > PSMOUSE_IMEX && genius_detect(psmouse, set_properties) == 0) | 611 | if (max_proto > PSMOUSE_IMEX) { |
609 | return PSMOUSE_GENPS; | 612 | |
613 | if (genius_detect(psmouse, set_properties) == 0) | ||
614 | return PSMOUSE_GENPS; | ||
610 | 615 | ||
611 | if (max_proto > PSMOUSE_IMEX && ps2pp_init(psmouse, set_properties) == 0) | 616 | if (ps2pp_init(psmouse, set_properties) == 0) |
612 | return PSMOUSE_PS2PP; | 617 | return PSMOUSE_PS2PP; |
613 | 618 | ||
614 | if (max_proto > PSMOUSE_IMEX && trackpoint_detect(psmouse, set_properties) == 0) | 619 | if (trackpoint_detect(psmouse, set_properties) == 0) |
615 | return PSMOUSE_TRACKPOINT; | 620 | return PSMOUSE_TRACKPOINT; |
621 | |||
622 | if (touchkit_ps2_detect(psmouse, set_properties) == 0) | ||
623 | return PSMOUSE_TOUCHKIT_PS2; | ||
624 | } | ||
616 | 625 | ||
617 | /* | 626 | /* |
618 | * Reset to defaults in case the device got confused by extended | 627 | * Reset to defaults in case the device got confused by extended |
@@ -654,12 +663,14 @@ static const struct psmouse_protocol psmouse_protocols[] = { | |||
654 | .maxproto = 1, | 663 | .maxproto = 1, |
655 | .detect = ps2bare_detect, | 664 | .detect = ps2bare_detect, |
656 | }, | 665 | }, |
666 | #ifdef CONFIG_MOUSE_PS2_LOGIPS2PP | ||
657 | { | 667 | { |
658 | .type = PSMOUSE_PS2PP, | 668 | .type = PSMOUSE_PS2PP, |
659 | .name = "PS2++", | 669 | .name = "PS2++", |
660 | .alias = "logitech", | 670 | .alias = "logitech", |
661 | .detect = ps2pp_init, | 671 | .detect = ps2pp_init, |
662 | }, | 672 | }, |
673 | #endif | ||
663 | { | 674 | { |
664 | .type = PSMOUSE_THINKPS, | 675 | .type = PSMOUSE_THINKPS, |
665 | .name = "ThinkPS/2", | 676 | .name = "ThinkPS/2", |
@@ -686,6 +697,7 @@ static const struct psmouse_protocol psmouse_protocols[] = { | |||
686 | .maxproto = 1, | 697 | .maxproto = 1, |
687 | .detect = im_explorer_detect, | 698 | .detect = im_explorer_detect, |
688 | }, | 699 | }, |
700 | #ifdef CONFIG_MOUSE_PS2_SYNAPTICS | ||
689 | { | 701 | { |
690 | .type = PSMOUSE_SYNAPTICS, | 702 | .type = PSMOUSE_SYNAPTICS, |
691 | .name = "SynPS/2", | 703 | .name = "SynPS/2", |
@@ -693,6 +705,8 @@ static const struct psmouse_protocol psmouse_protocols[] = { | |||
693 | .detect = synaptics_detect, | 705 | .detect = synaptics_detect, |
694 | .init = synaptics_init, | 706 | .init = synaptics_init, |
695 | }, | 707 | }, |
708 | #endif | ||
709 | #ifdef CONFIG_MOUSE_PS2_ALPS | ||
696 | { | 710 | { |
697 | .type = PSMOUSE_ALPS, | 711 | .type = PSMOUSE_ALPS, |
698 | .name = "AlpsPS/2", | 712 | .name = "AlpsPS/2", |
@@ -700,18 +714,31 @@ static const struct psmouse_protocol psmouse_protocols[] = { | |||
700 | .detect = alps_detect, | 714 | .detect = alps_detect, |
701 | .init = alps_init, | 715 | .init = alps_init, |
702 | }, | 716 | }, |
717 | #endif | ||
718 | #ifdef CONFIG_MOUSE_PS2_LIFEBOOK | ||
703 | { | 719 | { |
704 | .type = PSMOUSE_LIFEBOOK, | 720 | .type = PSMOUSE_LIFEBOOK, |
705 | .name = "LBPS/2", | 721 | .name = "LBPS/2", |
706 | .alias = "lifebook", | 722 | .alias = "lifebook", |
707 | .init = lifebook_init, | 723 | .init = lifebook_init, |
708 | }, | 724 | }, |
725 | #endif | ||
726 | #ifdef CONFIG_MOUSE_PS2_TRACKPOINT | ||
709 | { | 727 | { |
710 | .type = PSMOUSE_TRACKPOINT, | 728 | .type = PSMOUSE_TRACKPOINT, |
711 | .name = "TPPS/2", | 729 | .name = "TPPS/2", |
712 | .alias = "trackpoint", | 730 | .alias = "trackpoint", |
713 | .detect = trackpoint_detect, | 731 | .detect = trackpoint_detect, |
714 | }, | 732 | }, |
733 | #endif | ||
734 | #ifdef CONFIG_MOUSE_PS2_TOUCHKIT | ||
735 | { | ||
736 | .type = PSMOUSE_TOUCHKIT_PS2, | ||
737 | .name = "touchkitPS/2", | ||
738 | .alias = "touchkit", | ||
739 | .detect = touchkit_ps2_detect, | ||
740 | }, | ||
741 | #endif | ||
715 | { | 742 | { |
716 | .type = PSMOUSE_AUTO, | 743 | .type = PSMOUSE_AUTO, |
717 | .name = "auto", | 744 | .name = "auto", |
@@ -823,12 +850,6 @@ static void psmouse_set_rate(struct psmouse *psmouse, unsigned int rate) | |||
823 | static void psmouse_initialize(struct psmouse *psmouse) | 850 | static void psmouse_initialize(struct psmouse *psmouse) |
824 | { | 851 | { |
825 | /* | 852 | /* |
826 | * We set the mouse into streaming mode. | ||
827 | */ | ||
828 | |||
829 | ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); | ||
830 | |||
831 | /* | ||
832 | * We set the mouse report rate, resolution and scaling. | 853 | * We set the mouse report rate, resolution and scaling. |
833 | */ | 854 | */ |
834 | 855 | ||
@@ -1062,8 +1083,7 @@ static int psmouse_switch_protocol(struct psmouse *psmouse, const struct psmouse | |||
1062 | { | 1083 | { |
1063 | struct input_dev *input_dev = psmouse->dev; | 1084 | struct input_dev *input_dev = psmouse->dev; |
1064 | 1085 | ||
1065 | input_dev->private = psmouse; | 1086 | input_dev->dev.parent = &psmouse->ps2dev.serio->dev; |
1066 | input_dev->cdev.dev = &psmouse->ps2dev.serio->dev; | ||
1067 | 1087 | ||
1068 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REL); | 1088 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REL); |
1069 | input_dev->keybit[LONG(BTN_MOUSE)] = BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT); | 1089 | input_dev->keybit[LONG(BTN_MOUSE)] = BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT); |
diff --git a/drivers/input/mouse/psmouse.h b/drivers/input/mouse/psmouse.h index cf1de95b6f27..3964e8acbc54 100644 --- a/drivers/input/mouse/psmouse.h +++ b/drivers/input/mouse/psmouse.h | |||
@@ -87,6 +87,7 @@ enum psmouse_type { | |||
87 | PSMOUSE_ALPS, | 87 | PSMOUSE_ALPS, |
88 | PSMOUSE_LIFEBOOK, | 88 | PSMOUSE_LIFEBOOK, |
89 | PSMOUSE_TRACKPOINT, | 89 | PSMOUSE_TRACKPOINT, |
90 | PSMOUSE_TOUCHKIT_PS2, | ||
90 | PSMOUSE_AUTO /* This one should always be last */ | 91 | PSMOUSE_AUTO /* This one should always be last */ |
91 | }; | 92 | }; |
92 | 93 | ||
diff --git a/drivers/input/mouse/sermouse.c b/drivers/input/mouse/sermouse.c index a85d74710b44..77b8ee2b9651 100644 --- a/drivers/input/mouse/sermouse.c +++ b/drivers/input/mouse/sermouse.c | |||
@@ -69,7 +69,8 @@ static void sermouse_process_msc(struct sermouse *sermouse, signed char data) | |||
69 | switch (sermouse->count) { | 69 | switch (sermouse->count) { |
70 | 70 | ||
71 | case 0: | 71 | case 0: |
72 | if ((data & 0xf8) != 0x80) return; | 72 | if ((data & 0xf8) != 0x80) |
73 | return; | ||
73 | input_report_key(dev, BTN_LEFT, !(data & 4)); | 74 | input_report_key(dev, BTN_LEFT, !(data & 4)); |
74 | input_report_key(dev, BTN_RIGHT, !(data & 1)); | 75 | input_report_key(dev, BTN_RIGHT, !(data & 1)); |
75 | input_report_key(dev, BTN_MIDDLE, !(data & 2)); | 76 | input_report_key(dev, BTN_MIDDLE, !(data & 2)); |
@@ -107,7 +108,10 @@ static void sermouse_process_ms(struct sermouse *sermouse, signed char data) | |||
107 | struct input_dev *dev = sermouse->dev; | 108 | struct input_dev *dev = sermouse->dev; |
108 | signed char *buf = sermouse->buf; | 109 | signed char *buf = sermouse->buf; |
109 | 110 | ||
110 | if (data & 0x40) sermouse->count = 0; | 111 | if (data & 0x40) |
112 | sermouse->count = 0; | ||
113 | else if (sermouse->count == 0) | ||
114 | return; | ||
111 | 115 | ||
112 | switch (sermouse->count) { | 116 | switch (sermouse->count) { |
113 | 117 | ||
@@ -169,7 +173,8 @@ static void sermouse_process_ms(struct sermouse *sermouse, signed char data) | |||
169 | 173 | ||
170 | case 5: | 174 | case 5: |
171 | case 7: /* Ignore anything besides MZ++ */ | 175 | case 7: /* Ignore anything besides MZ++ */ |
172 | if (sermouse->type != SERIO_MZPP) break; | 176 | if (sermouse->type != SERIO_MZPP) |
177 | break; | ||
173 | 178 | ||
174 | switch (buf[1]) { | 179 | switch (buf[1]) { |
175 | 180 | ||
@@ -206,13 +211,16 @@ static irqreturn_t sermouse_interrupt(struct serio *serio, | |||
206 | { | 211 | { |
207 | struct sermouse *sermouse = serio_get_drvdata(serio); | 212 | struct sermouse *sermouse = serio_get_drvdata(serio); |
208 | 213 | ||
209 | if (time_after(jiffies, sermouse->last + HZ/10)) sermouse->count = 0; | 214 | if (time_after(jiffies, sermouse->last + HZ/10)) |
215 | sermouse->count = 0; | ||
216 | |||
210 | sermouse->last = jiffies; | 217 | sermouse->last = jiffies; |
211 | 218 | ||
212 | if (sermouse->type > SERIO_SUN) | 219 | if (sermouse->type > SERIO_SUN) |
213 | sermouse_process_ms(sermouse, data); | 220 | sermouse_process_ms(sermouse, data); |
214 | else | 221 | else |
215 | sermouse_process_msc(sermouse, data); | 222 | sermouse_process_msc(sermouse, data); |
223 | |||
216 | return IRQ_HANDLED; | 224 | return IRQ_HANDLED; |
217 | } | 225 | } |
218 | 226 | ||
@@ -258,12 +266,11 @@ static int sermouse_connect(struct serio *serio, struct serio_driver *drv) | |||
258 | input_dev->id.vendor = sermouse->type; | 266 | input_dev->id.vendor = sermouse->type; |
259 | input_dev->id.product = c; | 267 | input_dev->id.product = c; |
260 | input_dev->id.version = 0x0100; | 268 | input_dev->id.version = 0x0100; |
261 | input_dev->cdev.dev = &serio->dev; | 269 | input_dev->dev.parent = &serio->dev; |
262 | 270 | ||
263 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REL); | 271 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REL); |
264 | input_dev->keybit[LONG(BTN_MOUSE)] = BIT(BTN_LEFT) | BIT(BTN_RIGHT); | 272 | input_dev->keybit[LONG(BTN_MOUSE)] = BIT(BTN_LEFT) | BIT(BTN_RIGHT); |
265 | input_dev->relbit[0] = BIT(REL_X) | BIT(REL_Y); | 273 | input_dev->relbit[0] = BIT(REL_X) | BIT(REL_Y); |
266 | input_dev->private = sermouse; | ||
267 | 274 | ||
268 | if (c & 0x01) set_bit(BTN_MIDDLE, input_dev->keybit); | 275 | if (c & 0x01) set_bit(BTN_MIDDLE, input_dev->keybit); |
269 | if (c & 0x02) set_bit(BTN_SIDE, input_dev->keybit); | 276 | if (c & 0x02) set_bit(BTN_SIDE, input_dev->keybit); |
diff --git a/drivers/input/mouse/synaptics.c b/drivers/input/mouse/synaptics.c index f0f9413d762c..c77788bf932d 100644 --- a/drivers/input/mouse/synaptics.c +++ b/drivers/input/mouse/synaptics.c | |||
@@ -40,33 +40,70 @@ | |||
40 | #define YMIN_NOMINAL 1408 | 40 | #define YMIN_NOMINAL 1408 |
41 | #define YMAX_NOMINAL 4448 | 41 | #define YMAX_NOMINAL 4448 |
42 | 42 | ||
43 | |||
43 | /***************************************************************************** | 44 | /***************************************************************************** |
44 | * Synaptics communications functions | 45 | * Stuff we need even when we do not want native Synaptics support |
45 | ****************************************************************************/ | 46 | ****************************************************************************/ |
46 | 47 | ||
47 | /* | 48 | /* |
48 | * Send a command to the synpatics touchpad by special commands | 49 | * Set the synaptics touchpad mode byte by special commands |
49 | */ | 50 | */ |
50 | static int synaptics_send_cmd(struct psmouse *psmouse, unsigned char c, unsigned char *param) | 51 | static int synaptics_mode_cmd(struct psmouse *psmouse, unsigned char mode) |
51 | { | 52 | { |
52 | if (psmouse_sliced_command(psmouse, c)) | 53 | unsigned char param[1]; |
54 | |||
55 | if (psmouse_sliced_command(psmouse, mode)) | ||
53 | return -1; | 56 | return -1; |
54 | if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO)) | 57 | param[0] = SYN_PS_SET_MODE2; |
58 | if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_SETRATE)) | ||
55 | return -1; | 59 | return -1; |
56 | return 0; | 60 | return 0; |
57 | } | 61 | } |
58 | 62 | ||
63 | int synaptics_detect(struct psmouse *psmouse, int set_properties) | ||
64 | { | ||
65 | struct ps2dev *ps2dev = &psmouse->ps2dev; | ||
66 | unsigned char param[4]; | ||
67 | |||
68 | param[0] = 0; | ||
69 | |||
70 | ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); | ||
71 | ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); | ||
72 | ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); | ||
73 | ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); | ||
74 | ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); | ||
75 | |||
76 | if (param[1] != 0x47) | ||
77 | return -ENODEV; | ||
78 | |||
79 | if (set_properties) { | ||
80 | psmouse->vendor = "Synaptics"; | ||
81 | psmouse->name = "TouchPad"; | ||
82 | } | ||
83 | |||
84 | return 0; | ||
85 | } | ||
86 | |||
87 | void synaptics_reset(struct psmouse *psmouse) | ||
88 | { | ||
89 | /* reset touchpad back to relative mode, gestures enabled */ | ||
90 | synaptics_mode_cmd(psmouse, 0); | ||
91 | } | ||
92 | |||
93 | #ifdef CONFIG_MOUSE_PS2_SYNAPTICS | ||
94 | |||
95 | /***************************************************************************** | ||
96 | * Synaptics communications functions | ||
97 | ****************************************************************************/ | ||
98 | |||
59 | /* | 99 | /* |
60 | * Set the synaptics touchpad mode byte by special commands | 100 | * Send a command to the synpatics touchpad by special commands |
61 | */ | 101 | */ |
62 | static int synaptics_mode_cmd(struct psmouse *psmouse, unsigned char mode) | 102 | static int synaptics_send_cmd(struct psmouse *psmouse, unsigned char c, unsigned char *param) |
63 | { | 103 | { |
64 | unsigned char param[1]; | 104 | if (psmouse_sliced_command(psmouse, c)) |
65 | |||
66 | if (psmouse_sliced_command(psmouse, mode)) | ||
67 | return -1; | 105 | return -1; |
68 | param[0] = SYN_PS_SET_MODE2; | 106 | if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO)) |
69 | if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_SETRATE)) | ||
70 | return -1; | 107 | return -1; |
71 | return 0; | 108 | return 0; |
72 | } | 109 | } |
@@ -529,12 +566,6 @@ static void set_input_params(struct input_dev *dev, struct synaptics_data *priv) | |||
529 | clear_bit(REL_Y, dev->relbit); | 566 | clear_bit(REL_Y, dev->relbit); |
530 | } | 567 | } |
531 | 568 | ||
532 | void synaptics_reset(struct psmouse *psmouse) | ||
533 | { | ||
534 | /* reset touchpad back to relative mode, gestures enabled */ | ||
535 | synaptics_mode_cmd(psmouse, 0); | ||
536 | } | ||
537 | |||
538 | static void synaptics_disconnect(struct psmouse *psmouse) | 569 | static void synaptics_disconnect(struct psmouse *psmouse) |
539 | { | 570 | { |
540 | synaptics_reset(psmouse); | 571 | synaptics_reset(psmouse); |
@@ -569,30 +600,6 @@ static int synaptics_reconnect(struct psmouse *psmouse) | |||
569 | return 0; | 600 | return 0; |
570 | } | 601 | } |
571 | 602 | ||
572 | int synaptics_detect(struct psmouse *psmouse, int set_properties) | ||
573 | { | ||
574 | struct ps2dev *ps2dev = &psmouse->ps2dev; | ||
575 | unsigned char param[4]; | ||
576 | |||
577 | param[0] = 0; | ||
578 | |||
579 | ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); | ||
580 | ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); | ||
581 | ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); | ||
582 | ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); | ||
583 | ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); | ||
584 | |||
585 | if (param[1] != 0x47) | ||
586 | return -1; | ||
587 | |||
588 | if (set_properties) { | ||
589 | psmouse->vendor = "Synaptics"; | ||
590 | psmouse->name = "TouchPad"; | ||
591 | } | ||
592 | |||
593 | return 0; | ||
594 | } | ||
595 | |||
596 | #if defined(__i386__) | 603 | #if defined(__i386__) |
597 | #include <linux/dmi.h> | 604 | #include <linux/dmi.h> |
598 | static struct dmi_system_id toshiba_dmi_table[] = { | 605 | static struct dmi_system_id toshiba_dmi_table[] = { |
@@ -648,6 +655,16 @@ int synaptics_init(struct psmouse *psmouse) | |||
648 | 655 | ||
649 | set_input_params(psmouse->dev, priv); | 656 | set_input_params(psmouse->dev, priv); |
650 | 657 | ||
658 | /* | ||
659 | * Encode touchpad model so that it can be used to set | ||
660 | * input device->id.version and be visible to userspace. | ||
661 | * Because version is __u16 we have to drop something. | ||
662 | * Hardware info bits seem to be good candidates as they | ||
663 | * are documented to be for Synaptics corp. internal use. | ||
664 | */ | ||
665 | psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) | | ||
666 | (priv->model_id & 0x000000ff); | ||
667 | |||
651 | psmouse->protocol_handler = synaptics_process_byte; | 668 | psmouse->protocol_handler = synaptics_process_byte; |
652 | psmouse->set_rate = synaptics_set_rate; | 669 | psmouse->set_rate = synaptics_set_rate; |
653 | psmouse->disconnect = synaptics_disconnect; | 670 | psmouse->disconnect = synaptics_disconnect; |
@@ -680,4 +697,12 @@ int synaptics_init(struct psmouse *psmouse) | |||
680 | return -1; | 697 | return -1; |
681 | } | 698 | } |
682 | 699 | ||
700 | #else /* CONFIG_MOUSE_PS2_SYNAPTICS */ | ||
701 | |||
702 | int synaptics_init(struct psmouse *psmouse) | ||
703 | { | ||
704 | return -ENOSYS; | ||
705 | } | ||
706 | |||
707 | #endif /* CONFIG_MOUSE_PS2_SYNAPTICS */ | ||
683 | 708 | ||
diff --git a/drivers/input/mouse/synaptics.h b/drivers/input/mouse/synaptics.h index 68fff1dcd7de..02aa4cf7bc77 100644 --- a/drivers/input/mouse/synaptics.h +++ b/drivers/input/mouse/synaptics.h | |||
@@ -9,10 +9,6 @@ | |||
9 | #ifndef _SYNAPTICS_H | 9 | #ifndef _SYNAPTICS_H |
10 | #define _SYNAPTICS_H | 10 | #define _SYNAPTICS_H |
11 | 11 | ||
12 | extern int synaptics_detect(struct psmouse *psmouse, int set_properties); | ||
13 | extern int synaptics_init(struct psmouse *psmouse); | ||
14 | extern void synaptics_reset(struct psmouse *psmouse); | ||
15 | |||
16 | /* synaptics queries */ | 12 | /* synaptics queries */ |
17 | #define SYN_QUE_IDENTIFY 0x00 | 13 | #define SYN_QUE_IDENTIFY 0x00 |
18 | #define SYN_QUE_MODES 0x01 | 14 | #define SYN_QUE_MODES 0x01 |
@@ -62,9 +58,9 @@ extern void synaptics_reset(struct psmouse *psmouse); | |||
62 | #define SYN_MODE_WMODE(m) ((m) & (1 << 0)) | 58 | #define SYN_MODE_WMODE(m) ((m) & (1 << 0)) |
63 | 59 | ||
64 | /* synaptics identify query bits */ | 60 | /* synaptics identify query bits */ |
65 | #define SYN_ID_MODEL(i) (((i) >> 4) & 0x0f) | 61 | #define SYN_ID_MODEL(i) (((i) >> 4) & 0x0f) |
66 | #define SYN_ID_MAJOR(i) ((i) & 0x0f) | 62 | #define SYN_ID_MAJOR(i) ((i) & 0x0f) |
67 | #define SYN_ID_MINOR(i) (((i) >> 16) & 0xff) | 63 | #define SYN_ID_MINOR(i) (((i) >> 16) & 0xff) |
68 | #define SYN_ID_IS_SYNAPTICS(i) ((((i) >> 8) & 0xff) == 0x47) | 64 | #define SYN_ID_IS_SYNAPTICS(i) ((((i) >> 8) & 0xff) == 0x47) |
69 | 65 | ||
70 | /* synaptics special commands */ | 66 | /* synaptics special commands */ |
@@ -98,8 +94,8 @@ struct synaptics_hw_state { | |||
98 | struct synaptics_data { | 94 | struct synaptics_data { |
99 | /* Data read from the touchpad */ | 95 | /* Data read from the touchpad */ |
100 | unsigned long int model_id; /* Model-ID */ | 96 | unsigned long int model_id; /* Model-ID */ |
101 | unsigned long int capabilities; /* Capabilities */ | 97 | unsigned long int capabilities; /* Capabilities */ |
102 | unsigned long int ext_cap; /* Extended Capabilities */ | 98 | unsigned long int ext_cap; /* Extended Capabilities */ |
103 | unsigned long int identity; /* Identification */ | 99 | unsigned long int identity; /* Identification */ |
104 | 100 | ||
105 | unsigned char pkt_type; /* packet type - old, new, etc */ | 101 | unsigned char pkt_type; /* packet type - old, new, etc */ |
@@ -107,4 +103,8 @@ struct synaptics_data { | |||
107 | int scroll; | 103 | int scroll; |
108 | }; | 104 | }; |
109 | 105 | ||
106 | int synaptics_detect(struct psmouse *psmouse, int set_properties); | ||
107 | int synaptics_init(struct psmouse *psmouse); | ||
108 | void synaptics_reset(struct psmouse *psmouse); | ||
109 | |||
110 | #endif /* _SYNAPTICS_H */ | 110 | #endif /* _SYNAPTICS_H */ |
diff --git a/drivers/input/mouse/touchkit_ps2.c b/drivers/input/mouse/touchkit_ps2.c new file mode 100644 index 000000000000..7b977fd23571 --- /dev/null +++ b/drivers/input/mouse/touchkit_ps2.c | |||
@@ -0,0 +1,100 @@ | |||
1 | /* ---------------------------------------------------------------------------- | ||
2 | * touchkit_ps2.c -- Driver for eGalax TouchKit PS/2 Touchscreens | ||
3 | * | ||
4 | * Copyright (C) 2005 by Stefan Lucke | ||
5 | * Copyright (C) 2004 by Daniel Ritz | ||
6 | * Copyright (C) by Todd E. Johnson (mtouchusb.c) | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or | ||
9 | * modify it under the terms of the GNU General Public License as | ||
10 | * published by the Free Software Foundation; either version 2 of the | ||
11 | * License, or (at your option) any later version. | ||
12 | * | ||
13 | * This program is distributed in the hope that it will be useful, but | ||
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
16 | * General Public License for more details. | ||
17 | * | ||
18 | * You should have received a copy of the GNU General Public License | ||
19 | * along with this program; if not, write to the Free Software | ||
20 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
21 | * | ||
22 | * Based upon touchkitusb.c | ||
23 | * | ||
24 | * Vendor documentation is available in support section of: | ||
25 | * http://www.egalax.com.tw/ | ||
26 | */ | ||
27 | |||
28 | #include <linux/kernel.h> | ||
29 | #include <linux/slab.h> | ||
30 | |||
31 | #include <linux/input.h> | ||
32 | #include <linux/serio.h> | ||
33 | #include <linux/libps2.h> | ||
34 | |||
35 | #include "psmouse.h" | ||
36 | #include "touchkit_ps2.h" | ||
37 | |||
38 | #define TOUCHKIT_MAX_XC 0x07ff | ||
39 | #define TOUCHKIT_MAX_YC 0x07ff | ||
40 | |||
41 | #define TOUCHKIT_CMD 0x0a | ||
42 | #define TOUCHKIT_CMD_LENGTH 1 | ||
43 | |||
44 | #define TOUCHKIT_CMD_ACTIVE 'A' | ||
45 | #define TOUCHKIT_CMD_FIRMWARE_VERSION 'D' | ||
46 | #define TOUCHKIT_CMD_CONTROLLER_TYPE 'E' | ||
47 | |||
48 | #define TOUCHKIT_SEND_PARMS(s, r, c) ((s) << 12 | (r) << 8 | (c)) | ||
49 | |||
50 | #define TOUCHKIT_GET_TOUCHED(packet) (((packet)[0]) & 0x01) | ||
51 | #define TOUCHKIT_GET_X(packet) (((packet)[1] << 7) | (packet)[2]) | ||
52 | #define TOUCHKIT_GET_Y(packet) (((packet)[3] << 7) | (packet)[4]) | ||
53 | |||
54 | static psmouse_ret_t touchkit_ps2_process_byte(struct psmouse *psmouse) | ||
55 | { | ||
56 | unsigned char *packet = psmouse->packet; | ||
57 | struct input_dev *dev = psmouse->dev; | ||
58 | |||
59 | if (psmouse->pktcnt != 5) | ||
60 | return PSMOUSE_GOOD_DATA; | ||
61 | |||
62 | input_report_abs(dev, ABS_X, TOUCHKIT_GET_X(packet)); | ||
63 | input_report_abs(dev, ABS_Y, TOUCHKIT_GET_Y(packet)); | ||
64 | input_report_key(dev, BTN_TOUCH, TOUCHKIT_GET_TOUCHED(packet)); | ||
65 | input_sync(dev); | ||
66 | |||
67 | return PSMOUSE_FULL_PACKET; | ||
68 | } | ||
69 | |||
70 | int touchkit_ps2_detect(struct psmouse *psmouse, int set_properties) | ||
71 | { | ||
72 | struct input_dev *dev = psmouse->dev; | ||
73 | unsigned char param[3]; | ||
74 | int command; | ||
75 | |||
76 | param[0] = TOUCHKIT_CMD_LENGTH; | ||
77 | param[1] = TOUCHKIT_CMD_ACTIVE; | ||
78 | command = TOUCHKIT_SEND_PARMS(2, 3, TOUCHKIT_CMD); | ||
79 | |||
80 | if (ps2_command(&psmouse->ps2dev, param, command)) | ||
81 | return -ENODEV; | ||
82 | |||
83 | if (param[0] != TOUCHKIT_CMD || param[1] != 0x01 || | ||
84 | param[2] != TOUCHKIT_CMD_ACTIVE) | ||
85 | return -ENODEV; | ||
86 | |||
87 | if (set_properties) { | ||
88 | dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | ||
89 | set_bit(BTN_TOUCH, dev->keybit); | ||
90 | input_set_abs_params(dev, ABS_X, 0, TOUCHKIT_MAX_XC, 0, 0); | ||
91 | input_set_abs_params(dev, ABS_Y, 0, TOUCHKIT_MAX_YC, 0, 0); | ||
92 | |||
93 | psmouse->vendor = "eGalax"; | ||
94 | psmouse->name = "Touchscreen"; | ||
95 | psmouse->protocol_handler = touchkit_ps2_process_byte; | ||
96 | psmouse->pktsize = 5; | ||
97 | } | ||
98 | |||
99 | return 0; | ||
100 | } | ||
diff --git a/drivers/input/mouse/touchkit_ps2.h b/drivers/input/mouse/touchkit_ps2.h new file mode 100644 index 000000000000..61e9dfd8419f --- /dev/null +++ b/drivers/input/mouse/touchkit_ps2.h | |||
@@ -0,0 +1,24 @@ | |||
1 | /* ---------------------------------------------------------------------------- | ||
2 | * touchkit_ps2.h -- Driver for eGalax TouchKit PS/2 Touchscreens | ||
3 | * | ||
4 | * Copyright (C) 2005 by Stefan Lucke | ||
5 | * Copyright (c) 2005 Vojtech Pavlik | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or modify it | ||
8 | * under the terms of the GNU General Public License version 2 as published by | ||
9 | * the Free Software Foundation. | ||
10 | */ | ||
11 | |||
12 | #ifndef _TOUCHKIT_PS2_H | ||
13 | #define _TOUCHKIT_PS2_H | ||
14 | |||
15 | #ifdef CONFIG_MOUSE_PS2_TOUCHKIT | ||
16 | int touchkit_ps2_detect(struct psmouse *psmouse, int set_properties); | ||
17 | #else | ||
18 | inline int touchkit_ps2_detect(struct psmouse *psmouse, int set_properties) | ||
19 | { | ||
20 | return -ENOSYS; | ||
21 | } | ||
22 | #endif /* CONFIG_MOUSE_PS2_TOUCHKIT */ | ||
23 | |||
24 | #endif | ||
diff --git a/drivers/input/mouse/trackpoint.h b/drivers/input/mouse/trackpoint.h index 050298b1a09d..c10a6e7d0101 100644 --- a/drivers/input/mouse/trackpoint.h +++ b/drivers/input/mouse/trackpoint.h | |||
@@ -142,6 +142,13 @@ struct trackpoint_data | |||
142 | unsigned char ext_dev; | 142 | unsigned char ext_dev; |
143 | }; | 143 | }; |
144 | 144 | ||
145 | extern int trackpoint_detect(struct psmouse *psmouse, int set_properties); | 145 | #ifdef CONFIG_MOUSE_PS2_TRACKPOINT |
146 | int trackpoint_detect(struct psmouse *psmouse, int set_properties); | ||
147 | #else | ||
148 | inline int trackpoint_detect(struct psmouse *psmouse, int set_properties) | ||
149 | { | ||
150 | return -ENOSYS; | ||
151 | } | ||
152 | #endif /* CONFIG_MOUSE_PS2_TRACKPOINT */ | ||
146 | 153 | ||
147 | #endif /* _TRACKPOINT_H */ | 154 | #endif /* _TRACKPOINT_H */ |
diff --git a/drivers/input/mouse/vsxxxaa.c b/drivers/input/mouse/vsxxxaa.c index c3d64fcc858d..4a321576f345 100644 --- a/drivers/input/mouse/vsxxxaa.c +++ b/drivers/input/mouse/vsxxxaa.c | |||
@@ -508,8 +508,7 @@ vsxxxaa_connect (struct serio *serio, struct serio_driver *drv) | |||
508 | input_dev->name = mouse->name; | 508 | input_dev->name = mouse->name; |
509 | input_dev->phys = mouse->phys; | 509 | input_dev->phys = mouse->phys; |
510 | input_dev->id.bustype = BUS_RS232; | 510 | input_dev->id.bustype = BUS_RS232; |
511 | input_dev->cdev.dev = &serio->dev; | 511 | input_dev->dev.parent = &serio->dev; |
512 | input_dev->private = mouse; | ||
513 | 512 | ||
514 | set_bit (EV_KEY, input_dev->evbit); /* We have buttons */ | 513 | set_bit (EV_KEY, input_dev->evbit); /* We have buttons */ |
515 | set_bit (EV_REL, input_dev->evbit); | 514 | set_bit (EV_REL, input_dev->evbit); |
diff --git a/drivers/input/mousedev.c b/drivers/input/mousedev.c index 074fee429d1b..7678e9876550 100644 --- a/drivers/input/mousedev.c +++ b/drivers/input/mousedev.c | |||
@@ -63,9 +63,12 @@ struct mousedev { | |||
63 | int minor; | 63 | int minor; |
64 | char name[16]; | 64 | char name[16]; |
65 | wait_queue_head_t wait; | 65 | wait_queue_head_t wait; |
66 | struct list_head list; | 66 | struct list_head client_list; |
67 | struct input_handle handle; | 67 | struct input_handle handle; |
68 | 68 | ||
69 | struct list_head mixdev_node; | ||
70 | int mixdev_open; | ||
71 | |||
69 | struct mousedev_hw_data packet; | 72 | struct mousedev_hw_data packet; |
70 | unsigned int pkt_count; | 73 | unsigned int pkt_count; |
71 | int old_x[4], old_y[4]; | 74 | int old_x[4], old_y[4]; |
@@ -85,7 +88,7 @@ struct mousedev_motion { | |||
85 | }; | 88 | }; |
86 | 89 | ||
87 | #define PACKET_QUEUE_LEN 16 | 90 | #define PACKET_QUEUE_LEN 16 |
88 | struct mousedev_list { | 91 | struct mousedev_client { |
89 | struct fasync_struct *fasync; | 92 | struct fasync_struct *fasync; |
90 | struct mousedev *mousedev; | 93 | struct mousedev *mousedev; |
91 | struct list_head node; | 94 | struct list_head node; |
@@ -111,6 +114,7 @@ static struct input_handler mousedev_handler; | |||
111 | 114 | ||
112 | static struct mousedev *mousedev_table[MOUSEDEV_MINORS]; | 115 | static struct mousedev *mousedev_table[MOUSEDEV_MINORS]; |
113 | static struct mousedev mousedev_mix; | 116 | static struct mousedev mousedev_mix; |
117 | static LIST_HEAD(mousedev_mix_list); | ||
114 | 118 | ||
115 | #define fx(i) (mousedev->old_x[(mousedev->pkt_count - (i)) & 03]) | 119 | #define fx(i) (mousedev->old_x[(mousedev->pkt_count - (i)) & 03]) |
116 | #define fy(i) (mousedev->old_y[(mousedev->pkt_count - (i)) & 03]) | 120 | #define fy(i) (mousedev->old_y[(mousedev->pkt_count - (i)) & 03]) |
@@ -120,32 +124,33 @@ static void mousedev_touchpad_event(struct input_dev *dev, struct mousedev *mous | |||
120 | int size, tmp; | 124 | int size, tmp; |
121 | enum { FRACTION_DENOM = 128 }; | 125 | enum { FRACTION_DENOM = 128 }; |
122 | 126 | ||
123 | if (mousedev->touch) { | 127 | switch (code) { |
124 | size = dev->absmax[ABS_X] - dev->absmin[ABS_X]; | 128 | case ABS_X: |
125 | if (size == 0) | 129 | fx(0) = value; |
126 | size = 256 * 2; | 130 | if (mousedev->touch && mousedev->pkt_count >= 2) { |
127 | 131 | size = dev->absmax[ABS_X] - dev->absmin[ABS_X]; | |
128 | switch (code) { | 132 | if (size == 0) |
129 | case ABS_X: | 133 | size = 256 * 2; |
130 | fx(0) = value; | 134 | tmp = ((value - fx(2)) * (256 * FRACTION_DENOM)) / size; |
131 | if (mousedev->pkt_count >= 2) { | 135 | tmp += mousedev->frac_dx; |
132 | tmp = ((value - fx(2)) * (256 * FRACTION_DENOM)) / size; | 136 | mousedev->packet.dx = tmp / FRACTION_DENOM; |
133 | tmp += mousedev->frac_dx; | 137 | mousedev->frac_dx = tmp - mousedev->packet.dx * FRACTION_DENOM; |
134 | mousedev->packet.dx = tmp / FRACTION_DENOM; | 138 | } |
135 | mousedev->frac_dx = tmp - mousedev->packet.dx * FRACTION_DENOM; | 139 | break; |
136 | } | ||
137 | break; | ||
138 | 140 | ||
139 | case ABS_Y: | 141 | case ABS_Y: |
140 | fy(0) = value; | 142 | fy(0) = value; |
141 | if (mousedev->pkt_count >= 2) { | 143 | if (mousedev->touch && mousedev->pkt_count >= 2) { |
142 | tmp = -((value - fy(2)) * (256 * FRACTION_DENOM)) / size; | 144 | /* use X size to keep the same scale */ |
143 | tmp += mousedev->frac_dy; | 145 | size = dev->absmax[ABS_X] - dev->absmin[ABS_X]; |
144 | mousedev->packet.dy = tmp / FRACTION_DENOM; | 146 | if (size == 0) |
145 | mousedev->frac_dy = tmp - mousedev->packet.dy * FRACTION_DENOM; | 147 | size = 256 * 2; |
146 | } | 148 | tmp = -((value - fy(2)) * (256 * FRACTION_DENOM)) / size; |
147 | break; | 149 | tmp += mousedev->frac_dy; |
148 | } | 150 | mousedev->packet.dy = tmp / FRACTION_DENOM; |
151 | mousedev->frac_dy = tmp - mousedev->packet.dy * FRACTION_DENOM; | ||
152 | } | ||
153 | break; | ||
149 | } | 154 | } |
150 | } | 155 | } |
151 | 156 | ||
@@ -223,47 +228,47 @@ static void mousedev_key_event(struct mousedev *mousedev, unsigned int code, int | |||
223 | 228 | ||
224 | static void mousedev_notify_readers(struct mousedev *mousedev, struct mousedev_hw_data *packet) | 229 | static void mousedev_notify_readers(struct mousedev *mousedev, struct mousedev_hw_data *packet) |
225 | { | 230 | { |
226 | struct mousedev_list *list; | 231 | struct mousedev_client *client; |
227 | struct mousedev_motion *p; | 232 | struct mousedev_motion *p; |
228 | unsigned long flags; | 233 | unsigned long flags; |
229 | int wake_readers = 0; | 234 | int wake_readers = 0; |
230 | 235 | ||
231 | list_for_each_entry(list, &mousedev->list, node) { | 236 | list_for_each_entry(client, &mousedev->client_list, node) { |
232 | spin_lock_irqsave(&list->packet_lock, flags); | 237 | spin_lock_irqsave(&client->packet_lock, flags); |
233 | 238 | ||
234 | p = &list->packets[list->head]; | 239 | p = &client->packets[client->head]; |
235 | if (list->ready && p->buttons != mousedev->packet.buttons) { | 240 | if (client->ready && p->buttons != mousedev->packet.buttons) { |
236 | unsigned int new_head = (list->head + 1) % PACKET_QUEUE_LEN; | 241 | unsigned int new_head = (client->head + 1) % PACKET_QUEUE_LEN; |
237 | if (new_head != list->tail) { | 242 | if (new_head != client->tail) { |
238 | p = &list->packets[list->head = new_head]; | 243 | p = &client->packets[client->head = new_head]; |
239 | memset(p, 0, sizeof(struct mousedev_motion)); | 244 | memset(p, 0, sizeof(struct mousedev_motion)); |
240 | } | 245 | } |
241 | } | 246 | } |
242 | 247 | ||
243 | if (packet->abs_event) { | 248 | if (packet->abs_event) { |
244 | p->dx += packet->x - list->pos_x; | 249 | p->dx += packet->x - client->pos_x; |
245 | p->dy += packet->y - list->pos_y; | 250 | p->dy += packet->y - client->pos_y; |
246 | list->pos_x = packet->x; | 251 | client->pos_x = packet->x; |
247 | list->pos_y = packet->y; | 252 | client->pos_y = packet->y; |
248 | } | 253 | } |
249 | 254 | ||
250 | list->pos_x += packet->dx; | 255 | client->pos_x += packet->dx; |
251 | list->pos_x = list->pos_x < 0 ? 0 : (list->pos_x >= xres ? xres : list->pos_x); | 256 | client->pos_x = client->pos_x < 0 ? 0 : (client->pos_x >= xres ? xres : client->pos_x); |
252 | list->pos_y += packet->dy; | 257 | client->pos_y += packet->dy; |
253 | list->pos_y = list->pos_y < 0 ? 0 : (list->pos_y >= yres ? yres : list->pos_y); | 258 | client->pos_y = client->pos_y < 0 ? 0 : (client->pos_y >= yres ? yres : client->pos_y); |
254 | 259 | ||
255 | p->dx += packet->dx; | 260 | p->dx += packet->dx; |
256 | p->dy += packet->dy; | 261 | p->dy += packet->dy; |
257 | p->dz += packet->dz; | 262 | p->dz += packet->dz; |
258 | p->buttons = mousedev->packet.buttons; | 263 | p->buttons = mousedev->packet.buttons; |
259 | 264 | ||
260 | if (p->dx || p->dy || p->dz || p->buttons != list->last_buttons) | 265 | if (p->dx || p->dy || p->dz || p->buttons != client->last_buttons) |
261 | list->ready = 1; | 266 | client->ready = 1; |
262 | 267 | ||
263 | spin_unlock_irqrestore(&list->packet_lock, flags); | 268 | spin_unlock_irqrestore(&client->packet_lock, flags); |
264 | 269 | ||
265 | if (list->ready) { | 270 | if (client->ready) { |
266 | kill_fasync(&list->fasync, SIGIO, POLL_IN); | 271 | kill_fasync(&client->fasync, SIGIO, POLL_IN); |
267 | wake_readers = 1; | 272 | wake_readers = 1; |
268 | } | 273 | } |
269 | } | 274 | } |
@@ -351,9 +356,9 @@ static void mousedev_event(struct input_handle *handle, unsigned int type, unsig | |||
351 | static int mousedev_fasync(int fd, struct file *file, int on) | 356 | static int mousedev_fasync(int fd, struct file *file, int on) |
352 | { | 357 | { |
353 | int retval; | 358 | int retval; |
354 | struct mousedev_list *list = file->private_data; | 359 | struct mousedev_client *client = file->private_data; |
355 | 360 | ||
356 | retval = fasync_helper(fd, file, on, &list->fasync); | 361 | retval = fasync_helper(fd, file, on, &client->fasync); |
357 | 362 | ||
358 | return retval < 0 ? retval : 0; | 363 | return retval < 0 ? retval : 0; |
359 | } | 364 | } |
@@ -364,50 +369,95 @@ static void mousedev_free(struct mousedev *mousedev) | |||
364 | kfree(mousedev); | 369 | kfree(mousedev); |
365 | } | 370 | } |
366 | 371 | ||
367 | static void mixdev_release(void) | 372 | static int mixdev_add_device(struct mousedev *mousedev) |
368 | { | 373 | { |
369 | struct input_handle *handle; | 374 | int error; |
370 | 375 | ||
371 | list_for_each_entry(handle, &mousedev_handler.h_list, h_node) { | 376 | if (mousedev_mix.open) { |
372 | struct mousedev *mousedev = handle->private; | 377 | error = input_open_device(&mousedev->handle); |
378 | if (error) | ||
379 | return error; | ||
373 | 380 | ||
374 | if (!mousedev->open) { | 381 | mousedev->open++; |
375 | if (mousedev->exist) | 382 | mousedev->mixdev_open++; |
376 | input_close_device(&mousedev->handle); | 383 | } |
377 | else | 384 | |
378 | mousedev_free(mousedev); | 385 | list_add_tail(&mousedev->mixdev_node, &mousedev_mix_list); |
386 | |||
387 | return 0; | ||
388 | } | ||
389 | |||
390 | static void mixdev_remove_device(struct mousedev *mousedev) | ||
391 | { | ||
392 | if (mousedev->mixdev_open) { | ||
393 | mousedev->mixdev_open = 0; | ||
394 | if (!--mousedev->open && mousedev->exist) | ||
395 | input_close_device(&mousedev->handle); | ||
396 | } | ||
397 | |||
398 | list_del_init(&mousedev->mixdev_node); | ||
399 | } | ||
400 | |||
401 | static void mixdev_open_devices(void) | ||
402 | { | ||
403 | struct mousedev *mousedev; | ||
404 | |||
405 | list_for_each_entry(mousedev, &mousedev_mix_list, mixdev_node) { | ||
406 | if (mousedev->exist && !mousedev->open) { | ||
407 | if (input_open_device(&mousedev->handle)) | ||
408 | continue; | ||
409 | |||
410 | mousedev->open++; | ||
411 | mousedev->mixdev_open++; | ||
379 | } | 412 | } |
380 | } | 413 | } |
381 | } | 414 | } |
382 | 415 | ||
383 | static int mousedev_release(struct inode * inode, struct file * file) | 416 | static void mixdev_close_devices(void) |
384 | { | 417 | { |
385 | struct mousedev_list *list = file->private_data; | 418 | struct mousedev *mousedev, *next; |
419 | |||
420 | list_for_each_entry_safe(mousedev, next, &mousedev_mix_list, mixdev_node) { | ||
421 | if (mousedev->mixdev_open) { | ||
422 | mousedev->mixdev_open = 0; | ||
423 | if (!--mousedev->open) { | ||
424 | if (mousedev->exist) | ||
425 | input_close_device(&mousedev->handle); | ||
426 | else | ||
427 | mousedev_free(mousedev); | ||
428 | } | ||
429 | } | ||
430 | } | ||
431 | } | ||
432 | |||
433 | static int mousedev_release(struct inode *inode, struct file *file) | ||
434 | { | ||
435 | struct mousedev_client *client = file->private_data; | ||
436 | struct mousedev *mousedev = client->mousedev; | ||
386 | 437 | ||
387 | mousedev_fasync(-1, file, 0); | 438 | mousedev_fasync(-1, file, 0); |
388 | 439 | ||
389 | list_del(&list->node); | 440 | list_del(&client->node); |
441 | kfree(client); | ||
390 | 442 | ||
391 | if (!--list->mousedev->open) { | 443 | if (!--mousedev->open) { |
392 | if (list->mousedev->minor == MOUSEDEV_MIX) | 444 | if (mousedev->minor == MOUSEDEV_MIX) |
393 | mixdev_release(); | 445 | mixdev_close_devices(); |
394 | else if (!mousedev_mix.open) { | 446 | else if (mousedev->exist) |
395 | if (list->mousedev->exist) | 447 | input_close_device(&mousedev->handle); |
396 | input_close_device(&list->mousedev->handle); | 448 | else |
397 | else | 449 | mousedev_free(mousedev); |
398 | mousedev_free(list->mousedev); | ||
399 | } | ||
400 | } | 450 | } |
401 | 451 | ||
402 | kfree(list); | ||
403 | return 0; | 452 | return 0; |
404 | } | 453 | } |
405 | 454 | ||
406 | static int mousedev_open(struct inode * inode, struct file * file) | 455 | |
456 | static int mousedev_open(struct inode *inode, struct file *file) | ||
407 | { | 457 | { |
408 | struct mousedev_list *list; | 458 | struct mousedev_client *client; |
409 | struct input_handle *handle; | ||
410 | struct mousedev *mousedev; | 459 | struct mousedev *mousedev; |
460 | int error; | ||
411 | int i; | 461 | int i; |
412 | 462 | ||
413 | #ifdef CONFIG_INPUT_MOUSEDEV_PSAUX | 463 | #ifdef CONFIG_INPUT_MOUSEDEV_PSAUX |
@@ -417,31 +467,37 @@ static int mousedev_open(struct inode * inode, struct file * file) | |||
417 | #endif | 467 | #endif |
418 | i = iminor(inode) - MOUSEDEV_MINOR_BASE; | 468 | i = iminor(inode) - MOUSEDEV_MINOR_BASE; |
419 | 469 | ||
420 | if (i >= MOUSEDEV_MINORS || !mousedev_table[i]) | 470 | if (i >= MOUSEDEV_MINORS) |
421 | return -ENODEV; | 471 | return -ENODEV; |
422 | 472 | ||
423 | if (!(list = kzalloc(sizeof(struct mousedev_list), GFP_KERNEL))) | 473 | mousedev = mousedev_table[i]; |
474 | if (!mousedev) | ||
475 | return -ENODEV; | ||
476 | |||
477 | client = kzalloc(sizeof(struct mousedev_client), GFP_KERNEL); | ||
478 | if (!client) | ||
424 | return -ENOMEM; | 479 | return -ENOMEM; |
425 | 480 | ||
426 | spin_lock_init(&list->packet_lock); | 481 | spin_lock_init(&client->packet_lock); |
427 | list->pos_x = xres / 2; | 482 | client->pos_x = xres / 2; |
428 | list->pos_y = yres / 2; | 483 | client->pos_y = yres / 2; |
429 | list->mousedev = mousedev_table[i]; | 484 | client->mousedev = mousedev; |
430 | list_add_tail(&list->node, &mousedev_table[i]->list); | 485 | list_add_tail(&client->node, &mousedev->client_list); |
431 | file->private_data = list; | 486 | |
432 | 487 | if (!mousedev->open++) { | |
433 | if (!list->mousedev->open++) { | 488 | if (mousedev->minor == MOUSEDEV_MIX) |
434 | if (list->mousedev->minor == MOUSEDEV_MIX) { | 489 | mixdev_open_devices(); |
435 | list_for_each_entry(handle, &mousedev_handler.h_list, h_node) { | 490 | else if (mousedev->exist) { |
436 | mousedev = handle->private; | 491 | error = input_open_device(&mousedev->handle); |
437 | if (!mousedev->open && mousedev->exist) | 492 | if (error) { |
438 | input_open_device(handle); | 493 | list_del(&client->node); |
494 | kfree(client); | ||
495 | return error; | ||
439 | } | 496 | } |
440 | } else | 497 | } |
441 | if (!mousedev_mix.open && list->mousedev->exist) | ||
442 | input_open_device(&list->mousedev->handle); | ||
443 | } | 498 | } |
444 | 499 | ||
500 | file->private_data = client; | ||
445 | return 0; | 501 | return 0; |
446 | } | 502 | } |
447 | 503 | ||
@@ -450,13 +506,13 @@ static inline int mousedev_limit_delta(int delta, int limit) | |||
450 | return delta > limit ? limit : (delta < -limit ? -limit : delta); | 506 | return delta > limit ? limit : (delta < -limit ? -limit : delta); |
451 | } | 507 | } |
452 | 508 | ||
453 | static void mousedev_packet(struct mousedev_list *list, signed char *ps2_data) | 509 | static void mousedev_packet(struct mousedev_client *client, signed char *ps2_data) |
454 | { | 510 | { |
455 | struct mousedev_motion *p; | 511 | struct mousedev_motion *p; |
456 | unsigned long flags; | 512 | unsigned long flags; |
457 | 513 | ||
458 | spin_lock_irqsave(&list->packet_lock, flags); | 514 | spin_lock_irqsave(&client->packet_lock, flags); |
459 | p = &list->packets[list->tail]; | 515 | p = &client->packets[client->tail]; |
460 | 516 | ||
461 | ps2_data[0] = 0x08 | ((p->dx < 0) << 4) | ((p->dy < 0) << 5) | (p->buttons & 0x07); | 517 | ps2_data[0] = 0x08 | ((p->dx < 0) << 4) | ((p->dy < 0) << 5) | (p->buttons & 0x07); |
462 | ps2_data[1] = mousedev_limit_delta(p->dx, 127); | 518 | ps2_data[1] = mousedev_limit_delta(p->dx, 127); |
@@ -464,44 +520,44 @@ static void mousedev_packet(struct mousedev_list *list, signed char *ps2_data) | |||
464 | p->dx -= ps2_data[1]; | 520 | p->dx -= ps2_data[1]; |
465 | p->dy -= ps2_data[2]; | 521 | p->dy -= ps2_data[2]; |
466 | 522 | ||
467 | switch (list->mode) { | 523 | switch (client->mode) { |
468 | case MOUSEDEV_EMUL_EXPS: | 524 | case MOUSEDEV_EMUL_EXPS: |
469 | ps2_data[3] = mousedev_limit_delta(p->dz, 7); | 525 | ps2_data[3] = mousedev_limit_delta(p->dz, 7); |
470 | p->dz -= ps2_data[3]; | 526 | p->dz -= ps2_data[3]; |
471 | ps2_data[3] = (ps2_data[3] & 0x0f) | ((p->buttons & 0x18) << 1); | 527 | ps2_data[3] = (ps2_data[3] & 0x0f) | ((p->buttons & 0x18) << 1); |
472 | list->bufsiz = 4; | 528 | client->bufsiz = 4; |
473 | break; | 529 | break; |
474 | 530 | ||
475 | case MOUSEDEV_EMUL_IMPS: | 531 | case MOUSEDEV_EMUL_IMPS: |
476 | ps2_data[0] |= ((p->buttons & 0x10) >> 3) | ((p->buttons & 0x08) >> 1); | 532 | ps2_data[0] |= ((p->buttons & 0x10) >> 3) | ((p->buttons & 0x08) >> 1); |
477 | ps2_data[3] = mousedev_limit_delta(p->dz, 127); | 533 | ps2_data[3] = mousedev_limit_delta(p->dz, 127); |
478 | p->dz -= ps2_data[3]; | 534 | p->dz -= ps2_data[3]; |
479 | list->bufsiz = 4; | 535 | client->bufsiz = 4; |
480 | break; | 536 | break; |
481 | 537 | ||
482 | case MOUSEDEV_EMUL_PS2: | 538 | case MOUSEDEV_EMUL_PS2: |
483 | default: | 539 | default: |
484 | ps2_data[0] |= ((p->buttons & 0x10) >> 3) | ((p->buttons & 0x08) >> 1); | 540 | ps2_data[0] |= ((p->buttons & 0x10) >> 3) | ((p->buttons & 0x08) >> 1); |
485 | p->dz = 0; | 541 | p->dz = 0; |
486 | list->bufsiz = 3; | 542 | client->bufsiz = 3; |
487 | break; | 543 | break; |
488 | } | 544 | } |
489 | 545 | ||
490 | if (!p->dx && !p->dy && !p->dz) { | 546 | if (!p->dx && !p->dy && !p->dz) { |
491 | if (list->tail == list->head) { | 547 | if (client->tail == client->head) { |
492 | list->ready = 0; | 548 | client->ready = 0; |
493 | list->last_buttons = p->buttons; | 549 | client->last_buttons = p->buttons; |
494 | } else | 550 | } else |
495 | list->tail = (list->tail + 1) % PACKET_QUEUE_LEN; | 551 | client->tail = (client->tail + 1) % PACKET_QUEUE_LEN; |
496 | } | 552 | } |
497 | 553 | ||
498 | spin_unlock_irqrestore(&list->packet_lock, flags); | 554 | spin_unlock_irqrestore(&client->packet_lock, flags); |
499 | } | 555 | } |
500 | 556 | ||
501 | 557 | ||
502 | static ssize_t mousedev_write(struct file * file, const char __user * buffer, size_t count, loff_t *ppos) | 558 | static ssize_t mousedev_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos) |
503 | { | 559 | { |
504 | struct mousedev_list *list = file->private_data; | 560 | struct mousedev_client *client = file->private_data; |
505 | unsigned char c; | 561 | unsigned char c; |
506 | unsigned int i; | 562 | unsigned int i; |
507 | 563 | ||
@@ -510,95 +566,95 @@ static ssize_t mousedev_write(struct file * file, const char __user * buffer, si | |||
510 | if (get_user(c, buffer + i)) | 566 | if (get_user(c, buffer + i)) |
511 | return -EFAULT; | 567 | return -EFAULT; |
512 | 568 | ||
513 | if (c == mousedev_imex_seq[list->imexseq]) { | 569 | if (c == mousedev_imex_seq[client->imexseq]) { |
514 | if (++list->imexseq == MOUSEDEV_SEQ_LEN) { | 570 | if (++client->imexseq == MOUSEDEV_SEQ_LEN) { |
515 | list->imexseq = 0; | 571 | client->imexseq = 0; |
516 | list->mode = MOUSEDEV_EMUL_EXPS; | 572 | client->mode = MOUSEDEV_EMUL_EXPS; |
517 | } | 573 | } |
518 | } else | 574 | } else |
519 | list->imexseq = 0; | 575 | client->imexseq = 0; |
520 | 576 | ||
521 | if (c == mousedev_imps_seq[list->impsseq]) { | 577 | if (c == mousedev_imps_seq[client->impsseq]) { |
522 | if (++list->impsseq == MOUSEDEV_SEQ_LEN) { | 578 | if (++client->impsseq == MOUSEDEV_SEQ_LEN) { |
523 | list->impsseq = 0; | 579 | client->impsseq = 0; |
524 | list->mode = MOUSEDEV_EMUL_IMPS; | 580 | client->mode = MOUSEDEV_EMUL_IMPS; |
525 | } | 581 | } |
526 | } else | 582 | } else |
527 | list->impsseq = 0; | 583 | client->impsseq = 0; |
528 | 584 | ||
529 | list->ps2[0] = 0xfa; | 585 | client->ps2[0] = 0xfa; |
530 | 586 | ||
531 | switch (c) { | 587 | switch (c) { |
532 | 588 | ||
533 | case 0xeb: /* Poll */ | 589 | case 0xeb: /* Poll */ |
534 | mousedev_packet(list, &list->ps2[1]); | 590 | mousedev_packet(client, &client->ps2[1]); |
535 | list->bufsiz++; /* account for leading ACK */ | 591 | client->bufsiz++; /* account for leading ACK */ |
536 | break; | 592 | break; |
537 | 593 | ||
538 | case 0xf2: /* Get ID */ | 594 | case 0xf2: /* Get ID */ |
539 | switch (list->mode) { | 595 | switch (client->mode) { |
540 | case MOUSEDEV_EMUL_PS2: list->ps2[1] = 0; break; | 596 | case MOUSEDEV_EMUL_PS2: client->ps2[1] = 0; break; |
541 | case MOUSEDEV_EMUL_IMPS: list->ps2[1] = 3; break; | 597 | case MOUSEDEV_EMUL_IMPS: client->ps2[1] = 3; break; |
542 | case MOUSEDEV_EMUL_EXPS: list->ps2[1] = 4; break; | 598 | case MOUSEDEV_EMUL_EXPS: client->ps2[1] = 4; break; |
543 | } | 599 | } |
544 | list->bufsiz = 2; | 600 | client->bufsiz = 2; |
545 | break; | 601 | break; |
546 | 602 | ||
547 | case 0xe9: /* Get info */ | 603 | case 0xe9: /* Get info */ |
548 | list->ps2[1] = 0x60; list->ps2[2] = 3; list->ps2[3] = 200; | 604 | client->ps2[1] = 0x60; client->ps2[2] = 3; client->ps2[3] = 200; |
549 | list->bufsiz = 4; | 605 | client->bufsiz = 4; |
550 | break; | 606 | break; |
551 | 607 | ||
552 | case 0xff: /* Reset */ | 608 | case 0xff: /* Reset */ |
553 | list->impsseq = list->imexseq = 0; | 609 | client->impsseq = client->imexseq = 0; |
554 | list->mode = MOUSEDEV_EMUL_PS2; | 610 | client->mode = MOUSEDEV_EMUL_PS2; |
555 | list->ps2[1] = 0xaa; list->ps2[2] = 0x00; | 611 | client->ps2[1] = 0xaa; client->ps2[2] = 0x00; |
556 | list->bufsiz = 3; | 612 | client->bufsiz = 3; |
557 | break; | 613 | break; |
558 | 614 | ||
559 | default: | 615 | default: |
560 | list->bufsiz = 1; | 616 | client->bufsiz = 1; |
561 | break; | 617 | break; |
562 | } | 618 | } |
563 | 619 | ||
564 | list->buffer = list->bufsiz; | 620 | client->buffer = client->bufsiz; |
565 | } | 621 | } |
566 | 622 | ||
567 | kill_fasync(&list->fasync, SIGIO, POLL_IN); | 623 | kill_fasync(&client->fasync, SIGIO, POLL_IN); |
568 | 624 | ||
569 | wake_up_interruptible(&list->mousedev->wait); | 625 | wake_up_interruptible(&client->mousedev->wait); |
570 | 626 | ||
571 | return count; | 627 | return count; |
572 | } | 628 | } |
573 | 629 | ||
574 | static ssize_t mousedev_read(struct file * file, char __user * buffer, size_t count, loff_t *ppos) | 630 | static ssize_t mousedev_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos) |
575 | { | 631 | { |
576 | struct mousedev_list *list = file->private_data; | 632 | struct mousedev_client *client = file->private_data; |
577 | int retval = 0; | 633 | int retval = 0; |
578 | 634 | ||
579 | if (!list->ready && !list->buffer && (file->f_flags & O_NONBLOCK)) | 635 | if (!client->ready && !client->buffer && (file->f_flags & O_NONBLOCK)) |
580 | return -EAGAIN; | 636 | return -EAGAIN; |
581 | 637 | ||
582 | retval = wait_event_interruptible(list->mousedev->wait, | 638 | retval = wait_event_interruptible(client->mousedev->wait, |
583 | !list->mousedev->exist || list->ready || list->buffer); | 639 | !client->mousedev->exist || client->ready || client->buffer); |
584 | 640 | ||
585 | if (retval) | 641 | if (retval) |
586 | return retval; | 642 | return retval; |
587 | 643 | ||
588 | if (!list->mousedev->exist) | 644 | if (!client->mousedev->exist) |
589 | return -ENODEV; | 645 | return -ENODEV; |
590 | 646 | ||
591 | if (!list->buffer && list->ready) { | 647 | if (!client->buffer && client->ready) { |
592 | mousedev_packet(list, list->ps2); | 648 | mousedev_packet(client, client->ps2); |
593 | list->buffer = list->bufsiz; | 649 | client->buffer = client->bufsiz; |
594 | } | 650 | } |
595 | 651 | ||
596 | if (count > list->buffer) | 652 | if (count > client->buffer) |
597 | count = list->buffer; | 653 | count = client->buffer; |
598 | 654 | ||
599 | list->buffer -= count; | 655 | client->buffer -= count; |
600 | 656 | ||
601 | if (copy_to_user(buffer, list->ps2 + list->bufsiz - list->buffer - count, count)) | 657 | if (copy_to_user(buffer, client->ps2 + client->bufsiz - client->buffer - count, count)) |
602 | return -EFAULT; | 658 | return -EFAULT; |
603 | 659 | ||
604 | return count; | 660 | return count; |
@@ -607,11 +663,12 @@ static ssize_t mousedev_read(struct file * file, char __user * buffer, size_t co | |||
607 | /* No kernel lock - fine */ | 663 | /* No kernel lock - fine */ |
608 | static unsigned int mousedev_poll(struct file *file, poll_table *wait) | 664 | static unsigned int mousedev_poll(struct file *file, poll_table *wait) |
609 | { | 665 | { |
610 | struct mousedev_list *list = file->private_data; | 666 | struct mousedev_client *client = file->private_data; |
667 | struct mousedev *mousedev = client->mousedev; | ||
611 | 668 | ||
612 | poll_wait(file, &list->mousedev->wait, wait); | 669 | poll_wait(file, &mousedev->wait, wait); |
613 | return ((list->ready || list->buffer) ? (POLLIN | POLLRDNORM) : 0) | | 670 | return ((client->ready || client->buffer) ? (POLLIN | POLLRDNORM) : 0) | |
614 | (list->mousedev->exist ? 0 : (POLLHUP | POLLERR)); | 671 | (mousedev->exist ? 0 : (POLLHUP | POLLERR)); |
615 | } | 672 | } |
616 | 673 | ||
617 | static const struct file_operations mousedev_fops = { | 674 | static const struct file_operations mousedev_fops = { |
@@ -624,23 +681,27 @@ static const struct file_operations mousedev_fops = { | |||
624 | .fasync = mousedev_fasync, | 681 | .fasync = mousedev_fasync, |
625 | }; | 682 | }; |
626 | 683 | ||
627 | static struct input_handle *mousedev_connect(struct input_handler *handler, struct input_dev *dev, | 684 | static int mousedev_connect(struct input_handler *handler, struct input_dev *dev, |
628 | const struct input_device_id *id) | 685 | const struct input_device_id *id) |
629 | { | 686 | { |
630 | struct mousedev *mousedev; | 687 | struct mousedev *mousedev; |
631 | struct class_device *cdev; | 688 | struct class_device *cdev; |
632 | int minor = 0; | 689 | dev_t devt; |
690 | int minor; | ||
691 | int error; | ||
633 | 692 | ||
634 | for (minor = 0; minor < MOUSEDEV_MINORS && mousedev_table[minor]; minor++); | 693 | for (minor = 0; minor < MOUSEDEV_MINORS && mousedev_table[minor]; minor++); |
635 | if (minor == MOUSEDEV_MINORS) { | 694 | if (minor == MOUSEDEV_MINORS) { |
636 | printk(KERN_ERR "mousedev: no more free mousedev devices\n"); | 695 | printk(KERN_ERR "mousedev: no more free mousedev devices\n"); |
637 | return NULL; | 696 | return -ENFILE; |
638 | } | 697 | } |
639 | 698 | ||
640 | if (!(mousedev = kzalloc(sizeof(struct mousedev), GFP_KERNEL))) | 699 | mousedev = kzalloc(sizeof(struct mousedev), GFP_KERNEL); |
641 | return NULL; | 700 | if (!mousedev) |
701 | return -ENOMEM; | ||
642 | 702 | ||
643 | INIT_LIST_HEAD(&mousedev->list); | 703 | INIT_LIST_HEAD(&mousedev->client_list); |
704 | INIT_LIST_HEAD(&mousedev->mixdev_node); | ||
644 | init_waitqueue_head(&mousedev->wait); | 705 | init_waitqueue_head(&mousedev->wait); |
645 | 706 | ||
646 | mousedev->minor = minor; | 707 | mousedev->minor = minor; |
@@ -651,42 +712,66 @@ static struct input_handle *mousedev_connect(struct input_handler *handler, stru | |||
651 | mousedev->handle.private = mousedev; | 712 | mousedev->handle.private = mousedev; |
652 | sprintf(mousedev->name, "mouse%d", minor); | 713 | sprintf(mousedev->name, "mouse%d", minor); |
653 | 714 | ||
654 | if (mousedev_mix.open) | ||
655 | input_open_device(&mousedev->handle); | ||
656 | |||
657 | mousedev_table[minor] = mousedev; | 715 | mousedev_table[minor] = mousedev; |
658 | 716 | ||
659 | cdev = class_device_create(&input_class, &dev->cdev, | 717 | devt = MKDEV(INPUT_MAJOR, MOUSEDEV_MINOR_BASE + minor), |
660 | MKDEV(INPUT_MAJOR, MOUSEDEV_MINOR_BASE + minor), | 718 | |
661 | dev->cdev.dev, mousedev->name); | 719 | cdev = class_device_create(&input_class, &dev->cdev, devt, |
720 | dev->cdev.dev, mousedev->name); | ||
721 | if (IS_ERR(cdev)) { | ||
722 | error = PTR_ERR(cdev); | ||
723 | goto err_free_mousedev; | ||
724 | } | ||
662 | 725 | ||
663 | /* temporary symlink to keep userspace happy */ | 726 | /* temporary symlink to keep userspace happy */ |
664 | sysfs_create_link(&input_class.subsys.kobj, &cdev->kobj, | 727 | error = sysfs_create_link(&input_class.subsys.kobj, |
665 | mousedev->name); | 728 | &cdev->kobj, mousedev->name); |
729 | if (error) | ||
730 | goto err_cdev_destroy; | ||
731 | |||
732 | error = input_register_handle(&mousedev->handle); | ||
733 | if (error) | ||
734 | goto err_remove_link; | ||
735 | |||
736 | error = mixdev_add_device(mousedev); | ||
737 | if (error) | ||
738 | goto err_unregister_handle; | ||
666 | 739 | ||
667 | return &mousedev->handle; | 740 | return 0; |
741 | |||
742 | err_unregister_handle: | ||
743 | input_unregister_handle(&mousedev->handle); | ||
744 | err_remove_link: | ||
745 | sysfs_remove_link(&input_class.subsys.kobj, mousedev->name); | ||
746 | err_cdev_destroy: | ||
747 | class_device_destroy(&input_class, devt); | ||
748 | err_free_mousedev: | ||
749 | mousedev_table[minor] = NULL; | ||
750 | kfree(mousedev); | ||
751 | return error; | ||
668 | } | 752 | } |
669 | 753 | ||
670 | static void mousedev_disconnect(struct input_handle *handle) | 754 | static void mousedev_disconnect(struct input_handle *handle) |
671 | { | 755 | { |
672 | struct mousedev *mousedev = handle->private; | 756 | struct mousedev *mousedev = handle->private; |
673 | struct mousedev_list *list; | 757 | struct mousedev_client *client; |
758 | |||
759 | input_unregister_handle(handle); | ||
674 | 760 | ||
675 | sysfs_remove_link(&input_class.subsys.kobj, mousedev->name); | 761 | sysfs_remove_link(&input_class.subsys.kobj, mousedev->name); |
676 | class_device_destroy(&input_class, | 762 | class_device_destroy(&input_class, |
677 | MKDEV(INPUT_MAJOR, MOUSEDEV_MINOR_BASE + mousedev->minor)); | 763 | MKDEV(INPUT_MAJOR, MOUSEDEV_MINOR_BASE + mousedev->minor)); |
678 | mousedev->exist = 0; | 764 | mousedev->exist = 0; |
679 | 765 | ||
766 | mixdev_remove_device(mousedev); | ||
767 | |||
680 | if (mousedev->open) { | 768 | if (mousedev->open) { |
681 | input_close_device(handle); | 769 | input_close_device(handle); |
682 | wake_up_interruptible(&mousedev->wait); | 770 | wake_up_interruptible(&mousedev->wait); |
683 | list_for_each_entry(list, &mousedev->list, node) | 771 | list_for_each_entry(client, &mousedev->client_list, node) |
684 | kill_fasync(&list->fasync, SIGIO, POLL_HUP); | 772 | kill_fasync(&client->fasync, SIGIO, POLL_HUP); |
685 | } else { | 773 | } else |
686 | if (mousedev_mix.open) | ||
687 | input_close_device(handle); | ||
688 | mousedev_free(mousedev); | 774 | mousedev_free(mousedev); |
689 | } | ||
690 | } | 775 | } |
691 | 776 | ||
692 | static const struct input_device_id mousedev_ids[] = { | 777 | static const struct input_device_id mousedev_ids[] = { |
@@ -714,7 +799,7 @@ static const struct input_device_id mousedev_ids[] = { | |||
714 | .absbit = { BIT(ABS_X) | BIT(ABS_Y) | BIT(ABS_PRESSURE) | BIT(ABS_TOOL_WIDTH) }, | 799 | .absbit = { BIT(ABS_X) | BIT(ABS_Y) | BIT(ABS_PRESSURE) | BIT(ABS_TOOL_WIDTH) }, |
715 | }, /* A touchpad */ | 800 | }, /* A touchpad */ |
716 | 801 | ||
717 | { }, /* Terminating entry */ | 802 | { }, /* Terminating entry */ |
718 | }; | 803 | }; |
719 | 804 | ||
720 | MODULE_DEVICE_TABLE(input, mousedev_ids); | 805 | MODULE_DEVICE_TABLE(input, mousedev_ids); |
@@ -746,7 +831,7 @@ static int __init mousedev_init(void) | |||
746 | return error; | 831 | return error; |
747 | 832 | ||
748 | memset(&mousedev_mix, 0, sizeof(struct mousedev)); | 833 | memset(&mousedev_mix, 0, sizeof(struct mousedev)); |
749 | INIT_LIST_HEAD(&mousedev_mix.list); | 834 | INIT_LIST_HEAD(&mousedev_mix.client_list); |
750 | init_waitqueue_head(&mousedev_mix.wait); | 835 | init_waitqueue_head(&mousedev_mix.wait); |
751 | mousedev_table[MOUSEDEV_MIX] = &mousedev_mix; | 836 | mousedev_table[MOUSEDEV_MIX] = &mousedev_mix; |
752 | mousedev_mix.exist = 1; | 837 | mousedev_mix.exist = 1; |
diff --git a/drivers/input/power.c b/drivers/input/power.c deleted file mode 100644 index ee82464a2fa7..000000000000 --- a/drivers/input/power.c +++ /dev/null | |||
@@ -1,166 +0,0 @@ | |||
1 | /* | ||
2 | * $Id: power.c,v 1.10 2001/09/25 09:17:15 vojtech Exp $ | ||
3 | * | ||
4 | * Copyright (c) 2001 "Crazy" James Simmons | ||
5 | * | ||
6 | * Input driver Power Management. | ||
7 | * | ||
8 | * Sponsored by Transvirtual Technology. | ||
9 | */ | ||
10 | |||
11 | /* | ||
12 | * This program is free software; you can redistribute it and/or modify | ||
13 | * it under the terms of the GNU General Public License as published by | ||
14 | * the Free Software Foundation; either version 2 of the License, or | ||
15 | * (at your option) any later version. | ||
16 | * | ||
17 | * This program is distributed in the hope that it will be useful, | ||
18 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
20 | * GNU General Public License for more details. | ||
21 | * | ||
22 | * You should have received a copy of the GNU General Public License | ||
23 | * along with this program; if not, write to the Free Software | ||
24 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
25 | * | ||
26 | * Should you need to contact me, the author, you can do so by | ||
27 | * e-mail - mail your message to <jsimmons@transvirtual.com>. | ||
28 | */ | ||
29 | |||
30 | #include <linux/module.h> | ||
31 | #include <linux/input.h> | ||
32 | #include <linux/slab.h> | ||
33 | #include <linux/init.h> | ||
34 | #include <linux/tty.h> | ||
35 | #include <linux/delay.h> | ||
36 | #include <linux/pm.h> | ||
37 | |||
38 | static struct input_handler power_handler; | ||
39 | |||
40 | /* | ||
41 | * Power management can't be done in a interrupt context. So we have to | ||
42 | * use keventd. | ||
43 | */ | ||
44 | static int suspend_button_pushed = 0; | ||
45 | static void suspend_button_task_handler(void *data) | ||
46 | { | ||
47 | udelay(200); /* debounce */ | ||
48 | suspend_button_pushed = 0; | ||
49 | } | ||
50 | |||
51 | static DECLARE_WORK(suspend_button_task, suspend_button_task_handler, NULL); | ||
52 | |||
53 | static void power_event(struct input_handle *handle, unsigned int type, | ||
54 | unsigned int code, int down) | ||
55 | { | ||
56 | struct input_dev *dev = handle->dev; | ||
57 | |||
58 | printk("Entering power_event\n"); | ||
59 | |||
60 | if (type == EV_PWR) { | ||
61 | switch (code) { | ||
62 | case KEY_SUSPEND: | ||
63 | printk("Powering down entire device\n"); | ||
64 | |||
65 | if (!suspend_button_pushed) { | ||
66 | suspend_button_pushed = 1; | ||
67 | schedule_work(&suspend_button_task); | ||
68 | } | ||
69 | break; | ||
70 | case KEY_POWER: | ||
71 | /* Hum power down the machine. */ | ||
72 | break; | ||
73 | default: | ||
74 | return; | ||
75 | } | ||
76 | } | ||
77 | |||
78 | if (type == EV_KEY) { | ||
79 | switch (code) { | ||
80 | case KEY_SUSPEND: | ||
81 | printk("Powering down input device\n"); | ||
82 | /* This is risky. See pm.h for details. */ | ||
83 | if (dev->state != PM_RESUME) | ||
84 | dev->state = PM_RESUME; | ||
85 | else | ||
86 | dev->state = PM_SUSPEND; | ||
87 | pm_send(dev->pm_dev, dev->state, dev); | ||
88 | break; | ||
89 | case KEY_POWER: | ||
90 | /* Turn the input device off completely ? */ | ||
91 | break; | ||
92 | default: | ||
93 | return; | ||
94 | } | ||
95 | } | ||
96 | return; | ||
97 | } | ||
98 | |||
99 | static struct input_handle *power_connect(struct input_handler *handler, | ||
100 | struct input_dev *dev, | ||
101 | const struct input_device_id *id) | ||
102 | { | ||
103 | struct input_handle *handle; | ||
104 | |||
105 | if (!(handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL))) | ||
106 | return NULL; | ||
107 | |||
108 | handle->dev = dev; | ||
109 | handle->handler = handler; | ||
110 | |||
111 | input_open_device(handle); | ||
112 | |||
113 | printk(KERN_INFO "power.c: Adding power management to input layer\n"); | ||
114 | return handle; | ||
115 | } | ||
116 | |||
117 | static void power_disconnect(struct input_handle *handle) | ||
118 | { | ||
119 | input_close_device(handle); | ||
120 | kfree(handle); | ||
121 | } | ||
122 | |||
123 | static const struct input_device_id power_ids[] = { | ||
124 | { | ||
125 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT, | ||
126 | .evbit = { BIT(EV_KEY) }, | ||
127 | .keybit = { [LONG(KEY_SUSPEND)] = BIT(KEY_SUSPEND) } | ||
128 | }, | ||
129 | { | ||
130 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT, | ||
131 | .evbit = { BIT(EV_KEY) }, | ||
132 | .keybit = { [LONG(KEY_POWER)] = BIT(KEY_POWER) } | ||
133 | }, | ||
134 | { | ||
135 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT, | ||
136 | .evbit = { BIT(EV_PWR) }, | ||
137 | }, | ||
138 | { }, /* Terminating entry */ | ||
139 | }; | ||
140 | |||
141 | MODULE_DEVICE_TABLE(input, power_ids); | ||
142 | |||
143 | static struct input_handler power_handler = { | ||
144 | .event = power_event, | ||
145 | .connect = power_connect, | ||
146 | .disconnect = power_disconnect, | ||
147 | .name = "power", | ||
148 | .id_table = power_ids, | ||
149 | }; | ||
150 | |||
151 | static int __init power_init(void) | ||
152 | { | ||
153 | return input_register_handler(&power_handler); | ||
154 | } | ||
155 | |||
156 | static void __exit power_exit(void) | ||
157 | { | ||
158 | input_unregister_handler(&power_handler); | ||
159 | } | ||
160 | |||
161 | module_init(power_init); | ||
162 | module_exit(power_exit); | ||
163 | |||
164 | MODULE_AUTHOR("James Simmons <jsimmons@transvirtual.com>"); | ||
165 | MODULE_DESCRIPTION("Input Power Management driver"); | ||
166 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/input/serio/hil_mlc.c b/drivers/input/serio/hil_mlc.c index 4fa93ff30919..93a1a6ba216a 100644 --- a/drivers/input/serio/hil_mlc.c +++ b/drivers/input/serio/hil_mlc.c | |||
@@ -32,11 +32,11 @@ | |||
32 | * | 32 | * |
33 | * Driver theory of operation: | 33 | * Driver theory of operation: |
34 | * | 34 | * |
35 | * Some access methods and an ISR is defined by the sub-driver | 35 | * Some access methods and an ISR is defined by the sub-driver |
36 | * (e.g. hp_sdc_mlc.c). These methods are expected to provide a | 36 | * (e.g. hp_sdc_mlc.c). These methods are expected to provide a |
37 | * few bits of logic in addition to raw access to the HIL MLC, | 37 | * few bits of logic in addition to raw access to the HIL MLC, |
38 | * specifically, the ISR, which is entirely registered by the | 38 | * specifically, the ISR, which is entirely registered by the |
39 | * sub-driver and invoked directly, must check for record | 39 | * sub-driver and invoked directly, must check for record |
40 | * termination or packet match, at which point a semaphore must | 40 | * termination or packet match, at which point a semaphore must |
41 | * be cleared and then the hil_mlcs_tasklet must be scheduled. | 41 | * be cleared and then the hil_mlcs_tasklet must be scheduled. |
42 | * | 42 | * |
@@ -47,7 +47,7 @@ | |||
47 | * itself if output is pending. (This rescheduling should be replaced | 47 | * itself if output is pending. (This rescheduling should be replaced |
48 | * at some point with a sub-driver-specific mechanism.) | 48 | * at some point with a sub-driver-specific mechanism.) |
49 | * | 49 | * |
50 | * A timer task prods the tasklet once per second to prevent | 50 | * A timer task prods the tasklet once per second to prevent |
51 | * hangups when attached devices do not return expected data | 51 | * hangups when attached devices do not return expected data |
52 | * and to initiate probes of the loop for new devices. | 52 | * and to initiate probes of the loop for new devices. |
53 | */ | 53 | */ |
@@ -83,69 +83,85 @@ DECLARE_TASKLET_DISABLED(hil_mlcs_tasklet, hil_mlcs_process, 0); | |||
83 | 83 | ||
84 | /********************** Device info/instance management **********************/ | 84 | /********************** Device info/instance management **********************/ |
85 | 85 | ||
86 | static void hil_mlc_clear_di_map (hil_mlc *mlc, int val) { | 86 | static void hil_mlc_clear_di_map(hil_mlc *mlc, int val) |
87 | { | ||
87 | int j; | 88 | int j; |
88 | for (j = val; j < 7 ; j++) { | 89 | |
90 | for (j = val; j < 7 ; j++) | ||
89 | mlc->di_map[j] = -1; | 91 | mlc->di_map[j] = -1; |
90 | } | ||
91 | } | 92 | } |
92 | 93 | ||
93 | static void hil_mlc_clear_di_scratch (hil_mlc *mlc) { | 94 | static void hil_mlc_clear_di_scratch(hil_mlc *mlc) |
94 | memset(&(mlc->di_scratch), 0, sizeof(mlc->di_scratch)); | 95 | { |
96 | memset(&mlc->di_scratch, 0, sizeof(mlc->di_scratch)); | ||
95 | } | 97 | } |
96 | 98 | ||
97 | static void hil_mlc_copy_di_scratch (hil_mlc *mlc, int idx) { | 99 | static void hil_mlc_copy_di_scratch(hil_mlc *mlc, int idx) |
98 | memcpy(&(mlc->di[idx]), &(mlc->di_scratch), sizeof(mlc->di_scratch)); | 100 | { |
101 | memcpy(&mlc->di[idx], &mlc->di_scratch, sizeof(mlc->di_scratch)); | ||
99 | } | 102 | } |
100 | 103 | ||
101 | static int hil_mlc_match_di_scratch (hil_mlc *mlc) { | 104 | static int hil_mlc_match_di_scratch(hil_mlc *mlc) |
105 | { | ||
102 | int idx; | 106 | int idx; |
103 | 107 | ||
104 | for (idx = 0; idx < HIL_MLC_DEVMEM; idx++) { | 108 | for (idx = 0; idx < HIL_MLC_DEVMEM; idx++) { |
105 | int j, found; | 109 | int j, found = 0; |
106 | 110 | ||
107 | /* In-use slots are not eligible. */ | 111 | /* In-use slots are not eligible. */ |
108 | found = 0; | 112 | for (j = 0; j < 7 ; j++) |
109 | for (j = 0; j < 7 ; j++) { | 113 | if (mlc->di_map[j] == idx) |
110 | if (mlc->di_map[j] == idx) found++; | 114 | found++; |
111 | } | 115 | |
112 | if (found) continue; | 116 | if (found) |
113 | if (!memcmp(mlc->di + idx, | 117 | continue; |
114 | &(mlc->di_scratch), | 118 | |
115 | sizeof(mlc->di_scratch))) break; | 119 | if (!memcmp(mlc->di + idx, &mlc->di_scratch, |
120 | sizeof(mlc->di_scratch))) | ||
121 | break; | ||
116 | } | 122 | } |
117 | return((idx >= HIL_MLC_DEVMEM) ? -1 : idx); | 123 | return idx >= HIL_MLC_DEVMEM ? -1 : idx; |
118 | } | 124 | } |
119 | 125 | ||
120 | static int hil_mlc_find_free_di(hil_mlc *mlc) { | 126 | static int hil_mlc_find_free_di(hil_mlc *mlc) |
127 | { | ||
121 | int idx; | 128 | int idx; |
122 | /* TODO: Pick all-zero slots first, failing that, | 129 | |
123 | * randomize the slot picked among those eligible. | 130 | /* TODO: Pick all-zero slots first, failing that, |
131 | * randomize the slot picked among those eligible. | ||
124 | */ | 132 | */ |
125 | for (idx = 0; idx < HIL_MLC_DEVMEM; idx++) { | 133 | for (idx = 0; idx < HIL_MLC_DEVMEM; idx++) { |
126 | int j, found; | 134 | int j, found = 0; |
127 | found = 0; | 135 | |
128 | for (j = 0; j < 7 ; j++) { | 136 | for (j = 0; j < 7 ; j++) |
129 | if (mlc->di_map[j] == idx) found++; | 137 | if (mlc->di_map[j] == idx) |
130 | } | 138 | found++; |
131 | if (!found) break; | 139 | |
140 | if (!found) | ||
141 | break; | ||
132 | } | 142 | } |
133 | return(idx); /* Note: It is guaranteed at least one above will match */ | 143 | |
144 | return idx; /* Note: It is guaranteed at least one above will match */ | ||
134 | } | 145 | } |
135 | 146 | ||
136 | static inline void hil_mlc_clean_serio_map(hil_mlc *mlc) { | 147 | static inline void hil_mlc_clean_serio_map(hil_mlc *mlc) |
148 | { | ||
137 | int idx; | 149 | int idx; |
150 | |||
138 | for (idx = 0; idx < HIL_MLC_DEVMEM; idx++) { | 151 | for (idx = 0; idx < HIL_MLC_DEVMEM; idx++) { |
139 | int j, found; | 152 | int j, found = 0; |
140 | found = 0; | 153 | |
141 | for (j = 0; j < 7 ; j++) { | 154 | for (j = 0; j < 7 ; j++) |
142 | if (mlc->di_map[j] == idx) found++; | 155 | if (mlc->di_map[j] == idx) |
143 | } | 156 | found++; |
144 | if (!found) mlc->serio_map[idx].di_revmap = -1; | 157 | |
158 | if (!found) | ||
159 | mlc->serio_map[idx].di_revmap = -1; | ||
145 | } | 160 | } |
146 | } | 161 | } |
147 | 162 | ||
148 | static void hil_mlc_send_polls(hil_mlc *mlc) { | 163 | static void hil_mlc_send_polls(hil_mlc *mlc) |
164 | { | ||
149 | int did, i, cnt; | 165 | int did, i, cnt; |
150 | struct serio *serio; | 166 | struct serio *serio; |
151 | struct serio_driver *drv; | 167 | struct serio_driver *drv; |
@@ -157,26 +173,31 @@ static void hil_mlc_send_polls(hil_mlc *mlc) { | |||
157 | 173 | ||
158 | while (mlc->icount < 15 - i) { | 174 | while (mlc->icount < 15 - i) { |
159 | hil_packet p; | 175 | hil_packet p; |
176 | |||
160 | p = mlc->ipacket[i]; | 177 | p = mlc->ipacket[i]; |
161 | if (did != (p & HIL_PKT_ADDR_MASK) >> 8) { | 178 | if (did != (p & HIL_PKT_ADDR_MASK) >> 8) { |
162 | if (drv == NULL || drv->interrupt == NULL) goto skip; | 179 | if (drv && drv->interrupt) { |
180 | drv->interrupt(serio, 0, 0); | ||
181 | drv->interrupt(serio, HIL_ERR_INT >> 16, 0); | ||
182 | drv->interrupt(serio, HIL_PKT_CMD >> 8, 0); | ||
183 | drv->interrupt(serio, HIL_CMD_POL + cnt, 0); | ||
184 | } | ||
163 | 185 | ||
164 | drv->interrupt(serio, 0, 0); | ||
165 | drv->interrupt(serio, HIL_ERR_INT >> 16, 0); | ||
166 | drv->interrupt(serio, HIL_PKT_CMD >> 8, 0); | ||
167 | drv->interrupt(serio, HIL_CMD_POL + cnt, 0); | ||
168 | skip: | ||
169 | did = (p & HIL_PKT_ADDR_MASK) >> 8; | 186 | did = (p & HIL_PKT_ADDR_MASK) >> 8; |
170 | serio = did ? mlc->serio[mlc->di_map[did-1]] : NULL; | 187 | serio = did ? mlc->serio[mlc->di_map[did-1]] : NULL; |
171 | drv = (serio != NULL) ? serio->drv : NULL; | 188 | drv = (serio != NULL) ? serio->drv : NULL; |
172 | cnt = 0; | 189 | cnt = 0; |
173 | } | 190 | } |
174 | cnt++; i++; | 191 | |
175 | if (drv == NULL || drv->interrupt == NULL) continue; | 192 | cnt++; |
176 | drv->interrupt(serio, (p >> 24), 0); | 193 | i++; |
177 | drv->interrupt(serio, (p >> 16) & 0xff, 0); | 194 | |
178 | drv->interrupt(serio, (p >> 8) & ~HIL_PKT_ADDR_MASK, 0); | 195 | if (drv && drv->interrupt) { |
179 | drv->interrupt(serio, p & 0xff, 0); | 196 | drv->interrupt(serio, (p >> 24), 0); |
197 | drv->interrupt(serio, (p >> 16) & 0xff, 0); | ||
198 | drv->interrupt(serio, (p >> 8) & ~HIL_PKT_ADDR_MASK, 0); | ||
199 | drv->interrupt(serio, p & 0xff, 0); | ||
200 | } | ||
180 | } | 201 | } |
181 | } | 202 | } |
182 | 203 | ||
@@ -215,12 +236,16 @@ static void hil_mlc_send_polls(hil_mlc *mlc) { | |||
215 | #define HILSEN_DOZE (HILSEN_SAME | HILSEN_SCHED | HILSEN_BREAK) | 236 | #define HILSEN_DOZE (HILSEN_SAME | HILSEN_SCHED | HILSEN_BREAK) |
216 | #define HILSEN_SLEEP (HILSEN_SAME | HILSEN_BREAK) | 237 | #define HILSEN_SLEEP (HILSEN_SAME | HILSEN_BREAK) |
217 | 238 | ||
218 | static int hilse_match(hil_mlc *mlc, int unused) { | 239 | static int hilse_match(hil_mlc *mlc, int unused) |
240 | { | ||
219 | int rc; | 241 | int rc; |
242 | |||
220 | rc = hil_mlc_match_di_scratch(mlc); | 243 | rc = hil_mlc_match_di_scratch(mlc); |
221 | if (rc == -1) { | 244 | if (rc == -1) { |
222 | rc = hil_mlc_find_free_di(mlc); | 245 | rc = hil_mlc_find_free_di(mlc); |
223 | if (rc == -1) goto err; | 246 | if (rc == -1) |
247 | goto err; | ||
248 | |||
224 | #ifdef HIL_MLC_DEBUG | 249 | #ifdef HIL_MLC_DEBUG |
225 | printk(KERN_DEBUG PREFIX "new in slot %i\n", rc); | 250 | printk(KERN_DEBUG PREFIX "new in slot %i\n", rc); |
226 | #endif | 251 | #endif |
@@ -231,6 +256,7 @@ static int hilse_match(hil_mlc *mlc, int unused) { | |||
231 | serio_rescan(mlc->serio[rc]); | 256 | serio_rescan(mlc->serio[rc]); |
232 | return -1; | 257 | return -1; |
233 | } | 258 | } |
259 | |||
234 | mlc->di_map[mlc->ddi] = rc; | 260 | mlc->di_map[mlc->ddi] = rc; |
235 | #ifdef HIL_MLC_DEBUG | 261 | #ifdef HIL_MLC_DEBUG |
236 | printk(KERN_DEBUG PREFIX "same in slot %i\n", rc); | 262 | printk(KERN_DEBUG PREFIX "same in slot %i\n", rc); |
@@ -238,152 +264,177 @@ static int hilse_match(hil_mlc *mlc, int unused) { | |||
238 | mlc->serio_map[rc].di_revmap = mlc->ddi; | 264 | mlc->serio_map[rc].di_revmap = mlc->ddi; |
239 | hil_mlc_clean_serio_map(mlc); | 265 | hil_mlc_clean_serio_map(mlc); |
240 | return 0; | 266 | return 0; |
267 | |||
241 | err: | 268 | err: |
242 | printk(KERN_ERR PREFIX "Residual device slots exhausted, close some serios!\n"); | 269 | printk(KERN_ERR PREFIX "Residual device slots exhausted, close some serios!\n"); |
243 | return 1; | 270 | return 1; |
244 | } | 271 | } |
245 | 272 | ||
246 | /* An LCV used to prevent runaway loops, forces 5 second sleep when reset. */ | 273 | /* An LCV used to prevent runaway loops, forces 5 second sleep when reset. */ |
247 | static int hilse_init_lcv(hil_mlc *mlc, int unused) { | 274 | static int hilse_init_lcv(hil_mlc *mlc, int unused) |
275 | { | ||
248 | struct timeval tv; | 276 | struct timeval tv; |
249 | 277 | ||
250 | do_gettimeofday(&tv); | 278 | do_gettimeofday(&tv); |
251 | 279 | ||
252 | if(mlc->lcv == 0) goto restart; /* First init, no need to dally */ | 280 | if (mlc->lcv && (tv.tv_sec - mlc->lcv_tv.tv_sec) < 5) |
253 | if(tv.tv_sec - mlc->lcv_tv.tv_sec < 5) return -1; | 281 | return -1; |
254 | restart: | 282 | |
255 | mlc->lcv_tv = tv; | 283 | mlc->lcv_tv = tv; |
256 | mlc->lcv = 0; | 284 | mlc->lcv = 0; |
285 | |||
257 | return 0; | 286 | return 0; |
258 | } | 287 | } |
259 | 288 | ||
260 | static int hilse_inc_lcv(hil_mlc *mlc, int lim) { | 289 | static int hilse_inc_lcv(hil_mlc *mlc, int lim) |
261 | if (mlc->lcv++ >= lim) return -1; | 290 | { |
262 | return 0; | 291 | return mlc->lcv++ >= lim ? -1 : 0; |
263 | } | 292 | } |
264 | 293 | ||
265 | #if 0 | 294 | #if 0 |
266 | static int hilse_set_lcv(hil_mlc *mlc, int val) { | 295 | static int hilse_set_lcv(hil_mlc *mlc, int val) |
296 | { | ||
267 | mlc->lcv = val; | 297 | mlc->lcv = val; |
298 | |||
268 | return 0; | 299 | return 0; |
269 | } | 300 | } |
270 | #endif | 301 | #endif |
271 | 302 | ||
272 | /* Management of the discovered device index (zero based, -1 means no devs) */ | 303 | /* Management of the discovered device index (zero based, -1 means no devs) */ |
273 | static int hilse_set_ddi(hil_mlc *mlc, int val) { | 304 | static int hilse_set_ddi(hil_mlc *mlc, int val) |
305 | { | ||
274 | mlc->ddi = val; | 306 | mlc->ddi = val; |
275 | hil_mlc_clear_di_map(mlc, val + 1); | 307 | hil_mlc_clear_di_map(mlc, val + 1); |
308 | |||
276 | return 0; | 309 | return 0; |
277 | } | 310 | } |
278 | 311 | ||
279 | static int hilse_dec_ddi(hil_mlc *mlc, int unused) { | 312 | static int hilse_dec_ddi(hil_mlc *mlc, int unused) |
313 | { | ||
280 | mlc->ddi--; | 314 | mlc->ddi--; |
281 | if (mlc->ddi <= -1) { | 315 | if (mlc->ddi <= -1) { |
282 | mlc->ddi = -1; | 316 | mlc->ddi = -1; |
283 | hil_mlc_clear_di_map(mlc, 0); | 317 | hil_mlc_clear_di_map(mlc, 0); |
284 | return -1; | 318 | return -1; |
285 | } | 319 | } |
286 | hil_mlc_clear_di_map(mlc, mlc->ddi + 1); | 320 | hil_mlc_clear_di_map(mlc, mlc->ddi + 1); |
321 | |||
287 | return 0; | 322 | return 0; |
288 | } | 323 | } |
289 | 324 | ||
290 | static int hilse_inc_ddi(hil_mlc *mlc, int unused) { | 325 | static int hilse_inc_ddi(hil_mlc *mlc, int unused) |
291 | if (mlc->ddi >= 6) { | 326 | { |
292 | BUG(); | 327 | BUG_ON(mlc->ddi >= 6); |
293 | return -1; | ||
294 | } | ||
295 | mlc->ddi++; | 328 | mlc->ddi++; |
329 | |||
296 | return 0; | 330 | return 0; |
297 | } | 331 | } |
298 | 332 | ||
299 | static int hilse_take_idd(hil_mlc *mlc, int unused) { | 333 | static int hilse_take_idd(hil_mlc *mlc, int unused) |
334 | { | ||
300 | int i; | 335 | int i; |
301 | 336 | ||
302 | /* Help the state engine: | 337 | /* Help the state engine: |
303 | * Is this a real IDD response or just an echo? | 338 | * Is this a real IDD response or just an echo? |
304 | * | 339 | * |
305 | * Real IDD response does not start with a command. | 340 | * Real IDD response does not start with a command. |
306 | */ | 341 | */ |
307 | if (mlc->ipacket[0] & HIL_PKT_CMD) goto bail; | 342 | if (mlc->ipacket[0] & HIL_PKT_CMD) |
343 | goto bail; | ||
344 | |||
308 | /* Should have the command echoed further down. */ | 345 | /* Should have the command echoed further down. */ |
309 | for (i = 1; i < 16; i++) { | 346 | for (i = 1; i < 16; i++) { |
310 | if (((mlc->ipacket[i] & HIL_PKT_ADDR_MASK) == | 347 | if (((mlc->ipacket[i] & HIL_PKT_ADDR_MASK) == |
311 | (mlc->ipacket[0] & HIL_PKT_ADDR_MASK)) && | 348 | (mlc->ipacket[0] & HIL_PKT_ADDR_MASK)) && |
312 | (mlc->ipacket[i] & HIL_PKT_CMD) && | 349 | (mlc->ipacket[i] & HIL_PKT_CMD) && |
313 | ((mlc->ipacket[i] & HIL_PKT_DATA_MASK) == HIL_CMD_IDD)) | 350 | ((mlc->ipacket[i] & HIL_PKT_DATA_MASK) == HIL_CMD_IDD)) |
314 | break; | 351 | break; |
315 | } | 352 | } |
316 | if (i > 15) goto bail; | 353 | if (i > 15) |
354 | goto bail; | ||
355 | |||
317 | /* And the rest of the packets should still be clear. */ | 356 | /* And the rest of the packets should still be clear. */ |
318 | while (++i < 16) { | 357 | while (++i < 16) |
319 | if (mlc->ipacket[i]) break; | 358 | if (mlc->ipacket[i]) |
320 | } | 359 | break; |
321 | if (i < 16) goto bail; | 360 | |
322 | for (i = 0; i < 16; i++) { | 361 | if (i < 16) |
323 | mlc->di_scratch.idd[i] = | 362 | goto bail; |
363 | |||
364 | for (i = 0; i < 16; i++) | ||
365 | mlc->di_scratch.idd[i] = | ||
324 | mlc->ipacket[i] & HIL_PKT_DATA_MASK; | 366 | mlc->ipacket[i] & HIL_PKT_DATA_MASK; |
325 | } | 367 | |
326 | /* Next step is to see if RSC supported */ | 368 | /* Next step is to see if RSC supported */ |
327 | if (mlc->di_scratch.idd[1] & HIL_IDD_HEADER_RSC) | 369 | if (mlc->di_scratch.idd[1] & HIL_IDD_HEADER_RSC) |
328 | return HILSEN_NEXT; | 370 | return HILSEN_NEXT; |
329 | if (mlc->di_scratch.idd[1] & HIL_IDD_HEADER_EXD) | 371 | |
372 | if (mlc->di_scratch.idd[1] & HIL_IDD_HEADER_EXD) | ||
330 | return HILSEN_DOWN | 4; | 373 | return HILSEN_DOWN | 4; |
374 | |||
331 | return 0; | 375 | return 0; |
376 | |||
332 | bail: | 377 | bail: |
333 | mlc->ddi--; | 378 | mlc->ddi--; |
379 | |||
334 | return -1; /* This should send us off to ACF */ | 380 | return -1; /* This should send us off to ACF */ |
335 | } | 381 | } |
336 | 382 | ||
337 | static int hilse_take_rsc(hil_mlc *mlc, int unused) { | 383 | static int hilse_take_rsc(hil_mlc *mlc, int unused) |
384 | { | ||
338 | int i; | 385 | int i; |
339 | 386 | ||
340 | for (i = 0; i < 16; i++) { | 387 | for (i = 0; i < 16; i++) |
341 | mlc->di_scratch.rsc[i] = | 388 | mlc->di_scratch.rsc[i] = |
342 | mlc->ipacket[i] & HIL_PKT_DATA_MASK; | 389 | mlc->ipacket[i] & HIL_PKT_DATA_MASK; |
343 | } | 390 | |
344 | /* Next step is to see if EXD supported (IDD has already been read) */ | 391 | /* Next step is to see if EXD supported (IDD has already been read) */ |
345 | if (mlc->di_scratch.idd[1] & HIL_IDD_HEADER_EXD) | 392 | if (mlc->di_scratch.idd[1] & HIL_IDD_HEADER_EXD) |
346 | return HILSEN_NEXT; | 393 | return HILSEN_NEXT; |
394 | |||
347 | return 0; | 395 | return 0; |
348 | } | 396 | } |
349 | 397 | ||
350 | static int hilse_take_exd(hil_mlc *mlc, int unused) { | 398 | static int hilse_take_exd(hil_mlc *mlc, int unused) |
399 | { | ||
351 | int i; | 400 | int i; |
352 | 401 | ||
353 | for (i = 0; i < 16; i++) { | 402 | for (i = 0; i < 16; i++) |
354 | mlc->di_scratch.exd[i] = | 403 | mlc->di_scratch.exd[i] = |
355 | mlc->ipacket[i] & HIL_PKT_DATA_MASK; | 404 | mlc->ipacket[i] & HIL_PKT_DATA_MASK; |
356 | } | 405 | |
357 | /* Next step is to see if RNM supported. */ | 406 | /* Next step is to see if RNM supported. */ |
358 | if (mlc->di_scratch.exd[0] & HIL_EXD_HEADER_RNM) | 407 | if (mlc->di_scratch.exd[0] & HIL_EXD_HEADER_RNM) |
359 | return HILSEN_NEXT; | 408 | return HILSEN_NEXT; |
409 | |||
360 | return 0; | 410 | return 0; |
361 | } | 411 | } |
362 | 412 | ||
363 | static int hilse_take_rnm(hil_mlc *mlc, int unused) { | 413 | static int hilse_take_rnm(hil_mlc *mlc, int unused) |
414 | { | ||
364 | int i; | 415 | int i; |
365 | 416 | ||
366 | for (i = 0; i < 16; i++) { | 417 | for (i = 0; i < 16; i++) |
367 | mlc->di_scratch.rnm[i] = | 418 | mlc->di_scratch.rnm[i] = |
368 | mlc->ipacket[i] & HIL_PKT_DATA_MASK; | 419 | mlc->ipacket[i] & HIL_PKT_DATA_MASK; |
369 | } | 420 | |
370 | do { | 421 | printk(KERN_INFO PREFIX "Device name gotten: %16s\n", |
371 | char nam[17]; | 422 | mlc->di_scratch.rnm); |
372 | snprintf(nam, 16, "%s", mlc->di_scratch.rnm); | 423 | |
373 | nam[16] = '\0'; | ||
374 | printk(KERN_INFO PREFIX "Device name gotten: %s\n", nam); | ||
375 | } while (0); | ||
376 | return 0; | 424 | return 0; |
377 | } | 425 | } |
378 | 426 | ||
379 | static int hilse_operate(hil_mlc *mlc, int repoll) { | 427 | static int hilse_operate(hil_mlc *mlc, int repoll) |
428 | { | ||
380 | 429 | ||
381 | if (mlc->opercnt == 0) hil_mlcs_probe = 0; | 430 | if (mlc->opercnt == 0) |
431 | hil_mlcs_probe = 0; | ||
382 | mlc->opercnt = 1; | 432 | mlc->opercnt = 1; |
383 | 433 | ||
384 | hil_mlc_send_polls(mlc); | 434 | hil_mlc_send_polls(mlc); |
385 | 435 | ||
386 | if (!hil_mlcs_probe) return 0; | 436 | if (!hil_mlcs_probe) |
437 | return 0; | ||
387 | hil_mlcs_probe = 0; | 438 | hil_mlcs_probe = 0; |
388 | mlc->opercnt = 0; | 439 | mlc->opercnt = 0; |
389 | return 1; | 440 | return 1; |
@@ -408,7 +459,7 @@ static int hilse_operate(hil_mlc *mlc, int repoll) { | |||
408 | #define OUT_LAST(pack) \ | 459 | #define OUT_LAST(pack) \ |
409 | { HILSE_OUT_LAST, { .packet = pack }, 0, 0, 0, 0 }, | 460 | { HILSE_OUT_LAST, { .packet = pack }, 0, 0, 0, 0 }, |
410 | 461 | ||
411 | struct hilse_node hil_mlc_se[HILSEN_END] = { | 462 | const struct hilse_node hil_mlc_se[HILSEN_END] = { |
412 | 463 | ||
413 | /* 0 HILSEN_START */ | 464 | /* 0 HILSEN_START */ |
414 | FUNC(hilse_init_lcv, 0, HILSEN_NEXT, HILSEN_SLEEP, 0) | 465 | FUNC(hilse_init_lcv, 0, HILSEN_NEXT, HILSEN_SLEEP, 0) |
@@ -428,7 +479,7 @@ struct hilse_node hil_mlc_se[HILSEN_END] = { | |||
428 | EXPECT(HIL_ERR_INT | TEST_PACKET(0xa), | 479 | EXPECT(HIL_ERR_INT | TEST_PACKET(0xa), |
429 | 2000, HILSEN_NEXT, HILSEN_RESTART, HILSEN_RESTART) | 480 | 2000, HILSEN_NEXT, HILSEN_RESTART, HILSEN_RESTART) |
430 | OUT(HIL_CTRL_ONLY | 0) /* Disable test mode */ | 481 | OUT(HIL_CTRL_ONLY | 0) /* Disable test mode */ |
431 | 482 | ||
432 | /* 9 HILSEN_DHR */ | 483 | /* 9 HILSEN_DHR */ |
433 | FUNC(hilse_init_lcv, 0, HILSEN_NEXT, HILSEN_SLEEP, 0) | 484 | FUNC(hilse_init_lcv, 0, HILSEN_NEXT, HILSEN_SLEEP, 0) |
434 | 485 | ||
@@ -439,7 +490,7 @@ struct hilse_node hil_mlc_se[HILSEN_END] = { | |||
439 | IN(300000, HILSEN_DHR2, HILSEN_DHR2, HILSEN_NEXT) | 490 | IN(300000, HILSEN_DHR2, HILSEN_DHR2, HILSEN_NEXT) |
440 | 491 | ||
441 | /* 14 HILSEN_IFC */ | 492 | /* 14 HILSEN_IFC */ |
442 | OUT(HIL_PKT_CMD | HIL_CMD_IFC) | 493 | OUT(HIL_PKT_CMD | HIL_CMD_IFC) |
443 | EXPECT(HIL_PKT_CMD | HIL_CMD_IFC | HIL_ERR_INT, | 494 | EXPECT(HIL_PKT_CMD | HIL_CMD_IFC | HIL_ERR_INT, |
444 | 20000, HILSEN_DISC, HILSEN_DHR2, HILSEN_NEXT ) | 495 | 20000, HILSEN_DISC, HILSEN_DHR2, HILSEN_NEXT ) |
445 | 496 | ||
@@ -455,7 +506,7 @@ struct hilse_node hil_mlc_se[HILSEN_END] = { | |||
455 | 506 | ||
456 | /* 18 HILSEN_HEAL */ | 507 | /* 18 HILSEN_HEAL */ |
457 | OUT_LAST(HIL_CMD_ELB) | 508 | OUT_LAST(HIL_CMD_ELB) |
458 | EXPECT_LAST(HIL_CMD_ELB | HIL_ERR_INT, | 509 | EXPECT_LAST(HIL_CMD_ELB | HIL_ERR_INT, |
459 | 20000, HILSEN_REPOLL, HILSEN_DSR, HILSEN_NEXT) | 510 | 20000, HILSEN_REPOLL, HILSEN_DSR, HILSEN_NEXT) |
460 | FUNC(hilse_dec_ddi, 0, HILSEN_HEAL, HILSEN_NEXT, 0) | 511 | FUNC(hilse_dec_ddi, 0, HILSEN_HEAL, HILSEN_NEXT, 0) |
461 | 512 | ||
@@ -503,7 +554,7 @@ struct hilse_node hil_mlc_se[HILSEN_END] = { | |||
503 | 554 | ||
504 | /* 44 HILSEN_PROBE */ | 555 | /* 44 HILSEN_PROBE */ |
505 | OUT_LAST(HIL_PKT_CMD | HIL_CMD_EPT) | 556 | OUT_LAST(HIL_PKT_CMD | HIL_CMD_EPT) |
506 | IN(10000, HILSEN_DISC, HILSEN_DSR, HILSEN_NEXT) | 557 | IN(10000, HILSEN_DISC, HILSEN_DSR, HILSEN_NEXT) |
507 | OUT_DISC(HIL_PKT_CMD | HIL_CMD_ELB) | 558 | OUT_DISC(HIL_PKT_CMD | HIL_CMD_ELB) |
508 | IN(10000, HILSEN_DISC, HILSEN_DSR, HILSEN_NEXT) | 559 | IN(10000, HILSEN_DISC, HILSEN_DSR, HILSEN_NEXT) |
509 | OUT(HIL_PKT_CMD | HIL_CMD_ACF | 1) | 560 | OUT(HIL_PKT_CMD | HIL_CMD_ACF | 1) |
@@ -514,7 +565,7 @@ struct hilse_node hil_mlc_se[HILSEN_END] = { | |||
514 | /* 52 HILSEN_DSR */ | 565 | /* 52 HILSEN_DSR */ |
515 | FUNC(hilse_set_ddi, -1, HILSEN_NEXT, 0, 0) | 566 | FUNC(hilse_set_ddi, -1, HILSEN_NEXT, 0, 0) |
516 | OUT(HIL_PKT_CMD | HIL_CMD_DSR) | 567 | OUT(HIL_PKT_CMD | HIL_CMD_DSR) |
517 | IN(20000, HILSEN_DHR, HILSEN_DHR, HILSEN_IFC) | 568 | IN(20000, HILSEN_DHR, HILSEN_DHR, HILSEN_IFC) |
518 | 569 | ||
519 | /* 55 HILSEN_REPOLL */ | 570 | /* 55 HILSEN_REPOLL */ |
520 | OUT(HIL_PKT_CMD | HIL_CMD_RPL) | 571 | OUT(HIL_PKT_CMD | HIL_CMD_RPL) |
@@ -523,14 +574,15 @@ struct hilse_node hil_mlc_se[HILSEN_END] = { | |||
523 | FUNC(hilse_operate, 1, HILSEN_OPERATE, HILSEN_IFC, HILSEN_PROBE) | 574 | FUNC(hilse_operate, 1, HILSEN_OPERATE, HILSEN_IFC, HILSEN_PROBE) |
524 | 575 | ||
525 | /* 58 HILSEN_IFCACF */ | 576 | /* 58 HILSEN_IFCACF */ |
526 | OUT(HIL_PKT_CMD | HIL_CMD_IFC) | 577 | OUT(HIL_PKT_CMD | HIL_CMD_IFC) |
527 | EXPECT(HIL_PKT_CMD | HIL_CMD_IFC | HIL_ERR_INT, | 578 | EXPECT(HIL_PKT_CMD | HIL_CMD_IFC | HIL_ERR_INT, |
528 | 20000, HILSEN_ACF2, HILSEN_DHR2, HILSEN_HEAL) | 579 | 20000, HILSEN_ACF2, HILSEN_DHR2, HILSEN_HEAL) |
529 | 580 | ||
530 | /* 60 HILSEN_END */ | 581 | /* 60 HILSEN_END */ |
531 | }; | 582 | }; |
532 | 583 | ||
533 | static inline void hilse_setup_input(hil_mlc *mlc, struct hilse_node *node) { | 584 | static inline void hilse_setup_input(hil_mlc *mlc, const struct hilse_node *node) |
585 | { | ||
534 | 586 | ||
535 | switch (node->act) { | 587 | switch (node->act) { |
536 | case HILSE_EXPECT_DISC: | 588 | case HILSE_EXPECT_DISC: |
@@ -555,29 +607,27 @@ static inline void hilse_setup_input(hil_mlc *mlc, struct hilse_node *node) { | |||
555 | do_gettimeofday(&(mlc->instart)); | 607 | do_gettimeofday(&(mlc->instart)); |
556 | mlc->icount = 15; | 608 | mlc->icount = 15; |
557 | memset(mlc->ipacket, 0, 16 * sizeof(hil_packet)); | 609 | memset(mlc->ipacket, 0, 16 * sizeof(hil_packet)); |
558 | BUG_ON(down_trylock(&(mlc->isem))); | 610 | BUG_ON(down_trylock(&mlc->isem)); |
559 | |||
560 | return; | ||
561 | } | 611 | } |
562 | 612 | ||
563 | #ifdef HIL_MLC_DEBUG | 613 | #ifdef HIL_MLC_DEBUG |
564 | static int doze = 0; | 614 | static int doze; |
565 | static int seidx; /* For debug */ | 615 | static int seidx; /* For debug */ |
566 | static int kick = 1; | ||
567 | #endif | 616 | #endif |
568 | 617 | ||
569 | static int hilse_donode (hil_mlc *mlc) { | 618 | static int hilse_donode(hil_mlc *mlc) |
570 | struct hilse_node *node; | 619 | { |
620 | const struct hilse_node *node; | ||
571 | int nextidx = 0; | 621 | int nextidx = 0; |
572 | int sched_long = 0; | 622 | int sched_long = 0; |
573 | unsigned long flags; | 623 | unsigned long flags; |
574 | 624 | ||
575 | #ifdef HIL_MLC_DEBUG | 625 | #ifdef HIL_MLC_DEBUG |
576 | if (mlc->seidx && (mlc->seidx != seidx) && mlc->seidx != 41 && mlc->seidx != 42 && mlc->seidx != 43) { | 626 | if (mlc->seidx && mlc->seidx != seidx && |
577 | printk(KERN_DEBUG PREFIX "z%i \n%s {%i}", doze, kick ? "K" : "", mlc->seidx); | 627 | mlc->seidx != 41 && mlc->seidx != 42 && mlc->seidx != 43) { |
628 | printk(KERN_DEBUG PREFIX "z%i \n {%i}", doze, mlc->seidx); | ||
578 | doze = 0; | 629 | doze = 0; |
579 | } | 630 | } |
580 | kick = 0; | ||
581 | 631 | ||
582 | seidx = mlc->seidx; | 632 | seidx = mlc->seidx; |
583 | #endif | 633 | #endif |
@@ -588,52 +638,61 @@ static int hilse_donode (hil_mlc *mlc) { | |||
588 | hil_packet pack; | 638 | hil_packet pack; |
589 | 639 | ||
590 | case HILSE_FUNC: | 640 | case HILSE_FUNC: |
591 | if (node->object.func == NULL) break; | 641 | BUG_ON(node->object.func == NULL); |
592 | rc = node->object.func(mlc, node->arg); | 642 | rc = node->object.func(mlc, node->arg); |
593 | nextidx = (rc > 0) ? node->ugly : | 643 | nextidx = (rc > 0) ? node->ugly : |
594 | ((rc < 0) ? node->bad : node->good); | 644 | ((rc < 0) ? node->bad : node->good); |
595 | if (nextidx == HILSEN_FOLLOW) nextidx = rc; | 645 | if (nextidx == HILSEN_FOLLOW) |
646 | nextidx = rc; | ||
596 | break; | 647 | break; |
648 | |||
597 | case HILSE_EXPECT_LAST: | 649 | case HILSE_EXPECT_LAST: |
598 | case HILSE_EXPECT_DISC: | 650 | case HILSE_EXPECT_DISC: |
599 | case HILSE_EXPECT: | 651 | case HILSE_EXPECT: |
600 | case HILSE_IN: | 652 | case HILSE_IN: |
601 | /* Already set up from previous HILSE_OUT_* */ | 653 | /* Already set up from previous HILSE_OUT_* */ |
602 | write_lock_irqsave(&(mlc->lock), flags); | 654 | write_lock_irqsave(&mlc->lock, flags); |
603 | rc = mlc->in(mlc, node->arg); | 655 | rc = mlc->in(mlc, node->arg); |
604 | if (rc == 2) { | 656 | if (rc == 2) { |
605 | nextidx = HILSEN_DOZE; | 657 | nextidx = HILSEN_DOZE; |
606 | sched_long = 1; | 658 | sched_long = 1; |
607 | write_unlock_irqrestore(&(mlc->lock), flags); | 659 | write_unlock_irqrestore(&mlc->lock, flags); |
608 | break; | 660 | break; |
609 | } | 661 | } |
610 | if (rc == 1) nextidx = node->ugly; | 662 | if (rc == 1) |
611 | else if (rc == 0) nextidx = node->good; | 663 | nextidx = node->ugly; |
612 | else nextidx = node->bad; | 664 | else if (rc == 0) |
665 | nextidx = node->good; | ||
666 | else | ||
667 | nextidx = node->bad; | ||
613 | mlc->istarted = 0; | 668 | mlc->istarted = 0; |
614 | write_unlock_irqrestore(&(mlc->lock), flags); | 669 | write_unlock_irqrestore(&mlc->lock, flags); |
615 | break; | 670 | break; |
671 | |||
616 | case HILSE_OUT_LAST: | 672 | case HILSE_OUT_LAST: |
617 | write_lock_irqsave(&(mlc->lock), flags); | 673 | write_lock_irqsave(&mlc->lock, flags); |
618 | pack = node->object.packet; | 674 | pack = node->object.packet; |
619 | pack |= ((mlc->ddi + 1) << HIL_PKT_ADDR_SHIFT); | 675 | pack |= ((mlc->ddi + 1) << HIL_PKT_ADDR_SHIFT); |
620 | goto out; | 676 | goto out; |
677 | |||
621 | case HILSE_OUT_DISC: | 678 | case HILSE_OUT_DISC: |
622 | write_lock_irqsave(&(mlc->lock), flags); | 679 | write_lock_irqsave(&mlc->lock, flags); |
623 | pack = node->object.packet; | 680 | pack = node->object.packet; |
624 | pack |= ((mlc->ddi + 2) << HIL_PKT_ADDR_SHIFT); | 681 | pack |= ((mlc->ddi + 2) << HIL_PKT_ADDR_SHIFT); |
625 | goto out; | 682 | goto out; |
683 | |||
626 | case HILSE_OUT: | 684 | case HILSE_OUT: |
627 | write_lock_irqsave(&(mlc->lock), flags); | 685 | write_lock_irqsave(&mlc->lock, flags); |
628 | pack = node->object.packet; | 686 | pack = node->object.packet; |
629 | out: | 687 | out: |
630 | if (mlc->istarted) goto out2; | 688 | if (mlc->istarted) |
689 | goto out2; | ||
631 | /* Prepare to receive input */ | 690 | /* Prepare to receive input */ |
632 | if ((node + 1)->act & HILSE_IN) | 691 | if ((node + 1)->act & HILSE_IN) |
633 | hilse_setup_input(mlc, node + 1); | 692 | hilse_setup_input(mlc, node + 1); |
634 | 693 | ||
635 | out2: | 694 | out2: |
636 | write_unlock_irqrestore(&(mlc->lock), flags); | 695 | write_unlock_irqrestore(&mlc->lock, flags); |
637 | 696 | ||
638 | if (down_trylock(&mlc->osem)) { | 697 | if (down_trylock(&mlc->osem)) { |
639 | nextidx = HILSEN_DOZE; | 698 | nextidx = HILSEN_DOZE; |
@@ -641,60 +700,71 @@ static int hilse_donode (hil_mlc *mlc) { | |||
641 | } | 700 | } |
642 | up(&mlc->osem); | 701 | up(&mlc->osem); |
643 | 702 | ||
644 | write_lock_irqsave(&(mlc->lock), flags); | 703 | write_lock_irqsave(&mlc->lock, flags); |
645 | if (!(mlc->ostarted)) { | 704 | if (!mlc->ostarted) { |
646 | mlc->ostarted = 1; | 705 | mlc->ostarted = 1; |
647 | mlc->opacket = pack; | 706 | mlc->opacket = pack; |
648 | mlc->out(mlc); | 707 | mlc->out(mlc); |
649 | nextidx = HILSEN_DOZE; | 708 | nextidx = HILSEN_DOZE; |
650 | write_unlock_irqrestore(&(mlc->lock), flags); | 709 | write_unlock_irqrestore(&mlc->lock, flags); |
651 | break; | 710 | break; |
652 | } | 711 | } |
653 | mlc->ostarted = 0; | 712 | mlc->ostarted = 0; |
654 | do_gettimeofday(&(mlc->instart)); | 713 | do_gettimeofday(&(mlc->instart)); |
655 | write_unlock_irqrestore(&(mlc->lock), flags); | 714 | write_unlock_irqrestore(&mlc->lock, flags); |
656 | nextidx = HILSEN_NEXT; | 715 | nextidx = HILSEN_NEXT; |
657 | break; | 716 | break; |
717 | |||
658 | case HILSE_CTS: | 718 | case HILSE_CTS: |
719 | write_lock_irqsave(&mlc->lock, flags); | ||
659 | nextidx = mlc->cts(mlc) ? node->bad : node->good; | 720 | nextidx = mlc->cts(mlc) ? node->bad : node->good; |
721 | write_unlock_irqrestore(&mlc->lock, flags); | ||
660 | break; | 722 | break; |
723 | |||
661 | default: | 724 | default: |
662 | BUG(); | 725 | BUG(); |
663 | nextidx = 0; | ||
664 | break; | ||
665 | } | 726 | } |
666 | 727 | ||
667 | #ifdef HIL_MLC_DEBUG | 728 | #ifdef HIL_MLC_DEBUG |
668 | if (nextidx == HILSEN_DOZE) doze++; | 729 | if (nextidx == HILSEN_DOZE) |
730 | doze++; | ||
669 | #endif | 731 | #endif |
670 | 732 | ||
671 | while (nextidx & HILSEN_SCHED) { | 733 | while (nextidx & HILSEN_SCHED) { |
672 | struct timeval tv; | 734 | struct timeval tv; |
673 | 735 | ||
674 | if (!sched_long) goto sched; | 736 | if (!sched_long) |
737 | goto sched; | ||
675 | 738 | ||
676 | do_gettimeofday(&tv); | 739 | do_gettimeofday(&tv); |
677 | tv.tv_usec += 1000000 * (tv.tv_sec - mlc->instart.tv_sec); | 740 | tv.tv_usec += USEC_PER_SEC * (tv.tv_sec - mlc->instart.tv_sec); |
678 | tv.tv_usec -= mlc->instart.tv_usec; | 741 | tv.tv_usec -= mlc->instart.tv_usec; |
679 | if (tv.tv_usec >= mlc->intimeout) goto sched; | 742 | if (tv.tv_usec >= mlc->intimeout) goto sched; |
680 | tv.tv_usec = (mlc->intimeout - tv.tv_usec) * HZ / 1000000; | 743 | tv.tv_usec = (mlc->intimeout - tv.tv_usec) * HZ / USEC_PER_SEC; |
681 | if (!tv.tv_usec) goto sched; | 744 | if (!tv.tv_usec) goto sched; |
682 | mod_timer(&hil_mlcs_kicker, jiffies + tv.tv_usec); | 745 | mod_timer(&hil_mlcs_kicker, jiffies + tv.tv_usec); |
683 | break; | 746 | break; |
684 | sched: | 747 | sched: |
685 | tasklet_schedule(&hil_mlcs_tasklet); | 748 | tasklet_schedule(&hil_mlcs_tasklet); |
686 | break; | 749 | break; |
687 | } | 750 | } |
688 | if (nextidx & HILSEN_DOWN) mlc->seidx += nextidx & HILSEN_MASK; | 751 | |
689 | else if (nextidx & HILSEN_UP) mlc->seidx -= nextidx & HILSEN_MASK; | 752 | if (nextidx & HILSEN_DOWN) |
690 | else mlc->seidx = nextidx & HILSEN_MASK; | 753 | mlc->seidx += nextidx & HILSEN_MASK; |
754 | else if (nextidx & HILSEN_UP) | ||
755 | mlc->seidx -= nextidx & HILSEN_MASK; | ||
756 | else | ||
757 | mlc->seidx = nextidx & HILSEN_MASK; | ||
758 | |||
759 | if (nextidx & HILSEN_BREAK) | ||
760 | return 1; | ||
691 | 761 | ||
692 | if (nextidx & HILSEN_BREAK) return 1; | ||
693 | return 0; | 762 | return 0; |
694 | } | 763 | } |
695 | 764 | ||
696 | /******************** tasklet context functions **************************/ | 765 | /******************** tasklet context functions **************************/ |
697 | static void hil_mlcs_process(unsigned long unused) { | 766 | static void hil_mlcs_process(unsigned long unused) |
767 | { | ||
698 | struct list_head *tmp; | 768 | struct list_head *tmp; |
699 | 769 | ||
700 | read_lock(&hil_mlcs_lock); | 770 | read_lock(&hil_mlcs_lock); |
@@ -702,19 +772,20 @@ static void hil_mlcs_process(unsigned long unused) { | |||
702 | struct hil_mlc *mlc = list_entry(tmp, hil_mlc, list); | 772 | struct hil_mlc *mlc = list_entry(tmp, hil_mlc, list); |
703 | while (hilse_donode(mlc) == 0) { | 773 | while (hilse_donode(mlc) == 0) { |
704 | #ifdef HIL_MLC_DEBUG | 774 | #ifdef HIL_MLC_DEBUG |
705 | if (mlc->seidx != 41 && | 775 | if (mlc->seidx != 41 && |
706 | mlc->seidx != 42 && | 776 | mlc->seidx != 42 && |
707 | mlc->seidx != 43) | 777 | mlc->seidx != 43) |
708 | printk(KERN_DEBUG PREFIX " + "); | 778 | printk(KERN_DEBUG PREFIX " + "); |
709 | #endif | 779 | #endif |
710 | }; | 780 | } |
711 | } | 781 | } |
712 | read_unlock(&hil_mlcs_lock); | 782 | read_unlock(&hil_mlcs_lock); |
713 | } | 783 | } |
714 | 784 | ||
715 | /************************* Keepalive timer task *********************/ | 785 | /************************* Keepalive timer task *********************/ |
716 | 786 | ||
717 | void hil_mlcs_timer (unsigned long data) { | 787 | void hil_mlcs_timer(unsigned long data) |
788 | { | ||
718 | hil_mlcs_probe = 1; | 789 | hil_mlcs_probe = 1; |
719 | tasklet_schedule(&hil_mlcs_tasklet); | 790 | tasklet_schedule(&hil_mlcs_tasklet); |
720 | /* Re-insert the periodic task. */ | 791 | /* Re-insert the periodic task. */ |
@@ -724,28 +795,25 @@ void hil_mlcs_timer (unsigned long data) { | |||
724 | 795 | ||
725 | /******************** user/kernel context functions **********************/ | 796 | /******************** user/kernel context functions **********************/ |
726 | 797 | ||
727 | static int hil_mlc_serio_write(struct serio *serio, unsigned char c) { | 798 | static int hil_mlc_serio_write(struct serio *serio, unsigned char c) |
799 | { | ||
728 | struct hil_mlc_serio_map *map; | 800 | struct hil_mlc_serio_map *map; |
729 | struct hil_mlc *mlc; | 801 | struct hil_mlc *mlc; |
730 | struct serio_driver *drv; | 802 | struct serio_driver *drv; |
731 | uint8_t *idx, *last; | 803 | uint8_t *idx, *last; |
732 | 804 | ||
733 | map = serio->port_data; | 805 | map = serio->port_data; |
734 | if (map == NULL) { | 806 | BUG_ON(map == NULL); |
735 | BUG(); | 807 | |
736 | return -EIO; | ||
737 | } | ||
738 | mlc = map->mlc; | 808 | mlc = map->mlc; |
739 | if (mlc == NULL) { | 809 | BUG_ON(mlc == NULL); |
740 | BUG(); | 810 | |
741 | return -EIO; | 811 | mlc->serio_opacket[map->didx] |= |
742 | } | ||
743 | mlc->serio_opacket[map->didx] |= | ||
744 | ((hil_packet)c) << (8 * (3 - mlc->serio_oidx[map->didx])); | 812 | ((hil_packet)c) << (8 * (3 - mlc->serio_oidx[map->didx])); |
745 | 813 | ||
746 | if (mlc->serio_oidx[map->didx] >= 3) { | 814 | if (mlc->serio_oidx[map->didx] >= 3) { |
747 | /* for now only commands */ | 815 | /* for now only commands */ |
748 | if (!(mlc->serio_opacket[map->didx] & HIL_PKT_CMD)) | 816 | if (!(mlc->serio_opacket[map->didx] & HIL_PKT_CMD)) |
749 | return -EIO; | 817 | return -EIO; |
750 | switch (mlc->serio_opacket[map->didx] & HIL_PKT_DATA_MASK) { | 818 | switch (mlc->serio_opacket[map->didx] & HIL_PKT_DATA_MASK) { |
751 | case HIL_CMD_IDD: | 819 | case HIL_CMD_IDD: |
@@ -771,12 +839,11 @@ static int hil_mlc_serio_write(struct serio *serio, unsigned char c) { | |||
771 | return -EIO; | 839 | return -EIO; |
772 | emu: | 840 | emu: |
773 | drv = serio->drv; | 841 | drv = serio->drv; |
774 | if (drv == NULL) { | 842 | BUG_ON(drv == NULL); |
775 | BUG(); | 843 | |
776 | return -EIO; | ||
777 | } | ||
778 | last = idx + 15; | 844 | last = idx + 15; |
779 | while ((last != idx) && (*last == 0)) last--; | 845 | while ((last != idx) && (*last == 0)) |
846 | last--; | ||
780 | 847 | ||
781 | while (idx != last) { | 848 | while (idx != last) { |
782 | drv->interrupt(serio, 0, 0); | 849 | drv->interrupt(serio, 0, 0); |
@@ -789,14 +856,15 @@ static int hil_mlc_serio_write(struct serio *serio, unsigned char c) { | |||
789 | drv->interrupt(serio, HIL_ERR_INT >> 16, 0); | 856 | drv->interrupt(serio, HIL_ERR_INT >> 16, 0); |
790 | drv->interrupt(serio, HIL_PKT_CMD >> 8, 0); | 857 | drv->interrupt(serio, HIL_PKT_CMD >> 8, 0); |
791 | drv->interrupt(serio, *idx, 0); | 858 | drv->interrupt(serio, *idx, 0); |
792 | 859 | ||
793 | mlc->serio_oidx[map->didx] = 0; | 860 | mlc->serio_oidx[map->didx] = 0; |
794 | mlc->serio_opacket[map->didx] = 0; | 861 | mlc->serio_opacket[map->didx] = 0; |
795 | 862 | ||
796 | return 0; | 863 | return 0; |
797 | } | 864 | } |
798 | 865 | ||
799 | static int hil_mlc_serio_open(struct serio *serio) { | 866 | static int hil_mlc_serio_open(struct serio *serio) |
867 | { | ||
800 | struct hil_mlc_serio_map *map; | 868 | struct hil_mlc_serio_map *map; |
801 | struct hil_mlc *mlc; | 869 | struct hil_mlc *mlc; |
802 | 870 | ||
@@ -804,67 +872,57 @@ static int hil_mlc_serio_open(struct serio *serio) { | |||
804 | return -EBUSY; | 872 | return -EBUSY; |
805 | 873 | ||
806 | map = serio->port_data; | 874 | map = serio->port_data; |
807 | if (map == NULL) { | 875 | BUG_ON(map == NULL); |
808 | BUG(); | 876 | |
809 | return -ENODEV; | ||
810 | } | ||
811 | mlc = map->mlc; | 877 | mlc = map->mlc; |
812 | if (mlc == NULL) { | 878 | BUG_ON(mlc == NULL); |
813 | BUG(); | ||
814 | return -ENODEV; | ||
815 | } | ||
816 | 879 | ||
817 | return 0; | 880 | return 0; |
818 | } | 881 | } |
819 | 882 | ||
820 | static void hil_mlc_serio_close(struct serio *serio) { | 883 | static void hil_mlc_serio_close(struct serio *serio) |
884 | { | ||
821 | struct hil_mlc_serio_map *map; | 885 | struct hil_mlc_serio_map *map; |
822 | struct hil_mlc *mlc; | 886 | struct hil_mlc *mlc; |
823 | 887 | ||
824 | map = serio->port_data; | 888 | map = serio->port_data; |
825 | if (map == NULL) { | 889 | BUG_ON(map == NULL); |
826 | BUG(); | 890 | |
827 | return; | ||
828 | } | ||
829 | mlc = map->mlc; | 891 | mlc = map->mlc; |
830 | if (mlc == NULL) { | 892 | BUG_ON(mlc == NULL); |
831 | BUG(); | ||
832 | return; | ||
833 | } | ||
834 | 893 | ||
835 | serio_set_drvdata(serio, NULL); | 894 | serio_set_drvdata(serio, NULL); |
836 | serio->drv = NULL; | 895 | serio->drv = NULL; |
837 | /* TODO wake up interruptable */ | 896 | /* TODO wake up interruptable */ |
838 | } | 897 | } |
839 | 898 | ||
840 | static struct serio_device_id hil_mlc_serio_id = { | 899 | static const struct serio_device_id hil_mlc_serio_id = { |
841 | .type = SERIO_HIL_MLC, | 900 | .type = SERIO_HIL_MLC, |
842 | .proto = SERIO_HIL, | 901 | .proto = SERIO_HIL, |
843 | .extra = SERIO_ANY, | 902 | .extra = SERIO_ANY, |
844 | .id = SERIO_ANY, | 903 | .id = SERIO_ANY, |
845 | }; | 904 | }; |
846 | 905 | ||
847 | int hil_mlc_register(hil_mlc *mlc) { | 906 | int hil_mlc_register(hil_mlc *mlc) |
907 | { | ||
848 | int i; | 908 | int i; |
849 | unsigned long flags; | 909 | unsigned long flags; |
850 | 910 | ||
851 | if (mlc == NULL) { | 911 | BUG_ON(mlc == NULL); |
852 | return -EINVAL; | ||
853 | } | ||
854 | 912 | ||
855 | mlc->istarted = 0; | 913 | mlc->istarted = 0; |
856 | mlc->ostarted = 0; | 914 | mlc->ostarted = 0; |
857 | 915 | ||
858 | rwlock_init(&mlc->lock); | 916 | rwlock_init(&mlc->lock); |
859 | init_MUTEX(&(mlc->osem)); | 917 | init_MUTEX(&mlc->osem); |
860 | 918 | ||
861 | init_MUTEX(&(mlc->isem)); | 919 | init_MUTEX(&mlc->isem); |
862 | mlc->icount = -1; | 920 | mlc->icount = -1; |
863 | mlc->imatch = 0; | 921 | mlc->imatch = 0; |
864 | 922 | ||
865 | mlc->opercnt = 0; | 923 | mlc->opercnt = 0; |
866 | 924 | ||
867 | init_MUTEX_LOCKED(&(mlc->csem)); | 925 | init_MUTEX_LOCKED(&(mlc->csem)); |
868 | 926 | ||
869 | hil_mlc_clear_di_scratch(mlc); | 927 | hil_mlc_clear_di_scratch(mlc); |
870 | hil_mlc_clear_di_map(mlc, 0); | 928 | hil_mlc_clear_di_map(mlc, 0); |
@@ -873,6 +931,8 @@ int hil_mlc_register(hil_mlc *mlc) { | |||
873 | hil_mlc_copy_di_scratch(mlc, i); | 931 | hil_mlc_copy_di_scratch(mlc, i); |
874 | mlc_serio = kzalloc(sizeof(*mlc_serio), GFP_KERNEL); | 932 | mlc_serio = kzalloc(sizeof(*mlc_serio), GFP_KERNEL); |
875 | mlc->serio[i] = mlc_serio; | 933 | mlc->serio[i] = mlc_serio; |
934 | snprintf(mlc_serio->name, sizeof(mlc_serio->name)-1, "HIL_SERIO%d", i); | ||
935 | snprintf(mlc_serio->phys, sizeof(mlc_serio->phys)-1, "HIL%d", i); | ||
876 | mlc_serio->id = hil_mlc_serio_id; | 936 | mlc_serio->id = hil_mlc_serio_id; |
877 | mlc_serio->write = hil_mlc_serio_write; | 937 | mlc_serio->write = hil_mlc_serio_write; |
878 | mlc_serio->open = hil_mlc_serio_open; | 938 | mlc_serio->open = hil_mlc_serio_open; |
@@ -897,19 +957,18 @@ int hil_mlc_register(hil_mlc *mlc) { | |||
897 | return 0; | 957 | return 0; |
898 | } | 958 | } |
899 | 959 | ||
900 | int hil_mlc_unregister(hil_mlc *mlc) { | 960 | int hil_mlc_unregister(hil_mlc *mlc) |
961 | { | ||
901 | struct list_head *tmp; | 962 | struct list_head *tmp; |
902 | unsigned long flags; | 963 | unsigned long flags; |
903 | int i; | 964 | int i; |
904 | 965 | ||
905 | if (mlc == NULL) | 966 | BUG_ON(mlc == NULL); |
906 | return -EINVAL; | ||
907 | 967 | ||
908 | write_lock_irqsave(&hil_mlcs_lock, flags); | 968 | write_lock_irqsave(&hil_mlcs_lock, flags); |
909 | list_for_each(tmp, &hil_mlcs) { | 969 | list_for_each(tmp, &hil_mlcs) |
910 | if (list_entry(tmp, hil_mlc, list) == mlc) | 970 | if (list_entry(tmp, hil_mlc, list) == mlc) |
911 | goto found; | 971 | goto found; |
912 | } | ||
913 | 972 | ||
914 | /* not found in list */ | 973 | /* not found in list */ |
915 | write_unlock_irqrestore(&hil_mlcs_lock, flags); | 974 | write_unlock_irqrestore(&hil_mlcs_lock, flags); |
@@ -918,7 +977,7 @@ int hil_mlc_unregister(hil_mlc *mlc) { | |||
918 | 977 | ||
919 | found: | 978 | found: |
920 | list_del(tmp); | 979 | list_del(tmp); |
921 | write_unlock_irqrestore(&hil_mlcs_lock, flags); | 980 | write_unlock_irqrestore(&hil_mlcs_lock, flags); |
922 | 981 | ||
923 | for (i = 0; i < HIL_MLC_DEVMEM; i++) { | 982 | for (i = 0; i < HIL_MLC_DEVMEM; i++) { |
924 | serio_unregister_port(mlc->serio[i]); | 983 | serio_unregister_port(mlc->serio[i]); |
@@ -942,7 +1001,7 @@ static int __init hil_mlc_init(void) | |||
942 | 1001 | ||
943 | return 0; | 1002 | return 0; |
944 | } | 1003 | } |
945 | 1004 | ||
946 | static void __exit hil_mlc_exit(void) | 1005 | static void __exit hil_mlc_exit(void) |
947 | { | 1006 | { |
948 | del_timer(&hil_mlcs_kicker); | 1007 | del_timer(&hil_mlcs_kicker); |
@@ -950,6 +1009,6 @@ static void __exit hil_mlc_exit(void) | |||
950 | tasklet_disable(&hil_mlcs_tasklet); | 1009 | tasklet_disable(&hil_mlcs_tasklet); |
951 | tasklet_kill(&hil_mlcs_tasklet); | 1010 | tasklet_kill(&hil_mlcs_tasklet); |
952 | } | 1011 | } |
953 | 1012 | ||
954 | module_init(hil_mlc_init); | 1013 | module_init(hil_mlc_init); |
955 | module_exit(hil_mlc_exit); | 1014 | module_exit(hil_mlc_exit); |
diff --git a/drivers/input/serio/hp_sdc.c b/drivers/input/serio/hp_sdc.c index b57370dc4e3d..6af199805ffc 100644 --- a/drivers/input/serio/hp_sdc.c +++ b/drivers/input/serio/hp_sdc.c | |||
@@ -34,27 +34,27 @@ | |||
34 | * | 34 | * |
35 | * Driver theory of operation: | 35 | * Driver theory of operation: |
36 | * | 36 | * |
37 | * hp_sdc_put does all writing to the SDC. ISR can run on a different | 37 | * hp_sdc_put does all writing to the SDC. ISR can run on a different |
38 | * CPU than hp_sdc_put, but only one CPU runs hp_sdc_put at a time | 38 | * CPU than hp_sdc_put, but only one CPU runs hp_sdc_put at a time |
39 | * (it cannot really benefit from SMP anyway.) A tasket fit this perfectly. | 39 | * (it cannot really benefit from SMP anyway.) A tasket fit this perfectly. |
40 | * | 40 | * |
41 | * All data coming back from the SDC is sent via interrupt and can be read | 41 | * All data coming back from the SDC is sent via interrupt and can be read |
42 | * fully in the ISR, so there are no latency/throughput problems there. | 42 | * fully in the ISR, so there are no latency/throughput problems there. |
43 | * The problem is with output, due to the slow clock speed of the SDC | 43 | * The problem is with output, due to the slow clock speed of the SDC |
44 | * compared to the CPU. This should not be too horrible most of the time, | 44 | * compared to the CPU. This should not be too horrible most of the time, |
45 | * but if used with HIL devices that support the multibyte transfer command, | 45 | * but if used with HIL devices that support the multibyte transfer command, |
46 | * keeping outbound throughput flowing at the 6500KBps that the HIL is | 46 | * keeping outbound throughput flowing at the 6500KBps that the HIL is |
47 | * capable of is more than can be done at HZ=100. | 47 | * capable of is more than can be done at HZ=100. |
48 | * | 48 | * |
49 | * Busy polling for IBF clear wastes CPU cycles and bus cycles. hp_sdc.ibf | 49 | * Busy polling for IBF clear wastes CPU cycles and bus cycles. hp_sdc.ibf |
50 | * is set to 0 when the IBF flag in the status register has cleared. ISR | 50 | * is set to 0 when the IBF flag in the status register has cleared. ISR |
51 | * may do this, and may also access the parts of queued transactions related | 51 | * may do this, and may also access the parts of queued transactions related |
52 | * to reading data back from the SDC, but otherwise will not touch the | 52 | * to reading data back from the SDC, but otherwise will not touch the |
53 | * hp_sdc state. Whenever a register is written hp_sdc.ibf is set to 1. | 53 | * hp_sdc state. Whenever a register is written hp_sdc.ibf is set to 1. |
54 | * | 54 | * |
55 | * The i8042 write index and the values in the 4-byte input buffer | 55 | * The i8042 write index and the values in the 4-byte input buffer |
56 | * starting at 0x70 are kept track of in hp_sdc.wi, and .r7[], respectively, | 56 | * starting at 0x70 are kept track of in hp_sdc.wi, and .r7[], respectively, |
57 | * to minimize the amount of IO needed to the SDC. However these values | 57 | * to minimize the amount of IO needed to the SDC. However these values |
58 | * do not need to be locked since they are only ever accessed by hp_sdc_put. | 58 | * do not need to be locked since they are only ever accessed by hp_sdc_put. |
59 | * | 59 | * |
60 | * A timer task schedules the tasklet once per second just to make | 60 | * A timer task schedules the tasklet once per second just to make |
@@ -100,39 +100,46 @@ EXPORT_SYMBOL(hp_sdc_release_timer_irq); | |||
100 | EXPORT_SYMBOL(hp_sdc_release_hil_irq); | 100 | EXPORT_SYMBOL(hp_sdc_release_hil_irq); |
101 | EXPORT_SYMBOL(hp_sdc_release_cooked_irq); | 101 | EXPORT_SYMBOL(hp_sdc_release_cooked_irq); |
102 | 102 | ||
103 | EXPORT_SYMBOL(__hp_sdc_enqueue_transaction); | ||
103 | EXPORT_SYMBOL(hp_sdc_enqueue_transaction); | 104 | EXPORT_SYMBOL(hp_sdc_enqueue_transaction); |
104 | EXPORT_SYMBOL(hp_sdc_dequeue_transaction); | 105 | EXPORT_SYMBOL(hp_sdc_dequeue_transaction); |
105 | 106 | ||
106 | static hp_i8042_sdc hp_sdc; /* All driver state is kept in here. */ | 107 | static hp_i8042_sdc hp_sdc; /* All driver state is kept in here. */ |
107 | 108 | ||
108 | /*************** primitives for use in any context *********************/ | 109 | /*************** primitives for use in any context *********************/ |
109 | static inline uint8_t hp_sdc_status_in8 (void) { | 110 | static inline uint8_t hp_sdc_status_in8(void) |
111 | { | ||
110 | uint8_t status; | 112 | uint8_t status; |
111 | unsigned long flags; | 113 | unsigned long flags; |
112 | 114 | ||
113 | write_lock_irqsave(&hp_sdc.ibf_lock, flags); | 115 | write_lock_irqsave(&hp_sdc.ibf_lock, flags); |
114 | status = sdc_readb(hp_sdc.status_io); | 116 | status = sdc_readb(hp_sdc.status_io); |
115 | if (!(status & HP_SDC_STATUS_IBF)) hp_sdc.ibf = 0; | 117 | if (!(status & HP_SDC_STATUS_IBF)) |
118 | hp_sdc.ibf = 0; | ||
116 | write_unlock_irqrestore(&hp_sdc.ibf_lock, flags); | 119 | write_unlock_irqrestore(&hp_sdc.ibf_lock, flags); |
117 | 120 | ||
118 | return status; | 121 | return status; |
119 | } | 122 | } |
120 | 123 | ||
121 | static inline uint8_t hp_sdc_data_in8 (void) { | 124 | static inline uint8_t hp_sdc_data_in8(void) |
122 | return sdc_readb(hp_sdc.data_io); | 125 | { |
126 | return sdc_readb(hp_sdc.data_io); | ||
123 | } | 127 | } |
124 | 128 | ||
125 | static inline void hp_sdc_status_out8 (uint8_t val) { | 129 | static inline void hp_sdc_status_out8(uint8_t val) |
130 | { | ||
126 | unsigned long flags; | 131 | unsigned long flags; |
127 | 132 | ||
128 | write_lock_irqsave(&hp_sdc.ibf_lock, flags); | 133 | write_lock_irqsave(&hp_sdc.ibf_lock, flags); |
129 | hp_sdc.ibf = 1; | 134 | hp_sdc.ibf = 1; |
130 | if ((val & 0xf0) == 0xe0) hp_sdc.wi = 0xff; | 135 | if ((val & 0xf0) == 0xe0) |
136 | hp_sdc.wi = 0xff; | ||
131 | sdc_writeb(val, hp_sdc.status_io); | 137 | sdc_writeb(val, hp_sdc.status_io); |
132 | write_unlock_irqrestore(&hp_sdc.ibf_lock, flags); | 138 | write_unlock_irqrestore(&hp_sdc.ibf_lock, flags); |
133 | } | 139 | } |
134 | 140 | ||
135 | static inline void hp_sdc_data_out8 (uint8_t val) { | 141 | static inline void hp_sdc_data_out8(uint8_t val) |
142 | { | ||
136 | unsigned long flags; | 143 | unsigned long flags; |
137 | 144 | ||
138 | write_lock_irqsave(&hp_sdc.ibf_lock, flags); | 145 | write_lock_irqsave(&hp_sdc.ibf_lock, flags); |
@@ -141,11 +148,12 @@ static inline void hp_sdc_data_out8 (uint8_t val) { | |||
141 | write_unlock_irqrestore(&hp_sdc.ibf_lock, flags); | 148 | write_unlock_irqrestore(&hp_sdc.ibf_lock, flags); |
142 | } | 149 | } |
143 | 150 | ||
144 | /* Care must be taken to only invoke hp_sdc_spin_ibf when | 151 | /* Care must be taken to only invoke hp_sdc_spin_ibf when |
145 | * absolutely needed, or in rarely invoked subroutines. | 152 | * absolutely needed, or in rarely invoked subroutines. |
146 | * Not only does it waste CPU cycles, it also wastes bus cycles. | 153 | * Not only does it waste CPU cycles, it also wastes bus cycles. |
147 | */ | 154 | */ |
148 | static inline void hp_sdc_spin_ibf(void) { | 155 | static inline void hp_sdc_spin_ibf(void) |
156 | { | ||
149 | unsigned long flags; | 157 | unsigned long flags; |
150 | rwlock_t *lock; | 158 | rwlock_t *lock; |
151 | 159 | ||
@@ -158,19 +166,21 @@ static inline void hp_sdc_spin_ibf(void) { | |||
158 | } | 166 | } |
159 | read_unlock(lock); | 167 | read_unlock(lock); |
160 | write_lock(lock); | 168 | write_lock(lock); |
161 | while (sdc_readb(hp_sdc.status_io) & HP_SDC_STATUS_IBF) {}; | 169 | while (sdc_readb(hp_sdc.status_io) & HP_SDC_STATUS_IBF) |
170 | { } | ||
162 | hp_sdc.ibf = 0; | 171 | hp_sdc.ibf = 0; |
163 | write_unlock_irqrestore(lock, flags); | 172 | write_unlock_irqrestore(lock, flags); |
164 | } | 173 | } |
165 | 174 | ||
166 | 175 | ||
167 | /************************ Interrupt context functions ************************/ | 176 | /************************ Interrupt context functions ************************/ |
168 | static void hp_sdc_take (int irq, void *dev_id, uint8_t status, uint8_t data) { | 177 | static void hp_sdc_take(int irq, void *dev_id, uint8_t status, uint8_t data) |
178 | { | ||
169 | hp_sdc_transaction *curr; | 179 | hp_sdc_transaction *curr; |
170 | 180 | ||
171 | read_lock(&hp_sdc.rtq_lock); | 181 | read_lock(&hp_sdc.rtq_lock); |
172 | if (hp_sdc.rcurr < 0) { | 182 | if (hp_sdc.rcurr < 0) { |
173 | read_unlock(&hp_sdc.rtq_lock); | 183 | read_unlock(&hp_sdc.rtq_lock); |
174 | return; | 184 | return; |
175 | } | 185 | } |
176 | curr = hp_sdc.tq[hp_sdc.rcurr]; | 186 | curr = hp_sdc.tq[hp_sdc.rcurr]; |
@@ -183,25 +193,27 @@ static void hp_sdc_take (int irq, void *dev_id, uint8_t status, uint8_t data) { | |||
183 | 193 | ||
184 | if (hp_sdc.rqty <= 0) { | 194 | if (hp_sdc.rqty <= 0) { |
185 | /* All data has been gathered. */ | 195 | /* All data has been gathered. */ |
186 | if(curr->seq[curr->actidx] & HP_SDC_ACT_SEMAPHORE) { | 196 | if (curr->seq[curr->actidx] & HP_SDC_ACT_SEMAPHORE) |
187 | if (curr->act.semaphore) up(curr->act.semaphore); | 197 | if (curr->act.semaphore) |
188 | } | 198 | up(curr->act.semaphore); |
189 | if(curr->seq[curr->actidx] & HP_SDC_ACT_CALLBACK) { | 199 | |
200 | if (curr->seq[curr->actidx] & HP_SDC_ACT_CALLBACK) | ||
190 | if (curr->act.irqhook) | 201 | if (curr->act.irqhook) |
191 | curr->act.irqhook(irq, dev_id, status, data); | 202 | curr->act.irqhook(irq, dev_id, status, data); |
192 | } | 203 | |
193 | curr->actidx = curr->idx; | 204 | curr->actidx = curr->idx; |
194 | curr->idx++; | 205 | curr->idx++; |
195 | /* Return control of this transaction */ | 206 | /* Return control of this transaction */ |
196 | write_lock(&hp_sdc.rtq_lock); | 207 | write_lock(&hp_sdc.rtq_lock); |
197 | hp_sdc.rcurr = -1; | 208 | hp_sdc.rcurr = -1; |
198 | hp_sdc.rqty = 0; | 209 | hp_sdc.rqty = 0; |
199 | write_unlock(&hp_sdc.rtq_lock); | 210 | write_unlock(&hp_sdc.rtq_lock); |
200 | tasklet_schedule(&hp_sdc.task); | 211 | tasklet_schedule(&hp_sdc.task); |
201 | } | 212 | } |
202 | } | 213 | } |
203 | 214 | ||
204 | static irqreturn_t hp_sdc_isr(int irq, void *dev_id) { | 215 | static irqreturn_t hp_sdc_isr(int irq, void *dev_id) |
216 | { | ||
205 | uint8_t status, data; | 217 | uint8_t status, data; |
206 | 218 | ||
207 | status = hp_sdc_status_in8(); | 219 | status = hp_sdc_status_in8(); |
@@ -209,67 +221,74 @@ static irqreturn_t hp_sdc_isr(int irq, void *dev_id) { | |||
209 | data = hp_sdc_data_in8(); | 221 | data = hp_sdc_data_in8(); |
210 | 222 | ||
211 | /* For now we are ignoring these until we get the SDC to behave. */ | 223 | /* For now we are ignoring these until we get the SDC to behave. */ |
212 | if (((status & 0xf1) == 0x51) && data == 0x82) { | 224 | if (((status & 0xf1) == 0x51) && data == 0x82) |
213 | return IRQ_HANDLED; | 225 | return IRQ_HANDLED; |
214 | } | ||
215 | 226 | ||
216 | switch(status & HP_SDC_STATUS_IRQMASK) { | 227 | switch (status & HP_SDC_STATUS_IRQMASK) { |
217 | case 0: /* This case is not documented. */ | 228 | case 0: /* This case is not documented. */ |
218 | break; | 229 | break; |
219 | case HP_SDC_STATUS_USERTIMER: | 230 | |
220 | case HP_SDC_STATUS_PERIODIC: | 231 | case HP_SDC_STATUS_USERTIMER: |
221 | case HP_SDC_STATUS_TIMER: | 232 | case HP_SDC_STATUS_PERIODIC: |
233 | case HP_SDC_STATUS_TIMER: | ||
222 | read_lock(&hp_sdc.hook_lock); | 234 | read_lock(&hp_sdc.hook_lock); |
223 | if (hp_sdc.timer != NULL) | 235 | if (hp_sdc.timer != NULL) |
224 | hp_sdc.timer(irq, dev_id, status, data); | 236 | hp_sdc.timer(irq, dev_id, status, data); |
225 | read_unlock(&hp_sdc.hook_lock); | 237 | read_unlock(&hp_sdc.hook_lock); |
226 | break; | 238 | break; |
227 | case HP_SDC_STATUS_REG: | 239 | |
240 | case HP_SDC_STATUS_REG: | ||
228 | hp_sdc_take(irq, dev_id, status, data); | 241 | hp_sdc_take(irq, dev_id, status, data); |
229 | break; | 242 | break; |
230 | case HP_SDC_STATUS_HILCMD: | 243 | |
231 | case HP_SDC_STATUS_HILDATA: | 244 | case HP_SDC_STATUS_HILCMD: |
245 | case HP_SDC_STATUS_HILDATA: | ||
232 | read_lock(&hp_sdc.hook_lock); | 246 | read_lock(&hp_sdc.hook_lock); |
233 | if (hp_sdc.hil != NULL) | 247 | if (hp_sdc.hil != NULL) |
234 | hp_sdc.hil(irq, dev_id, status, data); | 248 | hp_sdc.hil(irq, dev_id, status, data); |
235 | read_unlock(&hp_sdc.hook_lock); | 249 | read_unlock(&hp_sdc.hook_lock); |
236 | break; | 250 | break; |
237 | case HP_SDC_STATUS_PUP: | 251 | |
252 | case HP_SDC_STATUS_PUP: | ||
238 | read_lock(&hp_sdc.hook_lock); | 253 | read_lock(&hp_sdc.hook_lock); |
239 | if (hp_sdc.pup != NULL) | 254 | if (hp_sdc.pup != NULL) |
240 | hp_sdc.pup(irq, dev_id, status, data); | 255 | hp_sdc.pup(irq, dev_id, status, data); |
241 | else printk(KERN_INFO PREFIX "HP SDC reports successful PUP.\n"); | 256 | else |
257 | printk(KERN_INFO PREFIX "HP SDC reports successful PUP.\n"); | ||
242 | read_unlock(&hp_sdc.hook_lock); | 258 | read_unlock(&hp_sdc.hook_lock); |
243 | break; | 259 | break; |
244 | default: | 260 | |
261 | default: | ||
245 | read_lock(&hp_sdc.hook_lock); | 262 | read_lock(&hp_sdc.hook_lock); |
246 | if (hp_sdc.cooked != NULL) | 263 | if (hp_sdc.cooked != NULL) |
247 | hp_sdc.cooked(irq, dev_id, status, data); | 264 | hp_sdc.cooked(irq, dev_id, status, data); |
248 | read_unlock(&hp_sdc.hook_lock); | 265 | read_unlock(&hp_sdc.hook_lock); |
249 | break; | 266 | break; |
250 | } | 267 | } |
268 | |||
251 | return IRQ_HANDLED; | 269 | return IRQ_HANDLED; |
252 | } | 270 | } |
253 | 271 | ||
254 | 272 | ||
255 | static irqreturn_t hp_sdc_nmisr(int irq, void *dev_id) { | 273 | static irqreturn_t hp_sdc_nmisr(int irq, void *dev_id) |
274 | { | ||
256 | int status; | 275 | int status; |
257 | 276 | ||
258 | status = hp_sdc_status_in8(); | 277 | status = hp_sdc_status_in8(); |
259 | printk(KERN_WARNING PREFIX "NMI !\n"); | 278 | printk(KERN_WARNING PREFIX "NMI !\n"); |
260 | 279 | ||
261 | #if 0 | 280 | #if 0 |
262 | if (status & HP_SDC_NMISTATUS_FHS) { | 281 | if (status & HP_SDC_NMISTATUS_FHS) { |
263 | read_lock(&hp_sdc.hook_lock); | 282 | read_lock(&hp_sdc.hook_lock); |
264 | if (hp_sdc.timer != NULL) | 283 | if (hp_sdc.timer != NULL) |
265 | hp_sdc.timer(irq, dev_id, status, 0); | 284 | hp_sdc.timer(irq, dev_id, status, 0); |
266 | read_unlock(&hp_sdc.hook_lock); | 285 | read_unlock(&hp_sdc.hook_lock); |
267 | } | 286 | } else { |
268 | else { | ||
269 | /* TODO: pass this on to the HIL handler, or do SAK here? */ | 287 | /* TODO: pass this on to the HIL handler, or do SAK here? */ |
270 | printk(KERN_WARNING PREFIX "HIL NMI\n"); | 288 | printk(KERN_WARNING PREFIX "HIL NMI\n"); |
271 | } | 289 | } |
272 | #endif | 290 | #endif |
291 | |||
273 | return IRQ_HANDLED; | 292 | return IRQ_HANDLED; |
274 | } | 293 | } |
275 | 294 | ||
@@ -278,13 +297,17 @@ static irqreturn_t hp_sdc_nmisr(int irq, void *dev_id) { | |||
278 | 297 | ||
279 | unsigned long hp_sdc_put(void); | 298 | unsigned long hp_sdc_put(void); |
280 | 299 | ||
281 | static void hp_sdc_tasklet(unsigned long foo) { | 300 | static void hp_sdc_tasklet(unsigned long foo) |
282 | 301 | { | |
283 | write_lock_irq(&hp_sdc.rtq_lock); | 302 | write_lock_irq(&hp_sdc.rtq_lock); |
303 | |||
284 | if (hp_sdc.rcurr >= 0) { | 304 | if (hp_sdc.rcurr >= 0) { |
285 | struct timeval tv; | 305 | struct timeval tv; |
306 | |||
286 | do_gettimeofday(&tv); | 307 | do_gettimeofday(&tv); |
287 | if (tv.tv_sec > hp_sdc.rtv.tv_sec) tv.tv_usec += 1000000; | 308 | if (tv.tv_sec > hp_sdc.rtv.tv_sec) |
309 | tv.tv_usec += USEC_PER_SEC; | ||
310 | |||
288 | if (tv.tv_usec - hp_sdc.rtv.tv_usec > HP_SDC_MAX_REG_DELAY) { | 311 | if (tv.tv_usec - hp_sdc.rtv.tv_usec > HP_SDC_MAX_REG_DELAY) { |
289 | hp_sdc_transaction *curr; | 312 | hp_sdc_transaction *curr; |
290 | uint8_t tmp; | 313 | uint8_t tmp; |
@@ -300,27 +323,29 @@ static void hp_sdc_tasklet(unsigned long foo) { | |||
300 | hp_sdc.rqty = 0; | 323 | hp_sdc.rqty = 0; |
301 | tmp = curr->seq[curr->actidx]; | 324 | tmp = curr->seq[curr->actidx]; |
302 | curr->seq[curr->actidx] |= HP_SDC_ACT_DEAD; | 325 | curr->seq[curr->actidx] |= HP_SDC_ACT_DEAD; |
303 | if(tmp & HP_SDC_ACT_SEMAPHORE) { | 326 | if (tmp & HP_SDC_ACT_SEMAPHORE) |
304 | if (curr->act.semaphore) | 327 | if (curr->act.semaphore) |
305 | up(curr->act.semaphore); | 328 | up(curr->act.semaphore); |
306 | } | 329 | |
307 | if(tmp & HP_SDC_ACT_CALLBACK) { | 330 | if (tmp & HP_SDC_ACT_CALLBACK) { |
308 | /* Note this means that irqhooks may be called | 331 | /* Note this means that irqhooks may be called |
309 | * in tasklet/bh context. | 332 | * in tasklet/bh context. |
310 | */ | 333 | */ |
311 | if (curr->act.irqhook) | 334 | if (curr->act.irqhook) |
312 | curr->act.irqhook(0, NULL, 0, 0); | 335 | curr->act.irqhook(0, NULL, 0, 0); |
313 | } | 336 | } |
337 | |||
314 | curr->actidx = curr->idx; | 338 | curr->actidx = curr->idx; |
315 | curr->idx++; | 339 | curr->idx++; |
316 | hp_sdc.rcurr = -1; | 340 | hp_sdc.rcurr = -1; |
317 | } | 341 | } |
318 | } | 342 | } |
319 | write_unlock_irq(&hp_sdc.rtq_lock); | 343 | write_unlock_irq(&hp_sdc.rtq_lock); |
320 | hp_sdc_put(); | 344 | hp_sdc_put(); |
321 | } | 345 | } |
322 | 346 | ||
323 | unsigned long hp_sdc_put(void) { | 347 | unsigned long hp_sdc_put(void) |
348 | { | ||
324 | hp_sdc_transaction *curr; | 349 | hp_sdc_transaction *curr; |
325 | uint8_t act; | 350 | uint8_t act; |
326 | int idx, curridx; | 351 | int idx, curridx; |
@@ -333,19 +358,24 @@ unsigned long hp_sdc_put(void) { | |||
333 | requires output, so we skip to the administrativa. */ | 358 | requires output, so we skip to the administrativa. */ |
334 | if (hp_sdc.ibf) { | 359 | if (hp_sdc.ibf) { |
335 | hp_sdc_status_in8(); | 360 | hp_sdc_status_in8(); |
336 | if (hp_sdc.ibf) goto finish; | 361 | if (hp_sdc.ibf) |
362 | goto finish; | ||
337 | } | 363 | } |
338 | 364 | ||
339 | anew: | 365 | anew: |
340 | /* See if we are in the middle of a sequence. */ | 366 | /* See if we are in the middle of a sequence. */ |
341 | if (hp_sdc.wcurr < 0) hp_sdc.wcurr = 0; | 367 | if (hp_sdc.wcurr < 0) |
368 | hp_sdc.wcurr = 0; | ||
342 | read_lock_irq(&hp_sdc.rtq_lock); | 369 | read_lock_irq(&hp_sdc.rtq_lock); |
343 | if (hp_sdc.rcurr == hp_sdc.wcurr) hp_sdc.wcurr++; | 370 | if (hp_sdc.rcurr == hp_sdc.wcurr) |
371 | hp_sdc.wcurr++; | ||
344 | read_unlock_irq(&hp_sdc.rtq_lock); | 372 | read_unlock_irq(&hp_sdc.rtq_lock); |
345 | if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) hp_sdc.wcurr = 0; | 373 | if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) |
374 | hp_sdc.wcurr = 0; | ||
346 | curridx = hp_sdc.wcurr; | 375 | curridx = hp_sdc.wcurr; |
347 | 376 | ||
348 | if (hp_sdc.tq[curridx] != NULL) goto start; | 377 | if (hp_sdc.tq[curridx] != NULL) |
378 | goto start; | ||
349 | 379 | ||
350 | while (++curridx != hp_sdc.wcurr) { | 380 | while (++curridx != hp_sdc.wcurr) { |
351 | if (curridx >= HP_SDC_QUEUE_LEN) { | 381 | if (curridx >= HP_SDC_QUEUE_LEN) { |
@@ -358,7 +388,8 @@ unsigned long hp_sdc_put(void) { | |||
358 | continue; | 388 | continue; |
359 | } | 389 | } |
360 | read_unlock_irq(&hp_sdc.rtq_lock); | 390 | read_unlock_irq(&hp_sdc.rtq_lock); |
361 | if (hp_sdc.tq[curridx] != NULL) break; /* Found one. */ | 391 | if (hp_sdc.tq[curridx] != NULL) |
392 | break; /* Found one. */ | ||
362 | } | 393 | } |
363 | if (curridx == hp_sdc.wcurr) { /* There's nothing queued to do. */ | 394 | if (curridx == hp_sdc.wcurr) { /* There's nothing queued to do. */ |
364 | curridx = -1; | 395 | curridx = -1; |
@@ -374,7 +405,8 @@ unsigned long hp_sdc_put(void) { | |||
374 | goto finish; | 405 | goto finish; |
375 | } | 406 | } |
376 | 407 | ||
377 | if (hp_sdc.wcurr == -1) goto done; | 408 | if (hp_sdc.wcurr == -1) |
409 | goto done; | ||
378 | 410 | ||
379 | curr = hp_sdc.tq[curridx]; | 411 | curr = hp_sdc.tq[curridx]; |
380 | idx = curr->actidx; | 412 | idx = curr->actidx; |
@@ -383,20 +415,23 @@ unsigned long hp_sdc_put(void) { | |||
383 | hp_sdc.tq[curridx] = NULL; | 415 | hp_sdc.tq[curridx] = NULL; |
384 | /* Interleave outbound data between the transactions. */ | 416 | /* Interleave outbound data between the transactions. */ |
385 | hp_sdc.wcurr++; | 417 | hp_sdc.wcurr++; |
386 | if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) hp_sdc.wcurr = 0; | 418 | if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) |
387 | goto finish; | 419 | hp_sdc.wcurr = 0; |
420 | goto finish; | ||
388 | } | 421 | } |
389 | 422 | ||
390 | act = curr->seq[idx]; | 423 | act = curr->seq[idx]; |
391 | idx++; | 424 | idx++; |
392 | 425 | ||
393 | if (curr->idx >= curr->endidx) { | 426 | if (curr->idx >= curr->endidx) { |
394 | if (act & HP_SDC_ACT_DEALLOC) kfree(curr); | 427 | if (act & HP_SDC_ACT_DEALLOC) |
428 | kfree(curr); | ||
395 | hp_sdc.tq[curridx] = NULL; | 429 | hp_sdc.tq[curridx] = NULL; |
396 | /* Interleave outbound data between the transactions. */ | 430 | /* Interleave outbound data between the transactions. */ |
397 | hp_sdc.wcurr++; | 431 | hp_sdc.wcurr++; |
398 | if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) hp_sdc.wcurr = 0; | 432 | if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) |
399 | goto finish; | 433 | hp_sdc.wcurr = 0; |
434 | goto finish; | ||
400 | } | 435 | } |
401 | 436 | ||
402 | while (act & HP_SDC_ACT_PRECMD) { | 437 | while (act & HP_SDC_ACT_PRECMD) { |
@@ -409,9 +444,10 @@ unsigned long hp_sdc_put(void) { | |||
409 | curr->idx++; | 444 | curr->idx++; |
410 | /* act finished? */ | 445 | /* act finished? */ |
411 | if ((act & HP_SDC_ACT_DURING) == HP_SDC_ACT_PRECMD) | 446 | if ((act & HP_SDC_ACT_DURING) == HP_SDC_ACT_PRECMD) |
412 | goto actdone; | 447 | goto actdone; |
413 | /* skip quantity field if data-out sequence follows. */ | 448 | /* skip quantity field if data-out sequence follows. */ |
414 | if (act & HP_SDC_ACT_DATAOUT) curr->idx++; | 449 | if (act & HP_SDC_ACT_DATAOUT) |
450 | curr->idx++; | ||
415 | goto finish; | 451 | goto finish; |
416 | } | 452 | } |
417 | if (act & HP_SDC_ACT_DATAOUT) { | 453 | if (act & HP_SDC_ACT_DATAOUT) { |
@@ -423,15 +459,15 @@ unsigned long hp_sdc_put(void) { | |||
423 | hp_sdc_data_out8(curr->seq[curr->idx]); | 459 | hp_sdc_data_out8(curr->seq[curr->idx]); |
424 | curr->idx++; | 460 | curr->idx++; |
425 | /* act finished? */ | 461 | /* act finished? */ |
426 | if ((curr->idx - idx >= qty) && | 462 | if (curr->idx - idx >= qty && |
427 | ((act & HP_SDC_ACT_DURING) == HP_SDC_ACT_DATAOUT)) | 463 | (act & HP_SDC_ACT_DURING) == HP_SDC_ACT_DATAOUT) |
428 | goto actdone; | 464 | goto actdone; |
429 | goto finish; | 465 | goto finish; |
430 | } | 466 | } |
431 | idx += qty; | 467 | idx += qty; |
432 | act &= ~HP_SDC_ACT_DATAOUT; | 468 | act &= ~HP_SDC_ACT_DATAOUT; |
433 | } | 469 | } else |
434 | else while (act & HP_SDC_ACT_DATAREG) { | 470 | while (act & HP_SDC_ACT_DATAREG) { |
435 | int mask; | 471 | int mask; |
436 | uint8_t w7[4]; | 472 | uint8_t w7[4]; |
437 | 473 | ||
@@ -445,26 +481,30 @@ unsigned long hp_sdc_put(void) { | |||
445 | act &= ~HP_SDC_ACT_DATAREG; | 481 | act &= ~HP_SDC_ACT_DATAREG; |
446 | break; | 482 | break; |
447 | } | 483 | } |
448 | 484 | ||
449 | w7[0] = (mask & 1) ? curr->seq[++idx] : hp_sdc.r7[0]; | 485 | w7[0] = (mask & 1) ? curr->seq[++idx] : hp_sdc.r7[0]; |
450 | w7[1] = (mask & 2) ? curr->seq[++idx] : hp_sdc.r7[1]; | 486 | w7[1] = (mask & 2) ? curr->seq[++idx] : hp_sdc.r7[1]; |
451 | w7[2] = (mask & 4) ? curr->seq[++idx] : hp_sdc.r7[2]; | 487 | w7[2] = (mask & 4) ? curr->seq[++idx] : hp_sdc.r7[2]; |
452 | w7[3] = (mask & 8) ? curr->seq[++idx] : hp_sdc.r7[3]; | 488 | w7[3] = (mask & 8) ? curr->seq[++idx] : hp_sdc.r7[3]; |
453 | 489 | ||
454 | if (hp_sdc.wi > 0x73 || hp_sdc.wi < 0x70 || | 490 | if (hp_sdc.wi > 0x73 || hp_sdc.wi < 0x70 || |
455 | w7[hp_sdc.wi-0x70] == hp_sdc.r7[hp_sdc.wi-0x70]) { | 491 | w7[hp_sdc.wi - 0x70] == hp_sdc.r7[hp_sdc.wi - 0x70]) { |
456 | int i = 0; | 492 | int i = 0; |
457 | 493 | ||
458 | /* Need to point the write index register */ | 494 | /* Need to point the write index register */ |
459 | while ((i < 4) && w7[i] == hp_sdc.r7[i]) i++; | 495 | while (i < 4 && w7[i] == hp_sdc.r7[i]) |
496 | i++; | ||
497 | |||
460 | if (i < 4) { | 498 | if (i < 4) { |
461 | hp_sdc_status_out8(HP_SDC_CMD_SET_D0 + i); | 499 | hp_sdc_status_out8(HP_SDC_CMD_SET_D0 + i); |
462 | hp_sdc.wi = 0x70 + i; | 500 | hp_sdc.wi = 0x70 + i; |
463 | goto finish; | 501 | goto finish; |
464 | } | 502 | } |
503 | |||
465 | idx++; | 504 | idx++; |
466 | if ((act & HP_SDC_ACT_DURING) == HP_SDC_ACT_DATAREG) | 505 | if ((act & HP_SDC_ACT_DURING) == HP_SDC_ACT_DATAREG) |
467 | goto actdone; | 506 | goto actdone; |
507 | |||
468 | curr->idx = idx; | 508 | curr->idx = idx; |
469 | act &= ~HP_SDC_ACT_DATAREG; | 509 | act &= ~HP_SDC_ACT_DATAREG; |
470 | break; | 510 | break; |
@@ -476,12 +516,13 @@ unsigned long hp_sdc_put(void) { | |||
476 | { | 516 | { |
477 | int i = 0; | 517 | int i = 0; |
478 | 518 | ||
479 | while ((i < 4) && w7[i] == hp_sdc.r7[i]) i++; | 519 | while ((i < 4) && w7[i] == hp_sdc.r7[i]) |
520 | i++; | ||
480 | if (i >= 4) { | 521 | if (i >= 4) { |
481 | curr->idx = idx + 1; | 522 | curr->idx = idx + 1; |
482 | if ((act & HP_SDC_ACT_DURING) == | 523 | if ((act & HP_SDC_ACT_DURING) == |
483 | HP_SDC_ACT_DATAREG) | 524 | HP_SDC_ACT_DATAREG) |
484 | goto actdone; | 525 | goto actdone; |
485 | } | 526 | } |
486 | } | 527 | } |
487 | goto finish; | 528 | goto finish; |
@@ -497,7 +538,7 @@ unsigned long hp_sdc_put(void) { | |||
497 | 538 | ||
498 | 539 | ||
499 | if (act & HP_SDC_ACT_POSTCMD) { | 540 | if (act & HP_SDC_ACT_POSTCMD) { |
500 | uint8_t postcmd; | 541 | uint8_t postcmd; |
501 | 542 | ||
502 | /* curr->idx should == idx at this point. */ | 543 | /* curr->idx should == idx at this point. */ |
503 | postcmd = curr->seq[idx]; | 544 | postcmd = curr->seq[idx]; |
@@ -505,12 +546,12 @@ unsigned long hp_sdc_put(void) { | |||
505 | if (act & HP_SDC_ACT_DATAIN) { | 546 | if (act & HP_SDC_ACT_DATAIN) { |
506 | 547 | ||
507 | /* Start a new read */ | 548 | /* Start a new read */ |
508 | hp_sdc.rqty = curr->seq[curr->idx]; | 549 | hp_sdc.rqty = curr->seq[curr->idx]; |
509 | do_gettimeofday(&hp_sdc.rtv); | 550 | do_gettimeofday(&hp_sdc.rtv); |
510 | curr->idx++; | 551 | curr->idx++; |
511 | /* Still need to lock here in case of spurious irq. */ | 552 | /* Still need to lock here in case of spurious irq. */ |
512 | write_lock_irq(&hp_sdc.rtq_lock); | 553 | write_lock_irq(&hp_sdc.rtq_lock); |
513 | hp_sdc.rcurr = curridx; | 554 | hp_sdc.rcurr = curridx; |
514 | write_unlock_irq(&hp_sdc.rtq_lock); | 555 | write_unlock_irq(&hp_sdc.rtq_lock); |
515 | hp_sdc_status_out8(postcmd); | 556 | hp_sdc_status_out8(postcmd); |
516 | goto finish; | 557 | goto finish; |
@@ -519,75 +560,86 @@ unsigned long hp_sdc_put(void) { | |||
519 | goto actdone; | 560 | goto actdone; |
520 | } | 561 | } |
521 | 562 | ||
522 | actdone: | 563 | actdone: |
523 | if (act & HP_SDC_ACT_SEMAPHORE) { | 564 | if (act & HP_SDC_ACT_SEMAPHORE) |
524 | up(curr->act.semaphore); | 565 | up(curr->act.semaphore); |
525 | } | 566 | else if (act & HP_SDC_ACT_CALLBACK) |
526 | else if (act & HP_SDC_ACT_CALLBACK) { | ||
527 | curr->act.irqhook(0,NULL,0,0); | 567 | curr->act.irqhook(0,NULL,0,0); |
528 | } | 568 | |
529 | if (curr->idx >= curr->endidx) { /* This transaction is over. */ | 569 | if (curr->idx >= curr->endidx) { /* This transaction is over. */ |
530 | if (act & HP_SDC_ACT_DEALLOC) kfree(curr); | 570 | if (act & HP_SDC_ACT_DEALLOC) |
571 | kfree(curr); | ||
531 | hp_sdc.tq[curridx] = NULL; | 572 | hp_sdc.tq[curridx] = NULL; |
532 | } | 573 | } else { |
533 | else { | ||
534 | curr->actidx = idx + 1; | 574 | curr->actidx = idx + 1; |
535 | curr->idx = idx + 2; | 575 | curr->idx = idx + 2; |
536 | } | 576 | } |
537 | /* Interleave outbound data between the transactions. */ | 577 | /* Interleave outbound data between the transactions. */ |
538 | hp_sdc.wcurr++; | 578 | hp_sdc.wcurr++; |
539 | if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) hp_sdc.wcurr = 0; | 579 | if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) |
580 | hp_sdc.wcurr = 0; | ||
540 | 581 | ||
541 | finish: | 582 | finish: |
542 | /* If by some quirk IBF has cleared and our ISR has run to | 583 | /* If by some quirk IBF has cleared and our ISR has run to |
543 | see that that has happened, do it all again. */ | 584 | see that that has happened, do it all again. */ |
544 | if (!hp_sdc.ibf && limit++ < 20) goto anew; | 585 | if (!hp_sdc.ibf && limit++ < 20) |
586 | goto anew; | ||
545 | 587 | ||
546 | done: | 588 | done: |
547 | if (hp_sdc.wcurr >= 0) tasklet_schedule(&hp_sdc.task); | 589 | if (hp_sdc.wcurr >= 0) |
590 | tasklet_schedule(&hp_sdc.task); | ||
548 | write_unlock(&hp_sdc.lock); | 591 | write_unlock(&hp_sdc.lock); |
592 | |||
549 | return 0; | 593 | return 0; |
550 | } | 594 | } |
551 | 595 | ||
552 | /******* Functions called in either user or kernel context ****/ | 596 | /******* Functions called in either user or kernel context ****/ |
553 | int hp_sdc_enqueue_transaction(hp_sdc_transaction *this) { | 597 | int __hp_sdc_enqueue_transaction(hp_sdc_transaction *this) |
554 | unsigned long flags; | 598 | { |
555 | int i; | 599 | int i; |
556 | 600 | ||
557 | if (this == NULL) { | 601 | if (this == NULL) { |
558 | tasklet_schedule(&hp_sdc.task); | 602 | BUG(); |
559 | return -EINVAL; | 603 | return -EINVAL; |
560 | }; | 604 | } |
561 | |||
562 | write_lock_irqsave(&hp_sdc.lock, flags); | ||
563 | 605 | ||
564 | /* Can't have same transaction on queue twice */ | 606 | /* Can't have same transaction on queue twice */ |
565 | for (i=0; i < HP_SDC_QUEUE_LEN; i++) | 607 | for (i = 0; i < HP_SDC_QUEUE_LEN; i++) |
566 | if (hp_sdc.tq[i] == this) goto fail; | 608 | if (hp_sdc.tq[i] == this) |
609 | goto fail; | ||
567 | 610 | ||
568 | this->actidx = 0; | 611 | this->actidx = 0; |
569 | this->idx = 1; | 612 | this->idx = 1; |
570 | 613 | ||
571 | /* Search for empty slot */ | 614 | /* Search for empty slot */ |
572 | for (i=0; i < HP_SDC_QUEUE_LEN; i++) { | 615 | for (i = 0; i < HP_SDC_QUEUE_LEN; i++) |
573 | if (hp_sdc.tq[i] == NULL) { | 616 | if (hp_sdc.tq[i] == NULL) { |
574 | hp_sdc.tq[i] = this; | 617 | hp_sdc.tq[i] = this; |
575 | write_unlock_irqrestore(&hp_sdc.lock, flags); | ||
576 | tasklet_schedule(&hp_sdc.task); | 618 | tasklet_schedule(&hp_sdc.task); |
577 | return 0; | 619 | return 0; |
578 | } | 620 | } |
579 | } | 621 | |
580 | write_unlock_irqrestore(&hp_sdc.lock, flags); | ||
581 | printk(KERN_WARNING PREFIX "No free slot to add transaction.\n"); | 622 | printk(KERN_WARNING PREFIX "No free slot to add transaction.\n"); |
582 | return -EBUSY; | 623 | return -EBUSY; |
583 | 624 | ||
584 | fail: | 625 | fail: |
585 | write_unlock_irqrestore(&hp_sdc.lock,flags); | ||
586 | printk(KERN_WARNING PREFIX "Transaction add failed: transaction already queued?\n"); | 626 | printk(KERN_WARNING PREFIX "Transaction add failed: transaction already queued?\n"); |
587 | return -EINVAL; | 627 | return -EINVAL; |
588 | } | 628 | } |
589 | 629 | ||
590 | int hp_sdc_dequeue_transaction(hp_sdc_transaction *this) { | 630 | int hp_sdc_enqueue_transaction(hp_sdc_transaction *this) { |
631 | unsigned long flags; | ||
632 | int ret; | ||
633 | |||
634 | write_lock_irqsave(&hp_sdc.lock, flags); | ||
635 | ret = __hp_sdc_enqueue_transaction(this); | ||
636 | write_unlock_irqrestore(&hp_sdc.lock,flags); | ||
637 | |||
638 | return ret; | ||
639 | } | ||
640 | |||
641 | int hp_sdc_dequeue_transaction(hp_sdc_transaction *this) | ||
642 | { | ||
591 | unsigned long flags; | 643 | unsigned long flags; |
592 | int i; | 644 | int i; |
593 | 645 | ||
@@ -595,8 +647,9 @@ int hp_sdc_dequeue_transaction(hp_sdc_transaction *this) { | |||
595 | 647 | ||
596 | /* TODO: don't remove it if it's not done. */ | 648 | /* TODO: don't remove it if it's not done. */ |
597 | 649 | ||
598 | for (i=0; i < HP_SDC_QUEUE_LEN; i++) | 650 | for (i = 0; i < HP_SDC_QUEUE_LEN; i++) |
599 | if (hp_sdc.tq[i] == this) hp_sdc.tq[i] = NULL; | 651 | if (hp_sdc.tq[i] == this) |
652 | hp_sdc.tq[i] = NULL; | ||
600 | 653 | ||
601 | write_unlock_irqrestore(&hp_sdc.lock, flags); | 654 | write_unlock_irqrestore(&hp_sdc.lock, flags); |
602 | return 0; | 655 | return 0; |
@@ -605,11 +658,11 @@ int hp_sdc_dequeue_transaction(hp_sdc_transaction *this) { | |||
605 | 658 | ||
606 | 659 | ||
607 | /********************** User context functions **************************/ | 660 | /********************** User context functions **************************/ |
608 | int hp_sdc_request_timer_irq(hp_sdc_irqhook *callback) { | 661 | int hp_sdc_request_timer_irq(hp_sdc_irqhook *callback) |
609 | 662 | { | |
610 | if (callback == NULL || hp_sdc.dev == NULL) { | 663 | if (callback == NULL || hp_sdc.dev == NULL) |
611 | return -EINVAL; | 664 | return -EINVAL; |
612 | } | 665 | |
613 | write_lock_irq(&hp_sdc.hook_lock); | 666 | write_lock_irq(&hp_sdc.hook_lock); |
614 | if (hp_sdc.timer != NULL) { | 667 | if (hp_sdc.timer != NULL) { |
615 | write_unlock_irq(&hp_sdc.hook_lock); | 668 | write_unlock_irq(&hp_sdc.hook_lock); |
@@ -629,11 +682,11 @@ int hp_sdc_request_timer_irq(hp_sdc_irqhook *callback) { | |||
629 | return 0; | 682 | return 0; |
630 | } | 683 | } |
631 | 684 | ||
632 | int hp_sdc_request_hil_irq(hp_sdc_irqhook *callback) { | 685 | int hp_sdc_request_hil_irq(hp_sdc_irqhook *callback) |
633 | 686 | { | |
634 | if (callback == NULL || hp_sdc.dev == NULL) { | 687 | if (callback == NULL || hp_sdc.dev == NULL) |
635 | return -EINVAL; | 688 | return -EINVAL; |
636 | } | 689 | |
637 | write_lock_irq(&hp_sdc.hook_lock); | 690 | write_lock_irq(&hp_sdc.hook_lock); |
638 | if (hp_sdc.hil != NULL) { | 691 | if (hp_sdc.hil != NULL) { |
639 | write_unlock_irq(&hp_sdc.hook_lock); | 692 | write_unlock_irq(&hp_sdc.hook_lock); |
@@ -650,11 +703,11 @@ int hp_sdc_request_hil_irq(hp_sdc_irqhook *callback) { | |||
650 | return 0; | 703 | return 0; |
651 | } | 704 | } |
652 | 705 | ||
653 | int hp_sdc_request_cooked_irq(hp_sdc_irqhook *callback) { | 706 | int hp_sdc_request_cooked_irq(hp_sdc_irqhook *callback) |
654 | 707 | { | |
655 | if (callback == NULL || hp_sdc.dev == NULL) { | 708 | if (callback == NULL || hp_sdc.dev == NULL) |
656 | return -EINVAL; | 709 | return -EINVAL; |
657 | } | 710 | |
658 | write_lock_irq(&hp_sdc.hook_lock); | 711 | write_lock_irq(&hp_sdc.hook_lock); |
659 | if (hp_sdc.cooked != NULL) { | 712 | if (hp_sdc.cooked != NULL) { |
660 | write_unlock_irq(&hp_sdc.hook_lock); | 713 | write_unlock_irq(&hp_sdc.hook_lock); |
@@ -672,9 +725,8 @@ int hp_sdc_request_cooked_irq(hp_sdc_irqhook *callback) { | |||
672 | return 0; | 725 | return 0; |
673 | } | 726 | } |
674 | 727 | ||
675 | int hp_sdc_release_timer_irq(hp_sdc_irqhook *callback) { | 728 | int hp_sdc_release_timer_irq(hp_sdc_irqhook *callback) |
676 | 729 | { | |
677 | |||
678 | write_lock_irq(&hp_sdc.hook_lock); | 730 | write_lock_irq(&hp_sdc.hook_lock); |
679 | if ((callback != hp_sdc.timer) || | 731 | if ((callback != hp_sdc.timer) || |
680 | (hp_sdc.timer == NULL)) { | 732 | (hp_sdc.timer == NULL)) { |
@@ -694,8 +746,8 @@ int hp_sdc_release_timer_irq(hp_sdc_irqhook *callback) { | |||
694 | return 0; | 746 | return 0; |
695 | } | 747 | } |
696 | 748 | ||
697 | int hp_sdc_release_hil_irq(hp_sdc_irqhook *callback) { | 749 | int hp_sdc_release_hil_irq(hp_sdc_irqhook *callback) |
698 | 750 | { | |
699 | write_lock_irq(&hp_sdc.hook_lock); | 751 | write_lock_irq(&hp_sdc.hook_lock); |
700 | if ((callback != hp_sdc.hil) || | 752 | if ((callback != hp_sdc.hil) || |
701 | (hp_sdc.hil == NULL)) { | 753 | (hp_sdc.hil == NULL)) { |
@@ -715,8 +767,8 @@ int hp_sdc_release_hil_irq(hp_sdc_irqhook *callback) { | |||
715 | return 0; | 767 | return 0; |
716 | } | 768 | } |
717 | 769 | ||
718 | int hp_sdc_release_cooked_irq(hp_sdc_irqhook *callback) { | 770 | int hp_sdc_release_cooked_irq(hp_sdc_irqhook *callback) |
719 | 771 | { | |
720 | write_lock_irq(&hp_sdc.hook_lock); | 772 | write_lock_irq(&hp_sdc.hook_lock); |
721 | if ((callback != hp_sdc.cooked) || | 773 | if ((callback != hp_sdc.cooked) || |
722 | (hp_sdc.cooked == NULL)) { | 774 | (hp_sdc.cooked == NULL)) { |
@@ -738,7 +790,8 @@ int hp_sdc_release_cooked_irq(hp_sdc_irqhook *callback) { | |||
738 | 790 | ||
739 | /************************* Keepalive timer task *********************/ | 791 | /************************* Keepalive timer task *********************/ |
740 | 792 | ||
741 | void hp_sdc_kicker (unsigned long data) { | 793 | void hp_sdc_kicker (unsigned long data) |
794 | { | ||
742 | tasklet_schedule(&hp_sdc.task); | 795 | tasklet_schedule(&hp_sdc.task); |
743 | /* Re-insert the periodic task. */ | 796 | /* Re-insert the periodic task. */ |
744 | mod_timer(&hp_sdc.kicker, jiffies + HZ); | 797 | mod_timer(&hp_sdc.kicker, jiffies + HZ); |
@@ -748,12 +801,12 @@ void hp_sdc_kicker (unsigned long data) { | |||
748 | 801 | ||
749 | #if defined(__hppa__) | 802 | #if defined(__hppa__) |
750 | 803 | ||
751 | static struct parisc_device_id hp_sdc_tbl[] = { | 804 | static const struct parisc_device_id hp_sdc_tbl[] = { |
752 | { | 805 | { |
753 | .hw_type = HPHW_FIO, | 806 | .hw_type = HPHW_FIO, |
754 | .hversion_rev = HVERSION_REV_ANY_ID, | 807 | .hversion_rev = HVERSION_REV_ANY_ID, |
755 | .hversion = HVERSION_ANY_ID, | 808 | .hversion = HVERSION_ANY_ID, |
756 | .sversion = 0x73, | 809 | .sversion = 0x73, |
757 | }, | 810 | }, |
758 | { 0, } | 811 | { 0, } |
759 | }; | 812 | }; |
@@ -772,16 +825,15 @@ static struct parisc_driver hp_sdc_driver = { | |||
772 | 825 | ||
773 | static int __init hp_sdc_init(void) | 826 | static int __init hp_sdc_init(void) |
774 | { | 827 | { |
775 | int i; | ||
776 | char *errstr; | 828 | char *errstr; |
777 | hp_sdc_transaction t_sync; | 829 | hp_sdc_transaction t_sync; |
778 | uint8_t ts_sync[6]; | 830 | uint8_t ts_sync[6]; |
779 | struct semaphore s_sync; | 831 | struct semaphore s_sync; |
780 | 832 | ||
781 | rwlock_init(&hp_sdc.lock); | 833 | rwlock_init(&hp_sdc.lock); |
782 | rwlock_init(&hp_sdc.ibf_lock); | 834 | rwlock_init(&hp_sdc.ibf_lock); |
783 | rwlock_init(&hp_sdc.rtq_lock); | 835 | rwlock_init(&hp_sdc.rtq_lock); |
784 | rwlock_init(&hp_sdc.hook_lock); | 836 | rwlock_init(&hp_sdc.hook_lock); |
785 | 837 | ||
786 | hp_sdc.timer = NULL; | 838 | hp_sdc.timer = NULL; |
787 | hp_sdc.hil = NULL; | 839 | hp_sdc.hil = NULL; |
@@ -796,7 +848,8 @@ static int __init hp_sdc_init(void) | |||
796 | hp_sdc.r7[3] = 0xff; | 848 | hp_sdc.r7[3] = 0xff; |
797 | hp_sdc.ibf = 1; | 849 | hp_sdc.ibf = 1; |
798 | 850 | ||
799 | for (i = 0; i < HP_SDC_QUEUE_LEN; i++) hp_sdc.tq[i] = NULL; | 851 | memset(&hp_sdc.tq, 0, sizeof(hp_sdc.tq)); |
852 | |||
800 | hp_sdc.wcurr = -1; | 853 | hp_sdc.wcurr = -1; |
801 | hp_sdc.rcurr = -1; | 854 | hp_sdc.rcurr = -1; |
802 | hp_sdc.rqty = 0; | 855 | hp_sdc.rqty = 0; |
@@ -804,27 +857,32 @@ static int __init hp_sdc_init(void) | |||
804 | hp_sdc.dev_err = -ENODEV; | 857 | hp_sdc.dev_err = -ENODEV; |
805 | 858 | ||
806 | errstr = "IO not found for"; | 859 | errstr = "IO not found for"; |
807 | if (!hp_sdc.base_io) goto err0; | 860 | if (!hp_sdc.base_io) |
861 | goto err0; | ||
808 | 862 | ||
809 | errstr = "IRQ not found for"; | 863 | errstr = "IRQ not found for"; |
810 | if (!hp_sdc.irq) goto err0; | 864 | if (!hp_sdc.irq) |
865 | goto err0; | ||
811 | 866 | ||
812 | hp_sdc.dev_err = -EBUSY; | 867 | hp_sdc.dev_err = -EBUSY; |
813 | 868 | ||
814 | #if defined(__hppa__) | 869 | #if defined(__hppa__) |
815 | errstr = "IO not available for"; | 870 | errstr = "IO not available for"; |
816 | if (request_region(hp_sdc.data_io, 2, hp_sdc_driver.name)) goto err0; | 871 | if (request_region(hp_sdc.data_io, 2, hp_sdc_driver.name)) |
817 | #endif | 872 | goto err0; |
873 | #endif | ||
818 | 874 | ||
819 | errstr = "IRQ not available for"; | 875 | errstr = "IRQ not available for"; |
820 | if(request_irq(hp_sdc.irq, &hp_sdc_isr, 0, "HP SDC", | 876 | if (request_irq(hp_sdc.irq, &hp_sdc_isr, IRQF_SHARED|IRQF_SAMPLE_RANDOM, |
821 | (void *) hp_sdc.base_io)) goto err1; | 877 | "HP SDC", &hp_sdc)) |
878 | goto err1; | ||
822 | 879 | ||
823 | errstr = "NMI not available for"; | 880 | errstr = "NMI not available for"; |
824 | if (request_irq(hp_sdc.nmi, &hp_sdc_nmisr, 0, "HP SDC NMI", | 881 | if (request_irq(hp_sdc.nmi, &hp_sdc_nmisr, IRQF_SHARED, |
825 | (void *) hp_sdc.base_io)) goto err2; | 882 | "HP SDC NMI", &hp_sdc)) |
883 | goto err2; | ||
826 | 884 | ||
827 | printk(KERN_INFO PREFIX "HP SDC at 0x%p, IRQ %d (NMI IRQ %d)\n", | 885 | printk(KERN_INFO PREFIX "HP SDC at 0x%p, IRQ %d (NMI IRQ %d)\n", |
828 | (void *)hp_sdc.base_io, hp_sdc.irq, hp_sdc.nmi); | 886 | (void *)hp_sdc.base_io, hp_sdc.irq, hp_sdc.nmi); |
829 | 887 | ||
830 | hp_sdc_status_in8(); | 888 | hp_sdc_status_in8(); |
@@ -854,13 +912,14 @@ static int __init hp_sdc_init(void) | |||
854 | hp_sdc.dev_err = 0; | 912 | hp_sdc.dev_err = 0; |
855 | return 0; | 913 | return 0; |
856 | err2: | 914 | err2: |
857 | free_irq(hp_sdc.irq, NULL); | 915 | free_irq(hp_sdc.irq, &hp_sdc); |
858 | err1: | 916 | err1: |
859 | release_region(hp_sdc.data_io, 2); | 917 | release_region(hp_sdc.data_io, 2); |
860 | err0: | 918 | err0: |
861 | printk(KERN_WARNING PREFIX ": %s SDC IO=0x%p IRQ=0x%x NMI=0x%x\n", | 919 | printk(KERN_WARNING PREFIX ": %s SDC IO=0x%p IRQ=0x%x NMI=0x%x\n", |
862 | errstr, (void *)hp_sdc.base_io, hp_sdc.irq, hp_sdc.nmi); | 920 | errstr, (void *)hp_sdc.base_io, hp_sdc.irq, hp_sdc.nmi); |
863 | hp_sdc.dev = NULL; | 921 | hp_sdc.dev = NULL; |
922 | |||
864 | return hp_sdc.dev_err; | 923 | return hp_sdc.dev_err; |
865 | } | 924 | } |
866 | 925 | ||
@@ -868,8 +927,10 @@ static int __init hp_sdc_init(void) | |||
868 | 927 | ||
869 | static int __init hp_sdc_init_hppa(struct parisc_device *d) | 928 | static int __init hp_sdc_init_hppa(struct parisc_device *d) |
870 | { | 929 | { |
871 | if (!d) return 1; | 930 | if (!d) |
872 | if (hp_sdc.dev != NULL) return 1; /* We only expect one SDC */ | 931 | return 1; |
932 | if (hp_sdc.dev != NULL) | ||
933 | return 1; /* We only expect one SDC */ | ||
873 | 934 | ||
874 | hp_sdc.dev = d; | 935 | hp_sdc.dev = d; |
875 | hp_sdc.irq = d->irq; | 936 | hp_sdc.irq = d->irq; |
@@ -898,18 +959,16 @@ static void hp_sdc_exit(void) | |||
898 | /* Wait until we know this has been processed by the i8042 */ | 959 | /* Wait until we know this has been processed by the i8042 */ |
899 | hp_sdc_spin_ibf(); | 960 | hp_sdc_spin_ibf(); |
900 | 961 | ||
901 | free_irq(hp_sdc.nmi, NULL); | 962 | free_irq(hp_sdc.nmi, &hp_sdc); |
902 | free_irq(hp_sdc.irq, NULL); | 963 | free_irq(hp_sdc.irq, &hp_sdc); |
903 | write_unlock_irq(&hp_sdc.lock); | 964 | write_unlock_irq(&hp_sdc.lock); |
904 | 965 | ||
905 | del_timer(&hp_sdc.kicker); | 966 | del_timer(&hp_sdc.kicker); |
906 | 967 | ||
907 | tasklet_kill(&hp_sdc.task); | 968 | tasklet_kill(&hp_sdc.task); |
908 | 969 | ||
909 | /* release_region(hp_sdc.data_io, 2); */ | ||
910 | |||
911 | #if defined(__hppa__) | 970 | #if defined(__hppa__) |
912 | if (unregister_parisc_driver(&hp_sdc_driver)) | 971 | if (unregister_parisc_driver(&hp_sdc_driver)) |
913 | printk(KERN_WARNING PREFIX "Error unregistering HP SDC"); | 972 | printk(KERN_WARNING PREFIX "Error unregistering HP SDC"); |
914 | #endif | 973 | #endif |
915 | } | 974 | } |
@@ -923,7 +982,7 @@ static int __init hp_sdc_register(void) | |||
923 | mm_segment_t fs; | 982 | mm_segment_t fs; |
924 | unsigned char i; | 983 | unsigned char i; |
925 | #endif | 984 | #endif |
926 | 985 | ||
927 | hp_sdc.dev = NULL; | 986 | hp_sdc.dev = NULL; |
928 | hp_sdc.dev_err = 0; | 987 | hp_sdc.dev_err = 0; |
929 | #if defined(__hppa__) | 988 | #if defined(__hppa__) |
@@ -960,8 +1019,8 @@ static int __init hp_sdc_register(void) | |||
960 | tq_init.seq = tq_init_seq; | 1019 | tq_init.seq = tq_init_seq; |
961 | tq_init.act.semaphore = &tq_init_sem; | 1020 | tq_init.act.semaphore = &tq_init_sem; |
962 | 1021 | ||
963 | tq_init_seq[0] = | 1022 | tq_init_seq[0] = |
964 | HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN | HP_SDC_ACT_SEMAPHORE; | 1023 | HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN | HP_SDC_ACT_SEMAPHORE; |
965 | tq_init_seq[1] = HP_SDC_CMD_READ_KCC; | 1024 | tq_init_seq[1] = HP_SDC_CMD_READ_KCC; |
966 | tq_init_seq[2] = 1; | 1025 | tq_init_seq[2] = 1; |
967 | tq_init_seq[3] = 0; | 1026 | tq_init_seq[3] = 0; |
@@ -979,13 +1038,13 @@ static int __init hp_sdc_register(void) | |||
979 | } | 1038 | } |
980 | hp_sdc.r11 = tq_init_seq[4]; | 1039 | hp_sdc.r11 = tq_init_seq[4]; |
981 | if (hp_sdc.r11 & HP_SDC_CFG_NEW) { | 1040 | if (hp_sdc.r11 & HP_SDC_CFG_NEW) { |
982 | char *str; | 1041 | const char *str; |
983 | printk(KERN_INFO PREFIX "New style SDC\n"); | 1042 | printk(KERN_INFO PREFIX "New style SDC\n"); |
984 | tq_init_seq[1] = HP_SDC_CMD_READ_XTD; | 1043 | tq_init_seq[1] = HP_SDC_CMD_READ_XTD; |
985 | tq_init.actidx = 0; | 1044 | tq_init.actidx = 0; |
986 | tq_init.idx = 1; | 1045 | tq_init.idx = 1; |
987 | down(&tq_init_sem); | 1046 | down(&tq_init_sem); |
988 | hp_sdc_enqueue_transaction(&tq_init); | 1047 | hp_sdc_enqueue_transaction(&tq_init); |
989 | down(&tq_init_sem); | 1048 | down(&tq_init_sem); |
990 | up(&tq_init_sem); | 1049 | up(&tq_init_sem); |
991 | if ((tq_init_seq[0] & HP_SDC_ACT_DEAD) == HP_SDC_ACT_DEAD) { | 1050 | if ((tq_init_seq[0] & HP_SDC_ACT_DEAD) == HP_SDC_ACT_DEAD) { |
@@ -995,15 +1054,13 @@ static int __init hp_sdc_register(void) | |||
995 | hp_sdc.r7e = tq_init_seq[4]; | 1054 | hp_sdc.r7e = tq_init_seq[4]; |
996 | HP_SDC_XTD_REV_STRINGS(hp_sdc.r7e & HP_SDC_XTD_REV, str) | 1055 | HP_SDC_XTD_REV_STRINGS(hp_sdc.r7e & HP_SDC_XTD_REV, str) |
997 | printk(KERN_INFO PREFIX "Revision: %s\n", str); | 1056 | printk(KERN_INFO PREFIX "Revision: %s\n", str); |
998 | if (hp_sdc.r7e & HP_SDC_XTD_BEEPER) { | 1057 | if (hp_sdc.r7e & HP_SDC_XTD_BEEPER) |
999 | printk(KERN_INFO PREFIX "TI SN76494 beeper present\n"); | 1058 | printk(KERN_INFO PREFIX "TI SN76494 beeper present\n"); |
1000 | } | 1059 | if (hp_sdc.r7e & HP_SDC_XTD_BBRTC) |
1001 | if (hp_sdc.r7e & HP_SDC_XTD_BBRTC) { | ||
1002 | printk(KERN_INFO PREFIX "OKI MSM-58321 BBRTC present\n"); | 1060 | printk(KERN_INFO PREFIX "OKI MSM-58321 BBRTC present\n"); |
1003 | } | ||
1004 | printk(KERN_INFO PREFIX "Spunking the self test register to force PUP " | 1061 | printk(KERN_INFO PREFIX "Spunking the self test register to force PUP " |
1005 | "on next firmware reset.\n"); | 1062 | "on next firmware reset.\n"); |
1006 | tq_init_seq[0] = HP_SDC_ACT_PRECMD | | 1063 | tq_init_seq[0] = HP_SDC_ACT_PRECMD | |
1007 | HP_SDC_ACT_DATAOUT | HP_SDC_ACT_SEMAPHORE; | 1064 | HP_SDC_ACT_DATAOUT | HP_SDC_ACT_SEMAPHORE; |
1008 | tq_init_seq[1] = HP_SDC_CMD_SET_STR; | 1065 | tq_init_seq[1] = HP_SDC_CMD_SET_STR; |
1009 | tq_init_seq[2] = 1; | 1066 | tq_init_seq[2] = 1; |
@@ -1012,14 +1069,12 @@ static int __init hp_sdc_register(void) | |||
1012 | tq_init.idx = 1; | 1069 | tq_init.idx = 1; |
1013 | tq_init.endidx = 4; | 1070 | tq_init.endidx = 4; |
1014 | down(&tq_init_sem); | 1071 | down(&tq_init_sem); |
1015 | hp_sdc_enqueue_transaction(&tq_init); | 1072 | hp_sdc_enqueue_transaction(&tq_init); |
1016 | down(&tq_init_sem); | 1073 | down(&tq_init_sem); |
1017 | up(&tq_init_sem); | 1074 | up(&tq_init_sem); |
1018 | } | 1075 | } else |
1019 | else { | 1076 | printk(KERN_INFO PREFIX "Old style SDC (1820-%s).\n", |
1020 | printk(KERN_INFO PREFIX "Old style SDC (1820-%s).\n", | ||
1021 | (hp_sdc.r11 & HP_SDC_CFG_REV) ? "3300" : "2564/3087"); | 1077 | (hp_sdc.r11 & HP_SDC_CFG_REV) ? "3300" : "2564/3087"); |
1022 | } | ||
1023 | 1078 | ||
1024 | return 0; | 1079 | return 0; |
1025 | } | 1080 | } |
@@ -1027,13 +1082,13 @@ static int __init hp_sdc_register(void) | |||
1027 | module_init(hp_sdc_register); | 1082 | module_init(hp_sdc_register); |
1028 | module_exit(hp_sdc_exit); | 1083 | module_exit(hp_sdc_exit); |
1029 | 1084 | ||
1030 | /* Timing notes: These measurements taken on my 64MHz 7100-LC (715/64) | 1085 | /* Timing notes: These measurements taken on my 64MHz 7100-LC (715/64) |
1031 | * cycles cycles-adj time | 1086 | * cycles cycles-adj time |
1032 | * between two consecutive mfctl(16)'s: 4 n/a 63ns | 1087 | * between two consecutive mfctl(16)'s: 4 n/a 63ns |
1033 | * hp_sdc_spin_ibf when idle: 119 115 1.7us | 1088 | * hp_sdc_spin_ibf when idle: 119 115 1.7us |
1034 | * gsc_writeb status register: 83 79 1.2us | 1089 | * gsc_writeb status register: 83 79 1.2us |
1035 | * IBF to clear after sending SET_IM: 6204 6006 93us | 1090 | * IBF to clear after sending SET_IM: 6204 6006 93us |
1036 | * IBF to clear after sending LOAD_RT: 4467 4352 68us | 1091 | * IBF to clear after sending LOAD_RT: 4467 4352 68us |
1037 | * IBF to clear after sending two LOAD_RTs: 18974 18859 295us | 1092 | * IBF to clear after sending two LOAD_RTs: 18974 18859 295us |
1038 | * READ_T1, read status/data, IRQ, call handler: 35564 n/a 556us | 1093 | * READ_T1, read status/data, IRQ, call handler: 35564 n/a 556us |
1039 | * cmd to ~IBF READ_T1 2nd time right after: 5158403 n/a 81ms | 1094 | * cmd to ~IBF READ_T1 2nd time right after: 5158403 n/a 81ms |
diff --git a/drivers/input/serio/hp_sdc_mlc.c b/drivers/input/serio/hp_sdc_mlc.c index aa4a8a4ccfdb..c45ea74d53e4 100644 --- a/drivers/input/serio/hp_sdc_mlc.c +++ b/drivers/input/serio/hp_sdc_mlc.c | |||
@@ -58,12 +58,13 @@ struct hp_sdc_mlc_priv_s { | |||
58 | } hp_sdc_mlc_priv; | 58 | } hp_sdc_mlc_priv; |
59 | 59 | ||
60 | /************************* Interrupt context ******************************/ | 60 | /************************* Interrupt context ******************************/ |
61 | static void hp_sdc_mlc_isr (int irq, void *dev_id, | 61 | static void hp_sdc_mlc_isr (int irq, void *dev_id, |
62 | uint8_t status, uint8_t data) { | 62 | uint8_t status, uint8_t data) |
63 | int idx; | 63 | { |
64 | int idx; | ||
64 | hil_mlc *mlc = &hp_sdc_mlc; | 65 | hil_mlc *mlc = &hp_sdc_mlc; |
65 | 66 | ||
66 | write_lock(&(mlc->lock)); | 67 | write_lock(&mlc->lock); |
67 | if (mlc->icount < 0) { | 68 | if (mlc->icount < 0) { |
68 | printk(KERN_WARNING PREFIX "HIL Overflow!\n"); | 69 | printk(KERN_WARNING PREFIX "HIL Overflow!\n"); |
69 | up(&mlc->isem); | 70 | up(&mlc->isem); |
@@ -73,239 +74,232 @@ static void hp_sdc_mlc_isr (int irq, void *dev_id, | |||
73 | if ((status & HP_SDC_STATUS_IRQMASK) == HP_SDC_STATUS_HILDATA) { | 74 | if ((status & HP_SDC_STATUS_IRQMASK) == HP_SDC_STATUS_HILDATA) { |
74 | mlc->ipacket[idx] |= data | HIL_ERR_INT; | 75 | mlc->ipacket[idx] |= data | HIL_ERR_INT; |
75 | mlc->icount--; | 76 | mlc->icount--; |
76 | if (hp_sdc_mlc_priv.got5x) goto check; | 77 | if (hp_sdc_mlc_priv.got5x || !idx) |
77 | if (!idx) goto check; | 78 | goto check; |
78 | if ((mlc->ipacket[idx-1] & HIL_PKT_ADDR_MASK) != | 79 | if ((mlc->ipacket[idx - 1] & HIL_PKT_ADDR_MASK) != |
79 | (mlc->ipacket[idx] & HIL_PKT_ADDR_MASK)) { | 80 | (mlc->ipacket[idx] & HIL_PKT_ADDR_MASK)) { |
80 | mlc->ipacket[idx] &= ~HIL_PKT_ADDR_MASK; | 81 | mlc->ipacket[idx] &= ~HIL_PKT_ADDR_MASK; |
81 | mlc->ipacket[idx] |= (mlc->ipacket[idx-1] | 82 | mlc->ipacket[idx] |= (mlc->ipacket[idx - 1] |
82 | & HIL_PKT_ADDR_MASK); | 83 | & HIL_PKT_ADDR_MASK); |
83 | } | 84 | } |
84 | goto check; | 85 | goto check; |
85 | } | 86 | } |
86 | /* We know status is 5X */ | 87 | /* We know status is 5X */ |
87 | if (data & HP_SDC_HIL_ISERR) goto err; | 88 | if (data & HP_SDC_HIL_ISERR) |
88 | mlc->ipacket[idx] = | 89 | goto err; |
90 | mlc->ipacket[idx] = | ||
89 | (data & HP_SDC_HIL_R1MASK) << HIL_PKT_ADDR_SHIFT; | 91 | (data & HP_SDC_HIL_R1MASK) << HIL_PKT_ADDR_SHIFT; |
90 | hp_sdc_mlc_priv.got5x = 1; | 92 | hp_sdc_mlc_priv.got5x = 1; |
91 | goto out; | 93 | goto out; |
92 | 94 | ||
93 | check: | 95 | check: |
94 | hp_sdc_mlc_priv.got5x = 0; | 96 | hp_sdc_mlc_priv.got5x = 0; |
95 | if (mlc->imatch == 0) goto done; | 97 | if (mlc->imatch == 0) |
96 | if ((mlc->imatch == (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_POL)) | 98 | goto done; |
97 | && (mlc->ipacket[idx] == (mlc->imatch | idx))) goto done; | 99 | if ((mlc->imatch == (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_POL)) |
98 | if (mlc->ipacket[idx] == mlc->imatch) goto done; | 100 | && (mlc->ipacket[idx] == (mlc->imatch | idx))) |
101 | goto done; | ||
102 | if (mlc->ipacket[idx] == mlc->imatch) | ||
103 | goto done; | ||
99 | goto out; | 104 | goto out; |
100 | 105 | ||
101 | err: | 106 | err: |
102 | printk(KERN_DEBUG PREFIX "err code %x\n", data); | 107 | printk(KERN_DEBUG PREFIX "err code %x\n", data); |
108 | |||
103 | switch (data) { | 109 | switch (data) { |
104 | case HP_SDC_HIL_RC_DONE: | 110 | case HP_SDC_HIL_RC_DONE: |
105 | printk(KERN_WARNING PREFIX "Bastard SDC reconfigured loop!\n"); | 111 | printk(KERN_WARNING PREFIX "Bastard SDC reconfigured loop!\n"); |
106 | break; | 112 | break; |
113 | |||
107 | case HP_SDC_HIL_ERR: | 114 | case HP_SDC_HIL_ERR: |
108 | mlc->ipacket[idx] |= HIL_ERR_INT | HIL_ERR_PERR | | 115 | mlc->ipacket[idx] |= HIL_ERR_INT | HIL_ERR_PERR | |
109 | HIL_ERR_FERR | HIL_ERR_FOF; | 116 | HIL_ERR_FERR | HIL_ERR_FOF; |
110 | break; | 117 | break; |
118 | |||
111 | case HP_SDC_HIL_TO: | 119 | case HP_SDC_HIL_TO: |
112 | mlc->ipacket[idx] |= HIL_ERR_INT | HIL_ERR_LERR; | 120 | mlc->ipacket[idx] |= HIL_ERR_INT | HIL_ERR_LERR; |
113 | break; | 121 | break; |
122 | |||
114 | case HP_SDC_HIL_RC: | 123 | case HP_SDC_HIL_RC: |
115 | printk(KERN_WARNING PREFIX "Bastard SDC decided to reconfigure loop!\n"); | 124 | printk(KERN_WARNING PREFIX "Bastard SDC decided to reconfigure loop!\n"); |
116 | break; | 125 | break; |
126 | |||
117 | default: | 127 | default: |
118 | printk(KERN_WARNING PREFIX "Unkown HIL Error status (%x)!\n", data); | 128 | printk(KERN_WARNING PREFIX "Unkown HIL Error status (%x)!\n", data); |
119 | break; | 129 | break; |
120 | } | 130 | } |
131 | |||
121 | /* No more data will be coming due to an error. */ | 132 | /* No more data will be coming due to an error. */ |
122 | done: | 133 | done: |
123 | tasklet_schedule(mlc->tasklet); | 134 | tasklet_schedule(mlc->tasklet); |
124 | up(&(mlc->isem)); | 135 | up(&mlc->isem); |
125 | out: | 136 | out: |
126 | write_unlock(&(mlc->lock)); | 137 | write_unlock(&mlc->lock); |
127 | } | 138 | } |
128 | 139 | ||
129 | 140 | ||
130 | /******************** Tasklet or userspace context functions ****************/ | 141 | /******************** Tasklet or userspace context functions ****************/ |
131 | 142 | ||
132 | static int hp_sdc_mlc_in (hil_mlc *mlc, suseconds_t timeout) { | 143 | static int hp_sdc_mlc_in(hil_mlc *mlc, suseconds_t timeout) |
133 | unsigned long flags; | 144 | { |
134 | struct hp_sdc_mlc_priv_s *priv; | 145 | struct hp_sdc_mlc_priv_s *priv; |
135 | int rc = 2; | 146 | int rc = 2; |
136 | 147 | ||
137 | priv = mlc->priv; | 148 | priv = mlc->priv; |
138 | 149 | ||
139 | write_lock_irqsave(&(mlc->lock), flags); | ||
140 | |||
141 | /* Try to down the semaphore */ | 150 | /* Try to down the semaphore */ |
142 | if (down_trylock(&(mlc->isem))) { | 151 | if (down_trylock(&mlc->isem)) { |
143 | struct timeval tv; | 152 | struct timeval tv; |
144 | if (priv->emtestmode) { | 153 | if (priv->emtestmode) { |
145 | mlc->ipacket[0] = | 154 | mlc->ipacket[0] = |
146 | HIL_ERR_INT | (mlc->opacket & | 155 | HIL_ERR_INT | (mlc->opacket & |
147 | (HIL_PKT_CMD | | 156 | (HIL_PKT_CMD | |
148 | HIL_PKT_ADDR_MASK | | 157 | HIL_PKT_ADDR_MASK | |
149 | HIL_PKT_DATA_MASK)); | 158 | HIL_PKT_DATA_MASK)); |
150 | mlc->icount = 14; | 159 | mlc->icount = 14; |
151 | /* printk(KERN_DEBUG PREFIX ">[%x]\n", mlc->ipacket[0]); */ | 160 | /* printk(KERN_DEBUG PREFIX ">[%x]\n", mlc->ipacket[0]); */ |
152 | goto wasup; | 161 | goto wasup; |
153 | } | 162 | } |
154 | do_gettimeofday(&tv); | 163 | do_gettimeofday(&tv); |
155 | tv.tv_usec += 1000000 * (tv.tv_sec - mlc->instart.tv_sec); | 164 | tv.tv_usec += USEC_PER_SEC * (tv.tv_sec - mlc->instart.tv_sec); |
156 | if (tv.tv_usec - mlc->instart.tv_usec > mlc->intimeout) { | 165 | if (tv.tv_usec - mlc->instart.tv_usec > mlc->intimeout) { |
157 | /* printk("!%i %i", | 166 | /* printk("!%i %i", |
158 | tv.tv_usec - mlc->instart.tv_usec, | 167 | tv.tv_usec - mlc->instart.tv_usec, |
159 | mlc->intimeout); | 168 | mlc->intimeout); |
160 | */ | 169 | */ |
161 | rc = 1; | 170 | rc = 1; |
162 | up(&(mlc->isem)); | 171 | up(&mlc->isem); |
163 | } | 172 | } |
164 | goto done; | 173 | goto done; |
165 | } | 174 | } |
166 | wasup: | 175 | wasup: |
167 | up(&(mlc->isem)); | 176 | up(&mlc->isem); |
168 | rc = 0; | 177 | rc = 0; |
169 | goto done; | ||
170 | done: | 178 | done: |
171 | write_unlock_irqrestore(&(mlc->lock), flags); | ||
172 | return rc; | 179 | return rc; |
173 | } | 180 | } |
174 | 181 | ||
175 | static int hp_sdc_mlc_cts (hil_mlc *mlc) { | 182 | static int hp_sdc_mlc_cts(hil_mlc *mlc) |
183 | { | ||
176 | struct hp_sdc_mlc_priv_s *priv; | 184 | struct hp_sdc_mlc_priv_s *priv; |
177 | unsigned long flags; | ||
178 | 185 | ||
179 | priv = mlc->priv; | 186 | priv = mlc->priv; |
180 | |||
181 | write_lock_irqsave(&(mlc->lock), flags); | ||
182 | 187 | ||
183 | /* Try to down the semaphores -- they should be up. */ | 188 | /* Try to down the semaphores -- they should be up. */ |
184 | if (down_trylock(&(mlc->isem))) { | 189 | BUG_ON(down_trylock(&mlc->isem)); |
185 | BUG(); | 190 | BUG_ON(down_trylock(&mlc->osem)); |
186 | goto busy; | 191 | |
187 | } | 192 | up(&mlc->isem); |
188 | if (down_trylock(&(mlc->osem))) { | 193 | up(&mlc->osem); |
189 | BUG(); | ||
190 | up(&(mlc->isem)); | ||
191 | goto busy; | ||
192 | } | ||
193 | up(&(mlc->isem)); | ||
194 | up(&(mlc->osem)); | ||
195 | 194 | ||
196 | if (down_trylock(&(mlc->csem))) { | 195 | if (down_trylock(&mlc->csem)) { |
197 | if (priv->trans.act.semaphore != &(mlc->csem)) goto poll; | 196 | if (priv->trans.act.semaphore != &mlc->csem) |
198 | goto busy; | 197 | goto poll; |
198 | else | ||
199 | goto busy; | ||
199 | } | 200 | } |
200 | if (!(priv->tseq[4] & HP_SDC_USE_LOOP)) goto done; | 201 | |
202 | if (!(priv->tseq[4] & HP_SDC_USE_LOOP)) | ||
203 | goto done; | ||
201 | 204 | ||
202 | poll: | 205 | poll: |
203 | priv->trans.act.semaphore = &(mlc->csem); | 206 | priv->trans.act.semaphore = &mlc->csem; |
204 | priv->trans.actidx = 0; | 207 | priv->trans.actidx = 0; |
205 | priv->trans.idx = 1; | 208 | priv->trans.idx = 1; |
206 | priv->trans.endidx = 5; | 209 | priv->trans.endidx = 5; |
207 | priv->tseq[0] = | 210 | priv->tseq[0] = |
208 | HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN | HP_SDC_ACT_SEMAPHORE; | 211 | HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN | HP_SDC_ACT_SEMAPHORE; |
209 | priv->tseq[1] = HP_SDC_CMD_READ_USE; | 212 | priv->tseq[1] = HP_SDC_CMD_READ_USE; |
210 | priv->tseq[2] = 1; | 213 | priv->tseq[2] = 1; |
211 | priv->tseq[3] = 0; | 214 | priv->tseq[3] = 0; |
212 | priv->tseq[4] = 0; | 215 | priv->tseq[4] = 0; |
213 | hp_sdc_enqueue_transaction(&(priv->trans)); | 216 | __hp_sdc_enqueue_transaction(&priv->trans); |
214 | busy: | 217 | busy: |
215 | write_unlock_irqrestore(&(mlc->lock), flags); | ||
216 | return 1; | 218 | return 1; |
217 | done: | 219 | done: |
218 | priv->trans.act.semaphore = &(mlc->osem); | 220 | priv->trans.act.semaphore = &mlc->osem; |
219 | up(&(mlc->csem)); | 221 | up(&mlc->csem); |
220 | write_unlock_irqrestore(&(mlc->lock), flags); | ||
221 | return 0; | 222 | return 0; |
222 | } | 223 | } |
223 | 224 | ||
224 | static void hp_sdc_mlc_out (hil_mlc *mlc) { | 225 | static void hp_sdc_mlc_out(hil_mlc *mlc) |
226 | { | ||
225 | struct hp_sdc_mlc_priv_s *priv; | 227 | struct hp_sdc_mlc_priv_s *priv; |
226 | unsigned long flags; | ||
227 | 228 | ||
228 | priv = mlc->priv; | 229 | priv = mlc->priv; |
229 | 230 | ||
230 | write_lock_irqsave(&(mlc->lock), flags); | ||
231 | |||
232 | /* Try to down the semaphore -- it should be up. */ | 231 | /* Try to down the semaphore -- it should be up. */ |
233 | if (down_trylock(&(mlc->osem))) { | 232 | BUG_ON(down_trylock(&mlc->osem)); |
234 | BUG(); | ||
235 | goto done; | ||
236 | } | ||
237 | 233 | ||
238 | if (mlc->opacket & HIL_DO_ALTER_CTRL) goto do_control; | 234 | if (mlc->opacket & HIL_DO_ALTER_CTRL) |
235 | goto do_control; | ||
239 | 236 | ||
240 | do_data: | 237 | do_data: |
241 | if (priv->emtestmode) { | 238 | if (priv->emtestmode) { |
242 | up(&(mlc->osem)); | 239 | up(&mlc->osem); |
243 | goto done; | 240 | return; |
244 | } | 241 | } |
245 | /* Shouldn't be sending commands when loop may be busy */ | 242 | /* Shouldn't be sending commands when loop may be busy */ |
246 | if (down_trylock(&(mlc->csem))) { | 243 | BUG_ON(down_trylock(&mlc->csem)); |
247 | BUG(); | 244 | up(&mlc->csem); |
248 | goto done; | ||
249 | } | ||
250 | up(&(mlc->csem)); | ||
251 | 245 | ||
252 | priv->trans.actidx = 0; | 246 | priv->trans.actidx = 0; |
253 | priv->trans.idx = 1; | 247 | priv->trans.idx = 1; |
254 | priv->trans.act.semaphore = &(mlc->osem); | 248 | priv->trans.act.semaphore = &mlc->osem; |
255 | priv->trans.endidx = 6; | 249 | priv->trans.endidx = 6; |
256 | priv->tseq[0] = | 250 | priv->tseq[0] = |
257 | HP_SDC_ACT_DATAREG | HP_SDC_ACT_POSTCMD | HP_SDC_ACT_SEMAPHORE; | 251 | HP_SDC_ACT_DATAREG | HP_SDC_ACT_POSTCMD | HP_SDC_ACT_SEMAPHORE; |
258 | priv->tseq[1] = 0x7; | 252 | priv->tseq[1] = 0x7; |
259 | priv->tseq[2] = | 253 | priv->tseq[2] = |
260 | (mlc->opacket & | 254 | (mlc->opacket & |
261 | (HIL_PKT_ADDR_MASK | HIL_PKT_CMD)) | 255 | (HIL_PKT_ADDR_MASK | HIL_PKT_CMD)) |
262 | >> HIL_PKT_ADDR_SHIFT; | 256 | >> HIL_PKT_ADDR_SHIFT; |
263 | priv->tseq[3] = | 257 | priv->tseq[3] = |
264 | (mlc->opacket & HIL_PKT_DATA_MASK) | 258 | (mlc->opacket & HIL_PKT_DATA_MASK) |
265 | >> HIL_PKT_DATA_SHIFT; | 259 | >> HIL_PKT_DATA_SHIFT; |
266 | priv->tseq[4] = 0; /* No timeout */ | 260 | priv->tseq[4] = 0; /* No timeout */ |
267 | if (priv->tseq[3] == HIL_CMD_DHR) priv->tseq[4] = 1; | 261 | if (priv->tseq[3] == HIL_CMD_DHR) |
262 | priv->tseq[4] = 1; | ||
268 | priv->tseq[5] = HP_SDC_CMD_DO_HIL; | 263 | priv->tseq[5] = HP_SDC_CMD_DO_HIL; |
269 | goto enqueue; | 264 | goto enqueue; |
270 | 265 | ||
271 | do_control: | 266 | do_control: |
272 | priv->emtestmode = mlc->opacket & HIL_CTRL_TEST; | 267 | priv->emtestmode = mlc->opacket & HIL_CTRL_TEST; |
273 | 268 | ||
274 | /* we cannot emulate this, it should not be used. */ | 269 | /* we cannot emulate this, it should not be used. */ |
275 | BUG_ON((mlc->opacket & (HIL_CTRL_APE | HIL_CTRL_IPF)) == HIL_CTRL_APE); | 270 | BUG_ON((mlc->opacket & (HIL_CTRL_APE | HIL_CTRL_IPF)) == HIL_CTRL_APE); |
276 | 271 | ||
277 | if ((mlc->opacket & HIL_CTRL_ONLY) == HIL_CTRL_ONLY) goto control_only; | 272 | if ((mlc->opacket & HIL_CTRL_ONLY) == HIL_CTRL_ONLY) |
278 | if (mlc->opacket & HIL_CTRL_APE) { | 273 | goto control_only; |
279 | BUG(); /* Should not send command/data after engaging APE */ | 274 | |
280 | goto done; | 275 | /* Should not send command/data after engaging APE */ |
281 | } | 276 | BUG_ON(mlc->opacket & HIL_CTRL_APE); |
282 | /* Disengaging APE this way would not be valid either since | 277 | |
278 | /* Disengaging APE this way would not be valid either since | ||
283 | * the loop must be allowed to idle. | 279 | * the loop must be allowed to idle. |
284 | * | 280 | * |
285 | * So, it works out that we really never actually send control | 281 | * So, it works out that we really never actually send control |
286 | * and data when using SDC, we just send the data. | 282 | * and data when using SDC, we just send the data. |
287 | */ | 283 | */ |
288 | goto do_data; | 284 | goto do_data; |
289 | 285 | ||
290 | control_only: | 286 | control_only: |
291 | priv->trans.actidx = 0; | 287 | priv->trans.actidx = 0; |
292 | priv->trans.idx = 1; | 288 | priv->trans.idx = 1; |
293 | priv->trans.act.semaphore = &(mlc->osem); | 289 | priv->trans.act.semaphore = &mlc->osem; |
294 | priv->trans.endidx = 4; | 290 | priv->trans.endidx = 4; |
295 | priv->tseq[0] = | 291 | priv->tseq[0] = |
296 | HP_SDC_ACT_PRECMD | HP_SDC_ACT_DATAOUT | HP_SDC_ACT_SEMAPHORE; | 292 | HP_SDC_ACT_PRECMD | HP_SDC_ACT_DATAOUT | HP_SDC_ACT_SEMAPHORE; |
297 | priv->tseq[1] = HP_SDC_CMD_SET_LPC; | 293 | priv->tseq[1] = HP_SDC_CMD_SET_LPC; |
298 | priv->tseq[2] = 1; | 294 | priv->tseq[2] = 1; |
299 | // priv->tseq[3] = (mlc->ddc + 1) | HP_SDC_LPS_ACSUCC; | 295 | /* priv->tseq[3] = (mlc->ddc + 1) | HP_SDC_LPS_ACSUCC; */ |
300 | priv->tseq[3] = 0; | 296 | priv->tseq[3] = 0; |
301 | if (mlc->opacket & HIL_CTRL_APE) { | 297 | if (mlc->opacket & HIL_CTRL_APE) { |
302 | priv->tseq[3] |= HP_SDC_LPC_APE_IPF; | 298 | priv->tseq[3] |= HP_SDC_LPC_APE_IPF; |
303 | down_trylock(&(mlc->csem)); | 299 | down_trylock(&mlc->csem); |
304 | } | 300 | } |
305 | enqueue: | 301 | enqueue: |
306 | hp_sdc_enqueue_transaction(&(priv->trans)); | 302 | hp_sdc_enqueue_transaction(&priv->trans); |
307 | done: | ||
308 | write_unlock_irqrestore(&(mlc->lock), flags); | ||
309 | } | 303 | } |
310 | 304 | ||
311 | static int __init hp_sdc_mlc_init(void) | 305 | static int __init hp_sdc_mlc_init(void) |
@@ -316,18 +310,18 @@ static int __init hp_sdc_mlc_init(void) | |||
316 | 310 | ||
317 | hp_sdc_mlc_priv.emtestmode = 0; | 311 | hp_sdc_mlc_priv.emtestmode = 0; |
318 | hp_sdc_mlc_priv.trans.seq = hp_sdc_mlc_priv.tseq; | 312 | hp_sdc_mlc_priv.trans.seq = hp_sdc_mlc_priv.tseq; |
319 | hp_sdc_mlc_priv.trans.act.semaphore = &(mlc->osem); | 313 | hp_sdc_mlc_priv.trans.act.semaphore = &mlc->osem; |
320 | hp_sdc_mlc_priv.got5x = 0; | 314 | hp_sdc_mlc_priv.got5x = 0; |
321 | 315 | ||
322 | mlc->cts = &hp_sdc_mlc_cts; | 316 | mlc->cts = &hp_sdc_mlc_cts; |
323 | mlc->in = &hp_sdc_mlc_in; | 317 | mlc->in = &hp_sdc_mlc_in; |
324 | mlc->out = &hp_sdc_mlc_out; | 318 | mlc->out = &hp_sdc_mlc_out; |
319 | mlc->priv = &hp_sdc_mlc_priv; | ||
325 | 320 | ||
326 | if (hil_mlc_register(mlc)) { | 321 | if (hil_mlc_register(mlc)) { |
327 | printk(KERN_WARNING PREFIX "Failed to register MLC structure with hil_mlc\n"); | 322 | printk(KERN_WARNING PREFIX "Failed to register MLC structure with hil_mlc\n"); |
328 | goto err0; | 323 | goto err0; |
329 | } | 324 | } |
330 | mlc->priv = &hp_sdc_mlc_priv; | ||
331 | 325 | ||
332 | if (hp_sdc_request_hil_irq(&hp_sdc_mlc_isr)) { | 326 | if (hp_sdc_request_hil_irq(&hp_sdc_mlc_isr)) { |
333 | printk(KERN_WARNING PREFIX "Request for raw HIL ISR hook denied\n"); | 327 | printk(KERN_WARNING PREFIX "Request for raw HIL ISR hook denied\n"); |
@@ -335,10 +329,9 @@ static int __init hp_sdc_mlc_init(void) | |||
335 | } | 329 | } |
336 | return 0; | 330 | return 0; |
337 | err1: | 331 | err1: |
338 | if (hil_mlc_unregister(mlc)) { | 332 | if (hil_mlc_unregister(mlc)) |
339 | printk(KERN_ERR PREFIX "Failed to unregister MLC structure with hil_mlc.\n" | 333 | printk(KERN_ERR PREFIX "Failed to unregister MLC structure with hil_mlc.\n" |
340 | "This is bad. Could cause an oops.\n"); | 334 | "This is bad. Could cause an oops.\n"); |
341 | } | ||
342 | err0: | 335 | err0: |
343 | return -EBUSY; | 336 | return -EBUSY; |
344 | } | 337 | } |
@@ -346,14 +339,14 @@ static int __init hp_sdc_mlc_init(void) | |||
346 | static void __exit hp_sdc_mlc_exit(void) | 339 | static void __exit hp_sdc_mlc_exit(void) |
347 | { | 340 | { |
348 | hil_mlc *mlc = &hp_sdc_mlc; | 341 | hil_mlc *mlc = &hp_sdc_mlc; |
349 | if (hp_sdc_release_hil_irq(&hp_sdc_mlc_isr)) { | 342 | |
343 | if (hp_sdc_release_hil_irq(&hp_sdc_mlc_isr)) | ||
350 | printk(KERN_ERR PREFIX "Failed to release the raw HIL ISR hook.\n" | 344 | printk(KERN_ERR PREFIX "Failed to release the raw HIL ISR hook.\n" |
351 | "This is bad. Could cause an oops.\n"); | 345 | "This is bad. Could cause an oops.\n"); |
352 | } | 346 | |
353 | if (hil_mlc_unregister(mlc)) { | 347 | if (hil_mlc_unregister(mlc)) |
354 | printk(KERN_ERR PREFIX "Failed to unregister MLC structure with hil_mlc.\n" | 348 | printk(KERN_ERR PREFIX "Failed to unregister MLC structure with hil_mlc.\n" |
355 | "This is bad. Could cause an oops.\n"); | 349 | "This is bad. Could cause an oops.\n"); |
356 | } | ||
357 | } | 350 | } |
358 | 351 | ||
359 | module_init(hp_sdc_mlc_init); | 352 | module_init(hp_sdc_mlc_init); |
diff --git a/drivers/input/serio/i8042-x86ia64io.h b/drivers/input/serio/i8042-x86ia64io.h index d36bd5475b6d..6858bc58f0fd 100644 --- a/drivers/input/serio/i8042-x86ia64io.h +++ b/drivers/input/serio/i8042-x86ia64io.h | |||
@@ -160,6 +160,28 @@ static struct dmi_system_id __initdata i8042_dmi_nomux_table[] = { | |||
160 | }, | 160 | }, |
161 | }, | 161 | }, |
162 | { | 162 | { |
163 | /* | ||
164 | * No data is coming from the touchscreen unless KBC | ||
165 | * is in legacy mode. | ||
166 | */ | ||
167 | .ident = "Panasonic CF-29", | ||
168 | .matches = { | ||
169 | DMI_MATCH(DMI_SYS_VENDOR, "Matsushita"), | ||
170 | DMI_MATCH(DMI_PRODUCT_NAME, "CF-29"), | ||
171 | }, | ||
172 | }, | ||
173 | { | ||
174 | /* | ||
175 | * Errors on MUX ports are reported without raising AUXDATA | ||
176 | * causing "spurious NAK" messages. | ||
177 | */ | ||
178 | .ident = "HP Pavilion DV4017EA", | ||
179 | .matches = { | ||
180 | DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"), | ||
181 | DMI_MATCH(DMI_PRODUCT_NAME, "Pavilion dv4000 (EA032EA#ABF)"), | ||
182 | }, | ||
183 | }, | ||
184 | { | ||
163 | .ident = "Toshiba P10", | 185 | .ident = "Toshiba P10", |
164 | .matches = { | 186 | .matches = { |
165 | DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 187 | DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), |
@@ -280,6 +302,8 @@ static struct pnp_driver i8042_pnp_kbd_driver = { | |||
280 | }; | 302 | }; |
281 | 303 | ||
282 | static struct pnp_device_id pnp_aux_devids[] = { | 304 | static struct pnp_device_id pnp_aux_devids[] = { |
305 | { .id = "FJC6000", .driver_data = 0 }, | ||
306 | { .id = "FJC6001", .driver_data = 0 }, | ||
283 | { .id = "PNP0f03", .driver_data = 0 }, | 307 | { .id = "PNP0f03", .driver_data = 0 }, |
284 | { .id = "PNP0f0b", .driver_data = 0 }, | 308 | { .id = "PNP0f0b", .driver_data = 0 }, |
285 | { .id = "PNP0f0e", .driver_data = 0 }, | 309 | { .id = "PNP0f0e", .driver_data = 0 }, |
diff --git a/drivers/input/serio/i8042.c b/drivers/input/serio/i8042.c index db9cca3b65e0..7c17377a65b9 100644 --- a/drivers/input/serio/i8042.c +++ b/drivers/input/serio/i8042.c | |||
@@ -768,6 +768,13 @@ static void i8042_controller_reset(void) | |||
768 | i8042_flush(); | 768 | i8042_flush(); |
769 | 769 | ||
770 | /* | 770 | /* |
771 | * Disable both KBD and AUX interfaces so they don't get in the way | ||
772 | */ | ||
773 | |||
774 | i8042_ctr |= I8042_CTR_KBDDIS | I8042_CTR_AUXDIS; | ||
775 | i8042_ctr &= ~(I8042_CTR_KBDINT | I8042_CTR_AUXINT); | ||
776 | |||
777 | /* | ||
771 | * Disable MUX mode if present. | 778 | * Disable MUX mode if present. |
772 | */ | 779 | */ |
773 | 780 | ||
diff --git a/drivers/input/touchscreen/ads7846.c b/drivers/input/touchscreen/ads7846.c index 0a26e0663542..693e3b2a65a3 100644 --- a/drivers/input/touchscreen/ads7846.c +++ b/drivers/input/touchscreen/ads7846.c | |||
@@ -39,7 +39,8 @@ | |||
39 | /* | 39 | /* |
40 | * This code has been heavily tested on a Nokia 770, and lightly | 40 | * This code has been heavily tested on a Nokia 770, and lightly |
41 | * tested on other ads7846 devices (OSK/Mistral, Lubbock). | 41 | * tested on other ads7846 devices (OSK/Mistral, Lubbock). |
42 | * Support for ads7843 and ads7845 has only been stubbed in. | 42 | * Support for ads7843 tested on Atmel at91sam926x-EK. |
43 | * Support for ads7845 has only been stubbed in. | ||
43 | * | 44 | * |
44 | * IRQ handling needs a workaround because of a shortcoming in handling | 45 | * IRQ handling needs a workaround because of a shortcoming in handling |
45 | * edge triggered IRQs on some platforms like the OMAP1/2. These | 46 | * edge triggered IRQs on some platforms like the OMAP1/2. These |
@@ -246,18 +247,16 @@ static int ads7846_read12_ser(struct device *dev, unsigned command) | |||
246 | 247 | ||
247 | /* REVISIT: take a few more samples, and compare ... */ | 248 | /* REVISIT: take a few more samples, and compare ... */ |
248 | 249 | ||
249 | /* maybe off internal vREF */ | 250 | /* converter in low power mode & enable PENIRQ */ |
250 | if (use_internal) { | 251 | req->ref_off = PWRDOWN; |
251 | req->ref_off = REF_OFF; | 252 | req->xfer[4].tx_buf = &req->ref_off; |
252 | req->xfer[4].tx_buf = &req->ref_off; | 253 | req->xfer[4].len = 1; |
253 | req->xfer[4].len = 1; | 254 | spi_message_add_tail(&req->xfer[4], &req->msg); |
254 | spi_message_add_tail(&req->xfer[4], &req->msg); | 255 | |
255 | 256 | req->xfer[5].rx_buf = &req->scratch; | |
256 | req->xfer[5].rx_buf = &req->scratch; | 257 | req->xfer[5].len = 2; |
257 | req->xfer[5].len = 2; | 258 | CS_CHANGE(req->xfer[5]); |
258 | CS_CHANGE(req->xfer[5]); | 259 | spi_message_add_tail(&req->xfer[5], &req->msg); |
259 | spi_message_add_tail(&req->xfer[5], &req->msg); | ||
260 | } | ||
261 | 260 | ||
262 | ts->irq_disabled = 1; | 261 | ts->irq_disabled = 1; |
263 | disable_irq(spi->irq); | 262 | disable_irq(spi->irq); |
@@ -536,6 +535,9 @@ static void ads7846_rx(void *ads) | |||
536 | } else | 535 | } else |
537 | Rt = 0; | 536 | Rt = 0; |
538 | 537 | ||
538 | if (ts->model == 7843) | ||
539 | Rt = ts->pressure_max / 2; | ||
540 | |||
539 | /* Sample found inconsistent by debouncing or pressure is beyond | 541 | /* Sample found inconsistent by debouncing or pressure is beyond |
540 | * the maximum. Don't report it to user space, repeat at least | 542 | * the maximum. Don't report it to user space, repeat at least |
541 | * once more the measurement | 543 | * once more the measurement |
@@ -897,7 +899,7 @@ static int __devinit ads7846_probe(struct spi_device *spi) | |||
897 | 899 | ||
898 | input_dev->name = "ADS784x Touchscreen"; | 900 | input_dev->name = "ADS784x Touchscreen"; |
899 | input_dev->phys = ts->phys; | 901 | input_dev->phys = ts->phys; |
900 | input_dev->cdev.dev = &spi->dev; | 902 | input_dev->dev.parent = &spi->dev; |
901 | 903 | ||
902 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 904 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
903 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | 905 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); |
diff --git a/drivers/input/touchscreen/corgi_ts.c b/drivers/input/touchscreen/corgi_ts.c index e2945582828e..e6a31d118786 100644 --- a/drivers/input/touchscreen/corgi_ts.c +++ b/drivers/input/touchscreen/corgi_ts.c | |||
@@ -300,8 +300,7 @@ static int __init corgits_probe(struct platform_device *pdev) | |||
300 | input_dev->id.vendor = 0x0001; | 300 | input_dev->id.vendor = 0x0001; |
301 | input_dev->id.product = 0x0002; | 301 | input_dev->id.product = 0x0002; |
302 | input_dev->id.version = 0x0100; | 302 | input_dev->id.version = 0x0100; |
303 | input_dev->cdev.dev = &pdev->dev; | 303 | input_dev->dev.parent = &pdev->dev; |
304 | input_dev->private = corgi_ts; | ||
305 | 304 | ||
306 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 305 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
307 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | 306 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); |
diff --git a/drivers/input/touchscreen/elo.c b/drivers/input/touchscreen/elo.c index 9d61cd133d01..557d781719f1 100644 --- a/drivers/input/touchscreen/elo.c +++ b/drivers/input/touchscreen/elo.c | |||
@@ -312,14 +312,13 @@ static int elo_connect(struct serio *serio, struct serio_driver *drv) | |||
312 | init_completion(&elo->cmd_done); | 312 | init_completion(&elo->cmd_done); |
313 | snprintf(elo->phys, sizeof(elo->phys), "%s/input0", serio->phys); | 313 | snprintf(elo->phys, sizeof(elo->phys), "%s/input0", serio->phys); |
314 | 314 | ||
315 | input_dev->private = elo; | ||
316 | input_dev->name = "Elo Serial TouchScreen"; | 315 | input_dev->name = "Elo Serial TouchScreen"; |
317 | input_dev->phys = elo->phys; | 316 | input_dev->phys = elo->phys; |
318 | input_dev->id.bustype = BUS_RS232; | 317 | input_dev->id.bustype = BUS_RS232; |
319 | input_dev->id.vendor = SERIO_ELO; | 318 | input_dev->id.vendor = SERIO_ELO; |
320 | input_dev->id.product = elo->id; | 319 | input_dev->id.product = elo->id; |
321 | input_dev->id.version = 0x0100; | 320 | input_dev->id.version = 0x0100; |
322 | input_dev->cdev.dev = &serio->dev; | 321 | input_dev->dev.parent = &serio->dev; |
323 | 322 | ||
324 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 323 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
325 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | 324 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); |
diff --git a/drivers/input/touchscreen/gunze.c b/drivers/input/touchscreen/gunze.c index 9157eb148e84..39d602600d7c 100644 --- a/drivers/input/touchscreen/gunze.c +++ b/drivers/input/touchscreen/gunze.c | |||
@@ -130,13 +130,13 @@ static int gunze_connect(struct serio *serio, struct serio_driver *drv) | |||
130 | gunze->dev = input_dev; | 130 | gunze->dev = input_dev; |
131 | snprintf(gunze->phys, sizeof(serio->phys), "%s/input0", serio->phys); | 131 | snprintf(gunze->phys, sizeof(serio->phys), "%s/input0", serio->phys); |
132 | 132 | ||
133 | input_dev->private = gunze; | ||
134 | input_dev->name = "Gunze AHL-51S TouchScreen"; | 133 | input_dev->name = "Gunze AHL-51S TouchScreen"; |
135 | input_dev->phys = gunze->phys; | 134 | input_dev->phys = gunze->phys; |
136 | input_dev->id.bustype = BUS_RS232; | 135 | input_dev->id.bustype = BUS_RS232; |
137 | input_dev->id.vendor = SERIO_GUNZE; | 136 | input_dev->id.vendor = SERIO_GUNZE; |
138 | input_dev->id.product = 0x0051; | 137 | input_dev->id.product = 0x0051; |
139 | input_dev->id.version = 0x0100; | 138 | input_dev->id.version = 0x0100; |
139 | input_dev->dev.parent = &serio->dev; | ||
140 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 140 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
141 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | 141 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); |
142 | input_set_abs_params(input_dev, ABS_X, 24, 1000, 0, 0); | 142 | input_set_abs_params(input_dev, ABS_X, 24, 1000, 0, 0); |
diff --git a/drivers/input/touchscreen/h3600_ts_input.c b/drivers/input/touchscreen/h3600_ts_input.c index c4116d4f64e7..09ed7803cb8f 100644 --- a/drivers/input/touchscreen/h3600_ts_input.c +++ b/drivers/input/touchscreen/h3600_ts_input.c | |||
@@ -147,7 +147,7 @@ enum flite_pwr { | |||
147 | unsigned int h3600_flite_power(struct input_dev *dev, enum flite_pwr pwr) | 147 | unsigned int h3600_flite_power(struct input_dev *dev, enum flite_pwr pwr) |
148 | { | 148 | { |
149 | unsigned char brightness = (pwr == FLITE_PWR_OFF) ? 0 : flite_brightness; | 149 | unsigned char brightness = (pwr == FLITE_PWR_OFF) ? 0 : flite_brightness; |
150 | struct h3600_dev *ts = dev->private; | 150 | struct h3600_dev *ts = input_get_drvdata(dev); |
151 | 151 | ||
152 | /* Must be in this order */ | 152 | /* Must be in this order */ |
153 | ts->serio->write(ts->serio, 1); | 153 | ts->serio->write(ts->serio, 1); |
@@ -260,7 +260,7 @@ static int h3600ts_event(struct input_dev *dev, unsigned int type, | |||
260 | unsigned int code, int value) | 260 | unsigned int code, int value) |
261 | { | 261 | { |
262 | #if 0 | 262 | #if 0 |
263 | struct h3600_dev *ts = dev->private; | 263 | struct h3600_dev *ts = input_get_drvdata(dev); |
264 | 264 | ||
265 | switch (type) { | 265 | switch (type) { |
266 | case EV_LED: { | 266 | case EV_LED: { |
@@ -367,8 +367,9 @@ static int h3600ts_connect(struct serio *serio, struct serio_driver *drv) | |||
367 | input_dev->id.vendor = SERIO_H3600; | 367 | input_dev->id.vendor = SERIO_H3600; |
368 | input_dev->id.product = 0x0666; /* FIXME !!! We can ask the hardware */ | 368 | input_dev->id.product = 0x0666; /* FIXME !!! We can ask the hardware */ |
369 | input_dev->id.version = 0x0100; | 369 | input_dev->id.version = 0x0100; |
370 | input_dev->cdev.dev = &serio->dev; | 370 | input_dev->dev.parent = &serio->dev; |
371 | input_dev->private = ts; | 371 | |
372 | input_set_drvdata(input_dev, ts); | ||
372 | 373 | ||
373 | input_dev->event = h3600ts_event; | 374 | input_dev->event = h3600ts_event; |
374 | 375 | ||
diff --git a/drivers/input/touchscreen/mtouch.c b/drivers/input/touchscreen/mtouch.c index c3c2d735d0ec..4ec3b1f940c8 100644 --- a/drivers/input/touchscreen/mtouch.c +++ b/drivers/input/touchscreen/mtouch.c | |||
@@ -144,13 +144,13 @@ static int mtouch_connect(struct serio *serio, struct serio_driver *drv) | |||
144 | mtouch->dev = input_dev; | 144 | mtouch->dev = input_dev; |
145 | snprintf(mtouch->phys, sizeof(mtouch->phys), "%s/input0", serio->phys); | 145 | snprintf(mtouch->phys, sizeof(mtouch->phys), "%s/input0", serio->phys); |
146 | 146 | ||
147 | input_dev->private = mtouch; | ||
148 | input_dev->name = "MicroTouch Serial TouchScreen"; | 147 | input_dev->name = "MicroTouch Serial TouchScreen"; |
149 | input_dev->phys = mtouch->phys; | 148 | input_dev->phys = mtouch->phys; |
150 | input_dev->id.bustype = BUS_RS232; | 149 | input_dev->id.bustype = BUS_RS232; |
151 | input_dev->id.vendor = SERIO_MICROTOUCH; | 150 | input_dev->id.vendor = SERIO_MICROTOUCH; |
152 | input_dev->id.product = 0; | 151 | input_dev->id.product = 0; |
153 | input_dev->id.version = 0x0100; | 152 | input_dev->id.version = 0x0100; |
153 | input_dev->dev.parent = &serio->dev; | ||
154 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 154 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
155 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | 155 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); |
156 | input_set_abs_params(mtouch->dev, ABS_X, MTOUCH_MIN_XC, MTOUCH_MAX_XC, 0, 0); | 156 | input_set_abs_params(mtouch->dev, ABS_X, MTOUCH_MIN_XC, MTOUCH_MAX_XC, 0, 0); |
diff --git a/drivers/input/touchscreen/penmount.c b/drivers/input/touchscreen/penmount.c index bd2767991ae9..f2c0d3c7149c 100644 --- a/drivers/input/touchscreen/penmount.c +++ b/drivers/input/touchscreen/penmount.c | |||
@@ -105,14 +105,13 @@ static int pm_connect(struct serio *serio, struct serio_driver *drv) | |||
105 | pm->dev = input_dev; | 105 | pm->dev = input_dev; |
106 | snprintf(pm->phys, sizeof(pm->phys), "%s/input0", serio->phys); | 106 | snprintf(pm->phys, sizeof(pm->phys), "%s/input0", serio->phys); |
107 | 107 | ||
108 | input_dev->private = pm; | ||
109 | input_dev->name = "Penmount Serial TouchScreen"; | 108 | input_dev->name = "Penmount Serial TouchScreen"; |
110 | input_dev->phys = pm->phys; | 109 | input_dev->phys = pm->phys; |
111 | input_dev->id.bustype = BUS_RS232; | 110 | input_dev->id.bustype = BUS_RS232; |
112 | input_dev->id.vendor = SERIO_PENMOUNT; | 111 | input_dev->id.vendor = SERIO_PENMOUNT; |
113 | input_dev->id.product = 0; | 112 | input_dev->id.product = 0; |
114 | input_dev->id.version = 0x0100; | 113 | input_dev->id.version = 0x0100; |
115 | input_dev->cdev.dev = &serio->dev; | 114 | input_dev->dev.parent = &serio->dev; |
116 | 115 | ||
117 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 116 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
118 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | 117 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); |
diff --git a/drivers/input/touchscreen/touchright.c b/drivers/input/touchscreen/touchright.c index 35ba46c6ad2d..3def7bb1df44 100644 --- a/drivers/input/touchscreen/touchright.c +++ b/drivers/input/touchscreen/touchright.c | |||
@@ -118,13 +118,13 @@ static int tr_connect(struct serio *serio, struct serio_driver *drv) | |||
118 | tr->dev = input_dev; | 118 | tr->dev = input_dev; |
119 | snprintf(tr->phys, sizeof(tr->phys), "%s/input0", serio->phys); | 119 | snprintf(tr->phys, sizeof(tr->phys), "%s/input0", serio->phys); |
120 | 120 | ||
121 | input_dev->private = tr; | ||
122 | input_dev->name = "Touchright Serial TouchScreen"; | 121 | input_dev->name = "Touchright Serial TouchScreen"; |
123 | input_dev->phys = tr->phys; | 122 | input_dev->phys = tr->phys; |
124 | input_dev->id.bustype = BUS_RS232; | 123 | input_dev->id.bustype = BUS_RS232; |
125 | input_dev->id.vendor = SERIO_TOUCHRIGHT; | 124 | input_dev->id.vendor = SERIO_TOUCHRIGHT; |
126 | input_dev->id.product = 0; | 125 | input_dev->id.product = 0; |
127 | input_dev->id.version = 0x0100; | 126 | input_dev->id.version = 0x0100; |
127 | input_dev->dev.parent = &serio->dev; | ||
128 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 128 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
129 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | 129 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); |
130 | input_set_abs_params(tr->dev, ABS_X, TR_MIN_XC, TR_MAX_XC, 0, 0); | 130 | input_set_abs_params(tr->dev, ABS_X, TR_MIN_XC, TR_MAX_XC, 0, 0); |
diff --git a/drivers/input/touchscreen/touchwin.c b/drivers/input/touchscreen/touchwin.c index 4dc073dacabb..ac4bdcf18666 100644 --- a/drivers/input/touchscreen/touchwin.c +++ b/drivers/input/touchscreen/touchwin.c | |||
@@ -125,13 +125,13 @@ static int tw_connect(struct serio *serio, struct serio_driver *drv) | |||
125 | tw->dev = input_dev; | 125 | tw->dev = input_dev; |
126 | snprintf(tw->phys, sizeof(tw->phys), "%s/input0", serio->phys); | 126 | snprintf(tw->phys, sizeof(tw->phys), "%s/input0", serio->phys); |
127 | 127 | ||
128 | input_dev->private = tw; | ||
129 | input_dev->name = "Touchwindow Serial TouchScreen"; | 128 | input_dev->name = "Touchwindow Serial TouchScreen"; |
130 | input_dev->phys = tw->phys; | 129 | input_dev->phys = tw->phys; |
131 | input_dev->id.bustype = BUS_RS232; | 130 | input_dev->id.bustype = BUS_RS232; |
132 | input_dev->id.vendor = SERIO_TOUCHWIN; | 131 | input_dev->id.vendor = SERIO_TOUCHWIN; |
133 | input_dev->id.product = 0; | 132 | input_dev->id.product = 0; |
134 | input_dev->id.version = 0x0100; | 133 | input_dev->id.version = 0x0100; |
134 | input_dev->dev.parent = &serio->dev; | ||
135 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | 135 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
136 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | 136 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); |
137 | input_set_abs_params(tw->dev, ABS_X, TW_MIN_XC, TW_MAX_XC, 0, 0); | 137 | input_set_abs_params(tw->dev, ABS_X, TW_MIN_XC, TW_MAX_XC, 0, 0); |
diff --git a/drivers/input/touchscreen/ucb1400_ts.c b/drivers/input/touchscreen/ucb1400_ts.c index e8606c48c9c3..6582816a0477 100644 --- a/drivers/input/touchscreen/ucb1400_ts.c +++ b/drivers/input/touchscreen/ucb1400_ts.c | |||
@@ -97,6 +97,8 @@ struct ucb1400 { | |||
97 | }; | 97 | }; |
98 | 98 | ||
99 | static int adcsync; | 99 | static int adcsync; |
100 | static int ts_delay = 55; /* us */ | ||
101 | static int ts_delay_pressure; /* us */ | ||
100 | 102 | ||
101 | static inline u16 ucb1400_reg_read(struct ucb1400 *ucb, u16 reg) | 103 | static inline u16 ucb1400_reg_read(struct ucb1400 *ucb, u16 reg) |
102 | { | 104 | { |
@@ -159,6 +161,7 @@ static inline unsigned int ucb1400_ts_read_pressure(struct ucb1400 *ucb) | |||
159 | UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW | | 161 | UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW | |
160 | UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND | | 162 | UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND | |
161 | UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); | 163 | UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); |
164 | udelay(ts_delay_pressure); | ||
162 | return ucb1400_adc_read(ucb, UCB_ADC_INP_TSPY); | 165 | return ucb1400_adc_read(ucb, UCB_ADC_INP_TSPY); |
163 | } | 166 | } |
164 | 167 | ||
@@ -180,7 +183,7 @@ static inline unsigned int ucb1400_ts_read_xpos(struct ucb1400 *ucb) | |||
180 | UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW | | 183 | UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW | |
181 | UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA); | 184 | UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA); |
182 | 185 | ||
183 | udelay(55); | 186 | udelay(ts_delay); |
184 | 187 | ||
185 | return ucb1400_adc_read(ucb, UCB_ADC_INP_TSPY); | 188 | return ucb1400_adc_read(ucb, UCB_ADC_INP_TSPY); |
186 | } | 189 | } |
@@ -203,7 +206,7 @@ static inline unsigned int ucb1400_ts_read_ypos(struct ucb1400 *ucb) | |||
203 | UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW | | 206 | UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW | |
204 | UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA); | 207 | UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA); |
205 | 208 | ||
206 | udelay(55); | 209 | udelay(ts_delay); |
207 | 210 | ||
208 | return ucb1400_adc_read(ucb, UCB_ADC_INP_TSPX); | 211 | return ucb1400_adc_read(ucb, UCB_ADC_INP_TSPX); |
209 | } | 212 | } |
@@ -369,7 +372,7 @@ static irqreturn_t ucb1400_hard_irq(int irqnr, void *devid) | |||
369 | 372 | ||
370 | static int ucb1400_ts_open(struct input_dev *idev) | 373 | static int ucb1400_ts_open(struct input_dev *idev) |
371 | { | 374 | { |
372 | struct ucb1400 *ucb = idev->private; | 375 | struct ucb1400 *ucb = input_get_drvdata(idev); |
373 | int ret = 0; | 376 | int ret = 0; |
374 | 377 | ||
375 | BUG_ON(ucb->ts_task); | 378 | BUG_ON(ucb->ts_task); |
@@ -385,7 +388,7 @@ static int ucb1400_ts_open(struct input_dev *idev) | |||
385 | 388 | ||
386 | static void ucb1400_ts_close(struct input_dev *idev) | 389 | static void ucb1400_ts_close(struct input_dev *idev) |
387 | { | 390 | { |
388 | struct ucb1400 *ucb = idev->private; | 391 | struct ucb1400 *ucb = input_get_drvdata(idev); |
389 | 392 | ||
390 | if (ucb->ts_task) | 393 | if (ucb->ts_task) |
391 | kthread_stop(ucb->ts_task); | 394 | kthread_stop(ucb->ts_task); |
@@ -507,8 +510,9 @@ static int ucb1400_ts_probe(struct device *dev) | |||
507 | } | 510 | } |
508 | printk(KERN_DEBUG "UCB1400: found IRQ %d\n", ucb->irq); | 511 | printk(KERN_DEBUG "UCB1400: found IRQ %d\n", ucb->irq); |
509 | 512 | ||
510 | idev->private = ucb; | 513 | input_set_drvdata(idev, ucb); |
511 | idev->cdev.dev = dev; | 514 | |
515 | idev->dev.parent = dev; | ||
512 | idev->name = "UCB1400 touchscreen interface"; | 516 | idev->name = "UCB1400 touchscreen interface"; |
513 | idev->id.vendor = ucb1400_reg_read(ucb, AC97_VENDOR_ID1); | 517 | idev->id.vendor = ucb1400_reg_read(ucb, AC97_VENDOR_ID1); |
514 | idev->id.product = id; | 518 | idev->id.product = id; |
@@ -571,7 +575,15 @@ static void __exit ucb1400_ts_exit(void) | |||
571 | driver_unregister(&ucb1400_ts_driver); | 575 | driver_unregister(&ucb1400_ts_driver); |
572 | } | 576 | } |
573 | 577 | ||
574 | module_param(adcsync, int, 0444); | 578 | module_param(adcsync, bool, 0444); |
579 | MODULE_PARM_DESC(adcsync, "Synchronize touch readings with ADCSYNC pin."); | ||
580 | |||
581 | module_param(ts_delay, int, 0444); | ||
582 | MODULE_PARM_DESC(ts_delay, "Delay between panel setup and position read. Default = 55us."); | ||
583 | |||
584 | module_param(ts_delay_pressure, int, 0444); | ||
585 | MODULE_PARM_DESC(ts_delay_pressure, | ||
586 | "delay between panel setup and pressure read. Default = 0us."); | ||
575 | 587 | ||
576 | module_init(ucb1400_ts_init); | 588 | module_init(ucb1400_ts_init); |
577 | module_exit(ucb1400_ts_exit); | 589 | module_exit(ucb1400_ts_exit); |
diff --git a/drivers/input/tsdev.c b/drivers/input/tsdev.c index 05dfc10bc079..5e5b5c91d75b 100644 --- a/drivers/input/tsdev.c +++ b/drivers/input/tsdev.c | |||
@@ -111,13 +111,13 @@ struct tsdev { | |||
111 | int minor; | 111 | int minor; |
112 | char name[8]; | 112 | char name[8]; |
113 | wait_queue_head_t wait; | 113 | wait_queue_head_t wait; |
114 | struct list_head list; | 114 | struct list_head client_list; |
115 | struct input_handle handle; | 115 | struct input_handle handle; |
116 | int x, y, pressure; | 116 | int x, y, pressure; |
117 | struct ts_calibration cal; | 117 | struct ts_calibration cal; |
118 | }; | 118 | }; |
119 | 119 | ||
120 | struct tsdev_list { | 120 | struct tsdev_client { |
121 | struct fasync_struct *fasync; | 121 | struct fasync_struct *fasync; |
122 | struct list_head node; | 122 | struct list_head node; |
123 | struct tsdev *tsdev; | 123 | struct tsdev *tsdev; |
@@ -139,38 +139,49 @@ static struct tsdev *tsdev_table[TSDEV_MINORS/2]; | |||
139 | 139 | ||
140 | static int tsdev_fasync(int fd, struct file *file, int on) | 140 | static int tsdev_fasync(int fd, struct file *file, int on) |
141 | { | 141 | { |
142 | struct tsdev_list *list = file->private_data; | 142 | struct tsdev_client *client = file->private_data; |
143 | int retval; | 143 | int retval; |
144 | 144 | ||
145 | retval = fasync_helper(fd, file, on, &list->fasync); | 145 | retval = fasync_helper(fd, file, on, &client->fasync); |
146 | return retval < 0 ? retval : 0; | 146 | return retval < 0 ? retval : 0; |
147 | } | 147 | } |
148 | 148 | ||
149 | static int tsdev_open(struct inode *inode, struct file *file) | 149 | static int tsdev_open(struct inode *inode, struct file *file) |
150 | { | 150 | { |
151 | int i = iminor(inode) - TSDEV_MINOR_BASE; | 151 | int i = iminor(inode) - TSDEV_MINOR_BASE; |
152 | struct tsdev_list *list; | 152 | struct tsdev_client *client; |
153 | struct tsdev *tsdev; | ||
154 | int error; | ||
153 | 155 | ||
154 | printk(KERN_WARNING "tsdev (compaq touchscreen emulation) is scheduled " | 156 | printk(KERN_WARNING "tsdev (compaq touchscreen emulation) is scheduled " |
155 | "for removal.\nSee Documentation/feature-removal-schedule.txt " | 157 | "for removal.\nSee Documentation/feature-removal-schedule.txt " |
156 | "for details.\n"); | 158 | "for details.\n"); |
157 | 159 | ||
158 | if (i >= TSDEV_MINORS || !tsdev_table[i & TSDEV_MINOR_MASK]) | 160 | if (i >= TSDEV_MINORS) |
161 | return -ENODEV; | ||
162 | |||
163 | tsdev = tsdev_table[i & TSDEV_MINOR_MASK]; | ||
164 | if (!tsdev || !tsdev->exist) | ||
159 | return -ENODEV; | 165 | return -ENODEV; |
160 | 166 | ||
161 | if (!(list = kzalloc(sizeof(struct tsdev_list), GFP_KERNEL))) | 167 | client = kzalloc(sizeof(struct tsdev_client), GFP_KERNEL); |
168 | if (!client) | ||
162 | return -ENOMEM; | 169 | return -ENOMEM; |
163 | 170 | ||
164 | list->raw = (i >= TSDEV_MINORS/2) ? 1 : 0; | 171 | client->tsdev = tsdev; |
172 | client->raw = (i >= TSDEV_MINORS / 2) ? 1 : 0; | ||
173 | list_add_tail(&client->node, &tsdev->client_list); | ||
165 | 174 | ||
166 | i &= TSDEV_MINOR_MASK; | 175 | if (!tsdev->open++ && tsdev->exist) { |
167 | list->tsdev = tsdev_table[i]; | 176 | error = input_open_device(&tsdev->handle); |
168 | list_add_tail(&list->node, &tsdev_table[i]->list); | 177 | if (error) { |
169 | file->private_data = list; | 178 | list_del(&client->node); |
179 | kfree(client); | ||
180 | return error; | ||
181 | } | ||
182 | } | ||
170 | 183 | ||
171 | if (!list->tsdev->open++) | 184 | file->private_data = client; |
172 | if (list->tsdev->exist) | ||
173 | input_open_device(&list->tsdev->handle); | ||
174 | return 0; | 185 | return 0; |
175 | } | 186 | } |
176 | 187 | ||
@@ -182,45 +193,48 @@ static void tsdev_free(struct tsdev *tsdev) | |||
182 | 193 | ||
183 | static int tsdev_release(struct inode *inode, struct file *file) | 194 | static int tsdev_release(struct inode *inode, struct file *file) |
184 | { | 195 | { |
185 | struct tsdev_list *list = file->private_data; | 196 | struct tsdev_client *client = file->private_data; |
197 | struct tsdev *tsdev = client->tsdev; | ||
186 | 198 | ||
187 | tsdev_fasync(-1, file, 0); | 199 | tsdev_fasync(-1, file, 0); |
188 | list_del(&list->node); | ||
189 | 200 | ||
190 | if (!--list->tsdev->open) { | 201 | list_del(&client->node); |
191 | if (list->tsdev->exist) | 202 | kfree(client); |
192 | input_close_device(&list->tsdev->handle); | 203 | |
204 | if (!--tsdev->open) { | ||
205 | if (tsdev->exist) | ||
206 | input_close_device(&tsdev->handle); | ||
193 | else | 207 | else |
194 | tsdev_free(list->tsdev); | 208 | tsdev_free(tsdev); |
195 | } | 209 | } |
196 | kfree(list); | 210 | |
197 | return 0; | 211 | return 0; |
198 | } | 212 | } |
199 | 213 | ||
200 | static ssize_t tsdev_read(struct file *file, char __user *buffer, size_t count, | 214 | static ssize_t tsdev_read(struct file *file, char __user *buffer, size_t count, |
201 | loff_t * ppos) | 215 | loff_t *ppos) |
202 | { | 216 | { |
203 | struct tsdev_list *list = file->private_data; | 217 | struct tsdev_client *client = file->private_data; |
218 | struct tsdev *tsdev = client->tsdev; | ||
204 | int retval = 0; | 219 | int retval = 0; |
205 | 220 | ||
206 | if (list->head == list->tail && list->tsdev->exist && (file->f_flags & O_NONBLOCK)) | 221 | if (client->head == client->tail && tsdev->exist && (file->f_flags & O_NONBLOCK)) |
207 | return -EAGAIN; | 222 | return -EAGAIN; |
208 | 223 | ||
209 | retval = wait_event_interruptible(list->tsdev->wait, | 224 | retval = wait_event_interruptible(tsdev->wait, |
210 | list->head != list->tail || !list->tsdev->exist); | 225 | client->head != client->tail || !tsdev->exist); |
211 | |||
212 | if (retval) | 226 | if (retval) |
213 | return retval; | 227 | return retval; |
214 | 228 | ||
215 | if (!list->tsdev->exist) | 229 | if (!tsdev->exist) |
216 | return -ENODEV; | 230 | return -ENODEV; |
217 | 231 | ||
218 | while (list->head != list->tail && | 232 | while (client->head != client->tail && |
219 | retval + sizeof (struct ts_event) <= count) { | 233 | retval + sizeof (struct ts_event) <= count) { |
220 | if (copy_to_user (buffer + retval, list->event + list->tail, | 234 | if (copy_to_user (buffer + retval, client->event + client->tail, |
221 | sizeof (struct ts_event))) | 235 | sizeof (struct ts_event))) |
222 | return -EFAULT; | 236 | return -EFAULT; |
223 | list->tail = (list->tail + 1) & (TSDEV_BUFFER_SIZE - 1); | 237 | client->tail = (client->tail + 1) & (TSDEV_BUFFER_SIZE - 1); |
224 | retval += sizeof (struct ts_event); | 238 | retval += sizeof (struct ts_event); |
225 | } | 239 | } |
226 | 240 | ||
@@ -228,32 +242,33 @@ static ssize_t tsdev_read(struct file *file, char __user *buffer, size_t count, | |||
228 | } | 242 | } |
229 | 243 | ||
230 | /* No kernel lock - fine */ | 244 | /* No kernel lock - fine */ |
231 | static unsigned int tsdev_poll(struct file *file, poll_table * wait) | 245 | static unsigned int tsdev_poll(struct file *file, poll_table *wait) |
232 | { | 246 | { |
233 | struct tsdev_list *list = file->private_data; | 247 | struct tsdev_client *client = file->private_data; |
248 | struct tsdev *tsdev = client->tsdev; | ||
234 | 249 | ||
235 | poll_wait(file, &list->tsdev->wait, wait); | 250 | poll_wait(file, &tsdev->wait, wait); |
236 | return ((list->head == list->tail) ? 0 : (POLLIN | POLLRDNORM)) | | 251 | return ((client->head == client->tail) ? 0 : (POLLIN | POLLRDNORM)) | |
237 | (list->tsdev->exist ? 0 : (POLLHUP | POLLERR)); | 252 | (tsdev->exist ? 0 : (POLLHUP | POLLERR)); |
238 | } | 253 | } |
239 | 254 | ||
240 | static int tsdev_ioctl(struct inode *inode, struct file *file, | 255 | static int tsdev_ioctl(struct inode *inode, struct file *file, |
241 | unsigned int cmd, unsigned long arg) | 256 | unsigned int cmd, unsigned long arg) |
242 | { | 257 | { |
243 | struct tsdev_list *list = file->private_data; | 258 | struct tsdev_client *client = file->private_data; |
244 | struct tsdev *tsdev = list->tsdev; | 259 | struct tsdev *tsdev = client->tsdev; |
245 | int retval = 0; | 260 | int retval = 0; |
246 | 261 | ||
247 | switch (cmd) { | 262 | switch (cmd) { |
248 | case TS_GET_CAL: | 263 | case TS_GET_CAL: |
249 | if (copy_to_user ((void __user *)arg, &tsdev->cal, | 264 | if (copy_to_user((void __user *)arg, &tsdev->cal, |
250 | sizeof (struct ts_calibration))) | 265 | sizeof (struct ts_calibration))) |
251 | retval = -EFAULT; | 266 | retval = -EFAULT; |
252 | break; | 267 | break; |
253 | 268 | ||
254 | case TS_SET_CAL: | 269 | case TS_SET_CAL: |
255 | if (copy_from_user (&tsdev->cal, (void __user *)arg, | 270 | if (copy_from_user(&tsdev->cal, (void __user *)arg, |
256 | sizeof (struct ts_calibration))) | 271 | sizeof (struct ts_calibration))) |
257 | retval = -EFAULT; | 272 | retval = -EFAULT; |
258 | break; | 273 | break; |
259 | 274 | ||
@@ -279,7 +294,7 @@ static void tsdev_event(struct input_handle *handle, unsigned int type, | |||
279 | unsigned int code, int value) | 294 | unsigned int code, int value) |
280 | { | 295 | { |
281 | struct tsdev *tsdev = handle->private; | 296 | struct tsdev *tsdev = handle->private; |
282 | struct tsdev_list *list; | 297 | struct tsdev_client *client; |
283 | struct timeval time; | 298 | struct timeval time; |
284 | 299 | ||
285 | switch (type) { | 300 | switch (type) { |
@@ -343,18 +358,18 @@ static void tsdev_event(struct input_handle *handle, unsigned int type, | |||
343 | if (type != EV_SYN || code != SYN_REPORT) | 358 | if (type != EV_SYN || code != SYN_REPORT) |
344 | return; | 359 | return; |
345 | 360 | ||
346 | list_for_each_entry(list, &tsdev->list, node) { | 361 | list_for_each_entry(client, &tsdev->client_list, node) { |
347 | int x, y, tmp; | 362 | int x, y, tmp; |
348 | 363 | ||
349 | do_gettimeofday(&time); | 364 | do_gettimeofday(&time); |
350 | list->event[list->head].millisecs = time.tv_usec / 100; | 365 | client->event[client->head].millisecs = time.tv_usec / 100; |
351 | list->event[list->head].pressure = tsdev->pressure; | 366 | client->event[client->head].pressure = tsdev->pressure; |
352 | 367 | ||
353 | x = tsdev->x; | 368 | x = tsdev->x; |
354 | y = tsdev->y; | 369 | y = tsdev->y; |
355 | 370 | ||
356 | /* Calibration */ | 371 | /* Calibration */ |
357 | if (!list->raw) { | 372 | if (!client->raw) { |
358 | x = ((x * tsdev->cal.xscale) >> 8) + tsdev->cal.xtrans; | 373 | x = ((x * tsdev->cal.xscale) >> 8) + tsdev->cal.xtrans; |
359 | y = ((y * tsdev->cal.yscale) >> 8) + tsdev->cal.ytrans; | 374 | y = ((y * tsdev->cal.yscale) >> 8) + tsdev->cal.ytrans; |
360 | if (tsdev->cal.xyswap) { | 375 | if (tsdev->cal.xyswap) { |
@@ -362,33 +377,35 @@ static void tsdev_event(struct input_handle *handle, unsigned int type, | |||
362 | } | 377 | } |
363 | } | 378 | } |
364 | 379 | ||
365 | list->event[list->head].x = x; | 380 | client->event[client->head].x = x; |
366 | list->event[list->head].y = y; | 381 | client->event[client->head].y = y; |
367 | list->head = (list->head + 1) & (TSDEV_BUFFER_SIZE - 1); | 382 | client->head = (client->head + 1) & (TSDEV_BUFFER_SIZE - 1); |
368 | kill_fasync(&list->fasync, SIGIO, POLL_IN); | 383 | kill_fasync(&client->fasync, SIGIO, POLL_IN); |
369 | } | 384 | } |
370 | wake_up_interruptible(&tsdev->wait); | 385 | wake_up_interruptible(&tsdev->wait); |
371 | } | 386 | } |
372 | 387 | ||
373 | static struct input_handle *tsdev_connect(struct input_handler *handler, | 388 | static int tsdev_connect(struct input_handler *handler, struct input_dev *dev, |
374 | struct input_dev *dev, | 389 | const struct input_device_id *id) |
375 | const struct input_device_id *id) | ||
376 | { | 390 | { |
377 | struct tsdev *tsdev; | 391 | struct tsdev *tsdev; |
378 | struct class_device *cdev; | 392 | struct class_device *cdev; |
393 | dev_t devt; | ||
379 | int minor, delta; | 394 | int minor, delta; |
395 | int error; | ||
380 | 396 | ||
381 | for (minor = 0; minor < TSDEV_MINORS / 2 && tsdev_table[minor]; minor++); | 397 | for (minor = 0; minor < TSDEV_MINORS / 2 && tsdev_table[minor]; minor++); |
382 | if (minor >= TSDEV_MINORS / 2) { | 398 | if (minor >= TSDEV_MINORS / 2) { |
383 | printk(KERN_ERR | 399 | printk(KERN_ERR |
384 | "tsdev: You have way too many touchscreens\n"); | 400 | "tsdev: You have way too many touchscreens\n"); |
385 | return NULL; | 401 | return -ENFILE; |
386 | } | 402 | } |
387 | 403 | ||
388 | if (!(tsdev = kzalloc(sizeof(struct tsdev), GFP_KERNEL))) | 404 | tsdev = kzalloc(sizeof(struct tsdev), GFP_KERNEL); |
389 | return NULL; | 405 | if (!tsdev) |
406 | return -ENOMEM; | ||
390 | 407 | ||
391 | INIT_LIST_HEAD(&tsdev->list); | 408 | INIT_LIST_HEAD(&tsdev->client_list); |
392 | init_waitqueue_head(&tsdev->wait); | 409 | init_waitqueue_head(&tsdev->wait); |
393 | 410 | ||
394 | sprintf(tsdev->name, "ts%d", minor); | 411 | sprintf(tsdev->name, "ts%d", minor); |
@@ -415,21 +432,43 @@ static struct input_handle *tsdev_connect(struct input_handler *handler, | |||
415 | 432 | ||
416 | tsdev_table[minor] = tsdev; | 433 | tsdev_table[minor] = tsdev; |
417 | 434 | ||
418 | cdev = class_device_create(&input_class, &dev->cdev, | 435 | devt = MKDEV(INPUT_MAJOR, TSDEV_MINOR_BASE + minor), |
419 | MKDEV(INPUT_MAJOR, TSDEV_MINOR_BASE + minor), | 436 | |
420 | dev->cdev.dev, tsdev->name); | 437 | cdev = class_device_create(&input_class, &dev->cdev, devt, |
438 | dev->cdev.dev, tsdev->name); | ||
439 | if (IS_ERR(cdev)) { | ||
440 | error = PTR_ERR(cdev); | ||
441 | goto err_free_tsdev; | ||
442 | } | ||
421 | 443 | ||
422 | /* temporary symlink to keep userspace happy */ | 444 | /* temporary symlink to keep userspace happy */ |
423 | sysfs_create_link(&input_class.subsys.kobj, &cdev->kobj, | 445 | error = sysfs_create_link(&input_class.subsys.kobj, |
424 | tsdev->name); | 446 | &cdev->kobj, tsdev->name); |
447 | if (error) | ||
448 | goto err_cdev_destroy; | ||
449 | |||
450 | error = input_register_handle(&tsdev->handle); | ||
451 | if (error) | ||
452 | goto err_remove_link; | ||
453 | |||
454 | return 0; | ||
425 | 455 | ||
426 | return &tsdev->handle; | 456 | err_remove_link: |
457 | sysfs_remove_link(&input_class.subsys.kobj, tsdev->name); | ||
458 | err_cdev_destroy: | ||
459 | class_device_destroy(&input_class, devt); | ||
460 | err_free_tsdev: | ||
461 | tsdev_table[minor] = NULL; | ||
462 | kfree(tsdev); | ||
463 | return error; | ||
427 | } | 464 | } |
428 | 465 | ||
429 | static void tsdev_disconnect(struct input_handle *handle) | 466 | static void tsdev_disconnect(struct input_handle *handle) |
430 | { | 467 | { |
431 | struct tsdev *tsdev = handle->private; | 468 | struct tsdev *tsdev = handle->private; |
432 | struct tsdev_list *list; | 469 | struct tsdev_client *client; |
470 | |||
471 | input_unregister_handle(handle); | ||
433 | 472 | ||
434 | sysfs_remove_link(&input_class.subsys.kobj, tsdev->name); | 473 | sysfs_remove_link(&input_class.subsys.kobj, tsdev->name); |
435 | class_device_destroy(&input_class, | 474 | class_device_destroy(&input_class, |
@@ -439,8 +478,8 @@ static void tsdev_disconnect(struct input_handle *handle) | |||
439 | if (tsdev->open) { | 478 | if (tsdev->open) { |
440 | input_close_device(handle); | 479 | input_close_device(handle); |
441 | wake_up_interruptible(&tsdev->wait); | 480 | wake_up_interruptible(&tsdev->wait); |
442 | list_for_each_entry(list, &tsdev->list, node) | 481 | list_for_each_entry(client, &tsdev->client_list, node) |
443 | kill_fasync(&list->fasync, SIGIO, POLL_HUP); | 482 | kill_fasync(&client->fasync, SIGIO, POLL_HUP); |
444 | } else | 483 | } else |
445 | tsdev_free(tsdev); | 484 | tsdev_free(tsdev); |
446 | } | 485 | } |
diff --git a/drivers/usb/input/Makefile b/drivers/usb/input/Makefile index 9bf420eef77f..284a0734e0cd 100644 --- a/drivers/usb/input/Makefile +++ b/drivers/usb/input/Makefile | |||
@@ -10,9 +10,6 @@ obj-$(CONFIG_USB_ATI_REMOTE) += ati_remote.o | |||
10 | obj-$(CONFIG_USB_ATI_REMOTE2) += ati_remote2.o | 10 | obj-$(CONFIG_USB_ATI_REMOTE2) += ati_remote2.o |
11 | obj-$(CONFIG_USB_KBTAB) += kbtab.o | 11 | obj-$(CONFIG_USB_KBTAB) += kbtab.o |
12 | obj-$(CONFIG_USB_KEYSPAN_REMOTE) += keyspan_remote.o | 12 | obj-$(CONFIG_USB_KEYSPAN_REMOTE) += keyspan_remote.o |
13 | obj-$(CONFIG_USB_MTOUCH) += mtouchusb.o | ||
14 | obj-$(CONFIG_USB_ITMTOUCH) += itmtouch.o | ||
15 | obj-$(CONFIG_USB_EGALAX) += touchkitusb.o | ||
16 | obj-$(CONFIG_USB_TOUCHSCREEN) += usbtouchscreen.o | 13 | obj-$(CONFIG_USB_TOUCHSCREEN) += usbtouchscreen.o |
17 | obj-$(CONFIG_USB_POWERMATE) += powermate.o | 14 | obj-$(CONFIG_USB_POWERMATE) += powermate.o |
18 | obj-$(CONFIG_USB_WACOM) += wacom.o | 15 | obj-$(CONFIG_USB_WACOM) += wacom.o |
@@ -20,7 +17,7 @@ obj-$(CONFIG_USB_ACECAD) += acecad.o | |||
20 | obj-$(CONFIG_USB_YEALINK) += yealink.o | 17 | obj-$(CONFIG_USB_YEALINK) += yealink.o |
21 | obj-$(CONFIG_USB_XPAD) += xpad.o | 18 | obj-$(CONFIG_USB_XPAD) += xpad.o |
22 | obj-$(CONFIG_USB_APPLETOUCH) += appletouch.o | 19 | obj-$(CONFIG_USB_APPLETOUCH) += appletouch.o |
23 | obj-$(CONFIG_USB_GTCO) += gtco.o | 20 | obj-$(CONFIG_USB_GTCO) += gtco.o |
24 | 21 | ||
25 | ifeq ($(CONFIG_USB_DEBUG),y) | 22 | ifeq ($(CONFIG_USB_DEBUG),y) |
26 | EXTRA_CFLAGS += -DDEBUG | 23 | EXTRA_CFLAGS += -DDEBUG |
diff --git a/drivers/usb/input/acecad.c b/drivers/usb/input/acecad.c index 909138e5aa04..be8e9243c062 100644 --- a/drivers/usb/input/acecad.c +++ b/drivers/usb/input/acecad.c | |||
@@ -111,7 +111,7 @@ resubmit: | |||
111 | 111 | ||
112 | static int usb_acecad_open(struct input_dev *dev) | 112 | static int usb_acecad_open(struct input_dev *dev) |
113 | { | 113 | { |
114 | struct usb_acecad *acecad = dev->private; | 114 | struct usb_acecad *acecad = input_get_drvdata(dev); |
115 | 115 | ||
116 | acecad->irq->dev = acecad->usbdev; | 116 | acecad->irq->dev = acecad->usbdev; |
117 | if (usb_submit_urb(acecad->irq, GFP_KERNEL)) | 117 | if (usb_submit_urb(acecad->irq, GFP_KERNEL)) |
@@ -122,7 +122,7 @@ static int usb_acecad_open(struct input_dev *dev) | |||
122 | 122 | ||
123 | static void usb_acecad_close(struct input_dev *dev) | 123 | static void usb_acecad_close(struct input_dev *dev) |
124 | { | 124 | { |
125 | struct usb_acecad *acecad = dev->private; | 125 | struct usb_acecad *acecad = input_get_drvdata(dev); |
126 | 126 | ||
127 | usb_kill_urb(acecad->irq); | 127 | usb_kill_urb(acecad->irq); |
128 | } | 128 | } |
@@ -135,6 +135,7 @@ static int usb_acecad_probe(struct usb_interface *intf, const struct usb_device_ | |||
135 | struct usb_acecad *acecad; | 135 | struct usb_acecad *acecad; |
136 | struct input_dev *input_dev; | 136 | struct input_dev *input_dev; |
137 | int pipe, maxp; | 137 | int pipe, maxp; |
138 | int err = -ENOMEM; | ||
138 | 139 | ||
139 | if (interface->desc.bNumEndpoints != 1) | 140 | if (interface->desc.bNumEndpoints != 1) |
140 | return -ENODEV; | 141 | return -ENODEV; |
@@ -149,16 +150,22 @@ static int usb_acecad_probe(struct usb_interface *intf, const struct usb_device_ | |||
149 | 150 | ||
150 | acecad = kzalloc(sizeof(struct usb_acecad), GFP_KERNEL); | 151 | acecad = kzalloc(sizeof(struct usb_acecad), GFP_KERNEL); |
151 | input_dev = input_allocate_device(); | 152 | input_dev = input_allocate_device(); |
152 | if (!acecad || !input_dev) | 153 | if (!acecad || !input_dev) { |
154 | err = -ENOMEM; | ||
153 | goto fail1; | 155 | goto fail1; |
156 | } | ||
154 | 157 | ||
155 | acecad->data = usb_buffer_alloc(dev, 8, GFP_KERNEL, &acecad->data_dma); | 158 | acecad->data = usb_buffer_alloc(dev, 8, GFP_KERNEL, &acecad->data_dma); |
156 | if (!acecad->data) | 159 | if (!acecad->data) { |
160 | err= -ENOMEM; | ||
157 | goto fail1; | 161 | goto fail1; |
162 | } | ||
158 | 163 | ||
159 | acecad->irq = usb_alloc_urb(0, GFP_KERNEL); | 164 | acecad->irq = usb_alloc_urb(0, GFP_KERNEL); |
160 | if (!acecad->irq) | 165 | if (!acecad->irq) { |
166 | err = -ENOMEM; | ||
161 | goto fail2; | 167 | goto fail2; |
168 | } | ||
162 | 169 | ||
163 | acecad->usbdev = dev; | 170 | acecad->usbdev = dev; |
164 | acecad->input = input_dev; | 171 | acecad->input = input_dev; |
@@ -178,8 +185,9 @@ static int usb_acecad_probe(struct usb_interface *intf, const struct usb_device_ | |||
178 | input_dev->name = acecad->name; | 185 | input_dev->name = acecad->name; |
179 | input_dev->phys = acecad->phys; | 186 | input_dev->phys = acecad->phys; |
180 | usb_to_input_id(dev, &input_dev->id); | 187 | usb_to_input_id(dev, &input_dev->id); |
181 | input_dev->cdev.dev = &intf->dev; | 188 | input_dev->dev.parent = &intf->dev; |
182 | input_dev->private = acecad; | 189 | |
190 | input_set_drvdata(input_dev, acecad); | ||
183 | 191 | ||
184 | input_dev->open = usb_acecad_open; | 192 | input_dev->open = usb_acecad_open; |
185 | input_dev->close = usb_acecad_close; | 193 | input_dev->close = usb_acecad_close; |
@@ -221,7 +229,9 @@ static int usb_acecad_probe(struct usb_interface *intf, const struct usb_device_ | |||
221 | acecad->irq->transfer_dma = acecad->data_dma; | 229 | acecad->irq->transfer_dma = acecad->data_dma; |
222 | acecad->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 230 | acecad->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; |
223 | 231 | ||
224 | input_register_device(acecad->input); | 232 | err = input_register_device(acecad->input); |
233 | if (err) | ||
234 | goto fail2; | ||
225 | 235 | ||
226 | usb_set_intfdata(intf, acecad); | 236 | usb_set_intfdata(intf, acecad); |
227 | 237 | ||
@@ -230,7 +240,7 @@ static int usb_acecad_probe(struct usb_interface *intf, const struct usb_device_ | |||
230 | fail2: usb_buffer_free(dev, 8, acecad->data, acecad->data_dma); | 240 | fail2: usb_buffer_free(dev, 8, acecad->data, acecad->data_dma); |
231 | fail1: input_free_device(input_dev); | 241 | fail1: input_free_device(input_dev); |
232 | kfree(acecad); | 242 | kfree(acecad); |
233 | return -ENOMEM; | 243 | return err; |
234 | } | 244 | } |
235 | 245 | ||
236 | static void usb_acecad_disconnect(struct usb_interface *intf) | 246 | static void usb_acecad_disconnect(struct usb_interface *intf) |
diff --git a/drivers/usb/input/aiptek.c b/drivers/usb/input/aiptek.c index f857935e615c..cc0a498763d8 100644 --- a/drivers/usb/input/aiptek.c +++ b/drivers/usb/input/aiptek.c | |||
@@ -798,7 +798,7 @@ MODULE_DEVICE_TABLE(usb, aiptek_ids); | |||
798 | */ | 798 | */ |
799 | static int aiptek_open(struct input_dev *inputdev) | 799 | static int aiptek_open(struct input_dev *inputdev) |
800 | { | 800 | { |
801 | struct aiptek *aiptek = inputdev->private; | 801 | struct aiptek *aiptek = input_get_drvdata(inputdev); |
802 | 802 | ||
803 | aiptek->urb->dev = aiptek->usbdev; | 803 | aiptek->urb->dev = aiptek->usbdev; |
804 | if (usb_submit_urb(aiptek->urb, GFP_KERNEL) != 0) | 804 | if (usb_submit_urb(aiptek->urb, GFP_KERNEL) != 0) |
@@ -812,7 +812,7 @@ static int aiptek_open(struct input_dev *inputdev) | |||
812 | */ | 812 | */ |
813 | static void aiptek_close(struct input_dev *inputdev) | 813 | static void aiptek_close(struct input_dev *inputdev) |
814 | { | 814 | { |
815 | struct aiptek *aiptek = inputdev->private; | 815 | struct aiptek *aiptek = input_get_drvdata(inputdev); |
816 | 816 | ||
817 | usb_kill_urb(aiptek->urb); | 817 | usb_kill_urb(aiptek->urb); |
818 | } | 818 | } |
@@ -1972,6 +1972,7 @@ aiptek_probe(struct usb_interface *intf, const struct usb_device_id *id) | |||
1972 | AIPTEK_PROGRAMMABLE_DELAY_200, | 1972 | AIPTEK_PROGRAMMABLE_DELAY_200, |
1973 | AIPTEK_PROGRAMMABLE_DELAY_300 | 1973 | AIPTEK_PROGRAMMABLE_DELAY_300 |
1974 | }; | 1974 | }; |
1975 | int err = -ENOMEM; | ||
1975 | 1976 | ||
1976 | /* programmableDelay is where the command-line specified | 1977 | /* programmableDelay is where the command-line specified |
1977 | * delay is kept. We make it the first element of speeds[], | 1978 | * delay is kept. We make it the first element of speeds[], |
@@ -2043,8 +2044,10 @@ aiptek_probe(struct usb_interface *intf, const struct usb_device_id *id) | |||
2043 | inputdev->name = "Aiptek"; | 2044 | inputdev->name = "Aiptek"; |
2044 | inputdev->phys = aiptek->features.usbPath; | 2045 | inputdev->phys = aiptek->features.usbPath; |
2045 | usb_to_input_id(usbdev, &inputdev->id); | 2046 | usb_to_input_id(usbdev, &inputdev->id); |
2046 | inputdev->cdev.dev = &intf->dev; | 2047 | inputdev->dev.parent = &intf->dev; |
2047 | inputdev->private = aiptek; | 2048 | |
2049 | input_set_drvdata(inputdev, aiptek); | ||
2050 | |||
2048 | inputdev->open = aiptek_open; | 2051 | inputdev->open = aiptek_open; |
2049 | inputdev->close = aiptek_close; | 2052 | inputdev->close = aiptek_close; |
2050 | 2053 | ||
@@ -2133,7 +2136,9 @@ aiptek_probe(struct usb_interface *intf, const struct usb_device_id *id) | |||
2133 | 2136 | ||
2134 | /* Register the tablet as an Input Device | 2137 | /* Register the tablet as an Input Device |
2135 | */ | 2138 | */ |
2136 | input_register_device(aiptek->inputdev); | 2139 | err = input_register_device(aiptek->inputdev); |
2140 | if (err) | ||
2141 | goto fail2; | ||
2137 | 2142 | ||
2138 | /* We now will look for the evdev device which is mapped to | 2143 | /* We now will look for the evdev device which is mapped to |
2139 | * the tablet. The partial name is kept in the link list of | 2144 | * the tablet. The partial name is kept in the link list of |
@@ -2165,23 +2170,13 @@ aiptek_probe(struct usb_interface *intf, const struct usb_device_id *id) | |||
2165 | 2170 | ||
2166 | return 0; | 2171 | return 0; |
2167 | 2172 | ||
2168 | fail2: usb_buffer_free(usbdev, AIPTEK_PACKET_LENGTH, aiptek->data, | 2173 | fail2: usb_buffer_free(usbdev, AIPTEK_PACKET_LENGTH, aiptek->data, |
2169 | aiptek->data_dma); | 2174 | aiptek->data_dma); |
2170 | fail1: input_free_device(inputdev); | 2175 | fail1: input_free_device(inputdev); |
2171 | kfree(aiptek); | 2176 | kfree(aiptek); |
2172 | return -ENOMEM; | 2177 | return err; |
2173 | } | 2178 | } |
2174 | 2179 | ||
2175 | /* Forward declaration */ | ||
2176 | static void aiptek_disconnect(struct usb_interface *intf); | ||
2177 | |||
2178 | static struct usb_driver aiptek_driver = { | ||
2179 | .name = "aiptek", | ||
2180 | .probe = aiptek_probe, | ||
2181 | .disconnect = aiptek_disconnect, | ||
2182 | .id_table = aiptek_ids, | ||
2183 | }; | ||
2184 | |||
2185 | /*********************************************************************** | 2180 | /*********************************************************************** |
2186 | * Deal with tablet disconnecting from the system. | 2181 | * Deal with tablet disconnecting from the system. |
2187 | */ | 2182 | */ |
@@ -2206,6 +2201,13 @@ static void aiptek_disconnect(struct usb_interface *intf) | |||
2206 | } | 2201 | } |
2207 | } | 2202 | } |
2208 | 2203 | ||
2204 | static struct usb_driver aiptek_driver = { | ||
2205 | .name = "aiptek", | ||
2206 | .probe = aiptek_probe, | ||
2207 | .disconnect = aiptek_disconnect, | ||
2208 | .id_table = aiptek_ids, | ||
2209 | }; | ||
2210 | |||
2209 | static int __init aiptek_init(void) | 2211 | static int __init aiptek_init(void) |
2210 | { | 2212 | { |
2211 | int result = usb_register(&aiptek_driver); | 2213 | int result = usb_register(&aiptek_driver); |
diff --git a/drivers/usb/input/appletouch.c b/drivers/usb/input/appletouch.c index c77291d3d063..e3215267db11 100644 --- a/drivers/usb/input/appletouch.c +++ b/drivers/usb/input/appletouch.c | |||
@@ -466,7 +466,7 @@ exit: | |||
466 | 466 | ||
467 | static int atp_open(struct input_dev *input) | 467 | static int atp_open(struct input_dev *input) |
468 | { | 468 | { |
469 | struct atp *dev = input->private; | 469 | struct atp *dev = input_get_drvdata(input); |
470 | 470 | ||
471 | if (usb_submit_urb(dev->urb, GFP_ATOMIC)) | 471 | if (usb_submit_urb(dev->urb, GFP_ATOMIC)) |
472 | return -EIO; | 472 | return -EIO; |
@@ -477,7 +477,7 @@ static int atp_open(struct input_dev *input) | |||
477 | 477 | ||
478 | static void atp_close(struct input_dev *input) | 478 | static void atp_close(struct input_dev *input) |
479 | { | 479 | { |
480 | struct atp *dev = input->private; | 480 | struct atp *dev = input_get_drvdata(input); |
481 | 481 | ||
482 | usb_kill_urb(dev->urb); | 482 | usb_kill_urb(dev->urb); |
483 | dev->open = 0; | 483 | dev->open = 0; |
@@ -491,8 +491,7 @@ static int atp_probe(struct usb_interface *iface, const struct usb_device_id *id | |||
491 | struct usb_host_interface *iface_desc; | 491 | struct usb_host_interface *iface_desc; |
492 | struct usb_endpoint_descriptor *endpoint; | 492 | struct usb_endpoint_descriptor *endpoint; |
493 | int int_in_endpointAddr = 0; | 493 | int int_in_endpointAddr = 0; |
494 | int i, retval = -ENOMEM; | 494 | int i, error = -ENOMEM; |
495 | |||
496 | 495 | ||
497 | /* set up the endpoint information */ | 496 | /* set up the endpoint information */ |
498 | /* use only the first interrupt-in endpoint */ | 497 | /* use only the first interrupt-in endpoint */ |
@@ -567,17 +566,13 @@ static int atp_probe(struct usb_interface *iface, const struct usb_device_id *id | |||
567 | } | 566 | } |
568 | 567 | ||
569 | dev->urb = usb_alloc_urb(0, GFP_KERNEL); | 568 | dev->urb = usb_alloc_urb(0, GFP_KERNEL); |
570 | if (!dev->urb) { | 569 | if (!dev->urb) |
571 | retval = -ENOMEM; | ||
572 | goto err_free_devs; | 570 | goto err_free_devs; |
573 | } | ||
574 | 571 | ||
575 | dev->data = usb_buffer_alloc(dev->udev, dev->datalen, GFP_KERNEL, | 572 | dev->data = usb_buffer_alloc(dev->udev, dev->datalen, GFP_KERNEL, |
576 | &dev->urb->transfer_dma); | 573 | &dev->urb->transfer_dma); |
577 | if (!dev->data) { | 574 | if (!dev->data) |
578 | retval = -ENOMEM; | ||
579 | goto err_free_urb; | 575 | goto err_free_urb; |
580 | } | ||
581 | 576 | ||
582 | usb_fill_int_urb(dev->urb, udev, | 577 | usb_fill_int_urb(dev->urb, udev, |
583 | usb_rcvintpipe(udev, int_in_endpointAddr), | 578 | usb_rcvintpipe(udev, int_in_endpointAddr), |
@@ -589,9 +584,10 @@ static int atp_probe(struct usb_interface *iface, const struct usb_device_id *id | |||
589 | input_dev->name = "appletouch"; | 584 | input_dev->name = "appletouch"; |
590 | input_dev->phys = dev->phys; | 585 | input_dev->phys = dev->phys; |
591 | usb_to_input_id(dev->udev, &input_dev->id); | 586 | usb_to_input_id(dev->udev, &input_dev->id); |
592 | input_dev->cdev.dev = &iface->dev; | 587 | input_dev->dev.parent = &iface->dev; |
588 | |||
589 | input_set_drvdata(input_dev, dev); | ||
593 | 590 | ||
594 | input_dev->private = dev; | ||
595 | input_dev->open = atp_open; | 591 | input_dev->open = atp_open; |
596 | input_dev->close = atp_close; | 592 | input_dev->close = atp_close; |
597 | 593 | ||
@@ -633,20 +629,25 @@ static int atp_probe(struct usb_interface *iface, const struct usb_device_id *id | |||
633 | set_bit(BTN_TOOL_TRIPLETAP, input_dev->keybit); | 629 | set_bit(BTN_TOOL_TRIPLETAP, input_dev->keybit); |
634 | set_bit(BTN_LEFT, input_dev->keybit); | 630 | set_bit(BTN_LEFT, input_dev->keybit); |
635 | 631 | ||
636 | input_register_device(dev->input); | 632 | error = input_register_device(dev->input); |
633 | if (error) | ||
634 | goto err_free_buffer; | ||
637 | 635 | ||
638 | /* save our data pointer in this interface device */ | 636 | /* save our data pointer in this interface device */ |
639 | usb_set_intfdata(iface, dev); | 637 | usb_set_intfdata(iface, dev); |
640 | 638 | ||
641 | return 0; | 639 | return 0; |
642 | 640 | ||
641 | err_free_buffer: | ||
642 | usb_buffer_free(dev->udev, dev->datalen, | ||
643 | dev->data, dev->urb->transfer_dma); | ||
643 | err_free_urb: | 644 | err_free_urb: |
644 | usb_free_urb(dev->urb); | 645 | usb_free_urb(dev->urb); |
645 | err_free_devs: | 646 | err_free_devs: |
646 | usb_set_intfdata(iface, NULL); | 647 | usb_set_intfdata(iface, NULL); |
647 | kfree(dev); | 648 | kfree(dev); |
648 | input_free_device(input_dev); | 649 | input_free_device(input_dev); |
649 | return retval; | 650 | return error; |
650 | } | 651 | } |
651 | 652 | ||
652 | static void atp_disconnect(struct usb_interface *iface) | 653 | static void atp_disconnect(struct usb_interface *iface) |
diff --git a/drivers/usb/input/ati_remote.c b/drivers/usb/input/ati_remote.c index b724e36f7b92..471aab206443 100644 --- a/drivers/usb/input/ati_remote.c +++ b/drivers/usb/input/ati_remote.c | |||
@@ -120,6 +120,7 @@ | |||
120 | * behaviour. | 120 | * behaviour. |
121 | */ | 121 | */ |
122 | #define FILTER_TIME 60 /* msec */ | 122 | #define FILTER_TIME 60 /* msec */ |
123 | #define REPEAT_DELAY 500 /* msec */ | ||
123 | 124 | ||
124 | static unsigned long channel_mask; | 125 | static unsigned long channel_mask; |
125 | module_param(channel_mask, ulong, 0644); | 126 | module_param(channel_mask, ulong, 0644); |
@@ -133,6 +134,10 @@ static int repeat_filter = FILTER_TIME; | |||
133 | module_param(repeat_filter, int, 0644); | 134 | module_param(repeat_filter, int, 0644); |
134 | MODULE_PARM_DESC(repeat_filter, "Repeat filter time, default = 60 msec"); | 135 | MODULE_PARM_DESC(repeat_filter, "Repeat filter time, default = 60 msec"); |
135 | 136 | ||
137 | static int repeat_delay = REPEAT_DELAY; | ||
138 | module_param(repeat_delay, int, 0644); | ||
139 | MODULE_PARM_DESC(repeat_delay, "Delay before sending repeats, default = 500 msec"); | ||
140 | |||
136 | #define dbginfo(dev, format, arg...) do { if (debug) dev_info(dev , format , ## arg); } while (0) | 141 | #define dbginfo(dev, format, arg...) do { if (debug) dev_info(dev , format , ## arg); } while (0) |
137 | #undef err | 142 | #undef err |
138 | #define err(format, arg...) printk(KERN_ERR format , ## arg) | 143 | #define err(format, arg...) printk(KERN_ERR format , ## arg) |
@@ -174,6 +179,8 @@ struct ati_remote { | |||
174 | unsigned char old_data[2]; /* Detect duplicate events */ | 179 | unsigned char old_data[2]; /* Detect duplicate events */ |
175 | unsigned long old_jiffies; | 180 | unsigned long old_jiffies; |
176 | unsigned long acc_jiffies; /* handle acceleration */ | 181 | unsigned long acc_jiffies; /* handle acceleration */ |
182 | unsigned long first_jiffies; | ||
183 | |||
177 | unsigned int repeat_count; | 184 | unsigned int repeat_count; |
178 | 185 | ||
179 | char name[NAME_BUFSIZE]; | 186 | char name[NAME_BUFSIZE]; |
@@ -318,7 +325,7 @@ static void ati_remote_dump(unsigned char *data, unsigned int len) | |||
318 | */ | 325 | */ |
319 | static int ati_remote_open(struct input_dev *inputdev) | 326 | static int ati_remote_open(struct input_dev *inputdev) |
320 | { | 327 | { |
321 | struct ati_remote *ati_remote = inputdev->private; | 328 | struct ati_remote *ati_remote = input_get_drvdata(inputdev); |
322 | 329 | ||
323 | /* On first open, submit the read urb which was set up previously. */ | 330 | /* On first open, submit the read urb which was set up previously. */ |
324 | ati_remote->irq_urb->dev = ati_remote->udev; | 331 | ati_remote->irq_urb->dev = ati_remote->udev; |
@@ -336,7 +343,7 @@ static int ati_remote_open(struct input_dev *inputdev) | |||
336 | */ | 343 | */ |
337 | static void ati_remote_close(struct input_dev *inputdev) | 344 | static void ati_remote_close(struct input_dev *inputdev) |
338 | { | 345 | { |
339 | struct ati_remote *ati_remote = inputdev->private; | 346 | struct ati_remote *ati_remote = input_get_drvdata(inputdev); |
340 | 347 | ||
341 | usb_kill_urb(ati_remote->irq_urb); | 348 | usb_kill_urb(ati_remote->irq_urb); |
342 | } | 349 | } |
@@ -501,21 +508,31 @@ static void ati_remote_input_report(struct urb *urb) | |||
501 | } | 508 | } |
502 | 509 | ||
503 | if (ati_remote_tbl[index].kind == KIND_FILTERED) { | 510 | if (ati_remote_tbl[index].kind == KIND_FILTERED) { |
511 | unsigned long now = jiffies; | ||
512 | |||
504 | /* Filter duplicate events which happen "too close" together. */ | 513 | /* Filter duplicate events which happen "too close" together. */ |
505 | if (ati_remote->old_data[0] == data[1] && | 514 | if (ati_remote->old_data[0] == data[1] && |
506 | ati_remote->old_data[1] == data[2] && | 515 | ati_remote->old_data[1] == data[2] && |
507 | time_before(jiffies, ati_remote->old_jiffies + msecs_to_jiffies(repeat_filter))) { | 516 | time_before(now, ati_remote->old_jiffies + |
517 | msecs_to_jiffies(repeat_filter))) { | ||
508 | ati_remote->repeat_count++; | 518 | ati_remote->repeat_count++; |
509 | } else { | 519 | } else { |
510 | ati_remote->repeat_count = 0; | 520 | ati_remote->repeat_count = 0; |
521 | ati_remote->first_jiffies = now; | ||
511 | } | 522 | } |
512 | 523 | ||
513 | ati_remote->old_data[0] = data[1]; | 524 | ati_remote->old_data[0] = data[1]; |
514 | ati_remote->old_data[1] = data[2]; | 525 | ati_remote->old_data[1] = data[2]; |
515 | ati_remote->old_jiffies = jiffies; | 526 | ati_remote->old_jiffies = now; |
516 | 527 | ||
528 | /* Ensure we skip at least the 4 first duplicate events (generated | ||
529 | * by a single keypress), and continue skipping until repeat_delay | ||
530 | * msecs have passed | ||
531 | */ | ||
517 | if (ati_remote->repeat_count > 0 && | 532 | if (ati_remote->repeat_count > 0 && |
518 | ati_remote->repeat_count < 5) | 533 | (ati_remote->repeat_count < 5 || |
534 | time_before(now, ati_remote->first_jiffies + | ||
535 | msecs_to_jiffies(repeat_delay)))) | ||
519 | return; | 536 | return; |
520 | 537 | ||
521 | 538 | ||
@@ -653,7 +670,8 @@ static void ati_remote_input_init(struct ati_remote *ati_remote) | |||
653 | if (ati_remote_tbl[i].type == EV_KEY) | 670 | if (ati_remote_tbl[i].type == EV_KEY) |
654 | set_bit(ati_remote_tbl[i].code, idev->keybit); | 671 | set_bit(ati_remote_tbl[i].code, idev->keybit); |
655 | 672 | ||
656 | idev->private = ati_remote; | 673 | input_set_drvdata(idev, ati_remote); |
674 | |||
657 | idev->open = ati_remote_open; | 675 | idev->open = ati_remote_open; |
658 | idev->close = ati_remote_close; | 676 | idev->close = ati_remote_close; |
659 | 677 | ||
@@ -661,7 +679,7 @@ static void ati_remote_input_init(struct ati_remote *ati_remote) | |||
661 | idev->phys = ati_remote->phys; | 679 | idev->phys = ati_remote->phys; |
662 | 680 | ||
663 | usb_to_input_id(ati_remote->udev, &idev->id); | 681 | usb_to_input_id(ati_remote->udev, &idev->id); |
664 | idev->cdev.dev = &ati_remote->udev->dev; | 682 | idev->dev.parent = &ati_remote->udev->dev; |
665 | } | 683 | } |
666 | 684 | ||
667 | static int ati_remote_initialize(struct ati_remote *ati_remote) | 685 | static int ati_remote_initialize(struct ati_remote *ati_remote) |
@@ -772,15 +790,17 @@ static int ati_remote_probe(struct usb_interface *interface, const struct usb_de | |||
772 | goto fail3; | 790 | goto fail3; |
773 | 791 | ||
774 | /* Set up and register input device */ | 792 | /* Set up and register input device */ |
775 | input_register_device(ati_remote->idev); | 793 | err = input_register_device(ati_remote->idev); |
794 | if (err) | ||
795 | goto fail3; | ||
776 | 796 | ||
777 | usb_set_intfdata(interface, ati_remote); | 797 | usb_set_intfdata(interface, ati_remote); |
778 | return 0; | 798 | return 0; |
779 | 799 | ||
780 | fail3: usb_kill_urb(ati_remote->irq_urb); | 800 | fail3: usb_kill_urb(ati_remote->irq_urb); |
781 | usb_kill_urb(ati_remote->out_urb); | 801 | usb_kill_urb(ati_remote->out_urb); |
782 | fail2: ati_remote_free_buffers(ati_remote); | 802 | fail2: ati_remote_free_buffers(ati_remote); |
783 | fail1: input_free_device(input_dev); | 803 | fail1: input_free_device(input_dev); |
784 | kfree(ati_remote); | 804 | kfree(ati_remote); |
785 | return err; | 805 | return err; |
786 | } | 806 | } |
diff --git a/drivers/usb/input/ati_remote2.c b/drivers/usb/input/ati_remote2.c index 6459be90599c..a9032aa3465f 100644 --- a/drivers/usb/input/ati_remote2.c +++ b/drivers/usb/input/ati_remote2.c | |||
@@ -131,7 +131,7 @@ static struct usb_driver ati_remote2_driver = { | |||
131 | 131 | ||
132 | static int ati_remote2_open(struct input_dev *idev) | 132 | static int ati_remote2_open(struct input_dev *idev) |
133 | { | 133 | { |
134 | struct ati_remote2 *ar2 = idev->private; | 134 | struct ati_remote2 *ar2 = input_get_drvdata(idev); |
135 | int r; | 135 | int r; |
136 | 136 | ||
137 | r = usb_submit_urb(ar2->urb[0], GFP_KERNEL); | 137 | r = usb_submit_urb(ar2->urb[0], GFP_KERNEL); |
@@ -153,7 +153,7 @@ static int ati_remote2_open(struct input_dev *idev) | |||
153 | 153 | ||
154 | static void ati_remote2_close(struct input_dev *idev) | 154 | static void ati_remote2_close(struct input_dev *idev) |
155 | { | 155 | { |
156 | struct ati_remote2 *ar2 = idev->private; | 156 | struct ati_remote2 *ar2 = input_get_drvdata(idev); |
157 | 157 | ||
158 | usb_kill_urb(ar2->urb[0]); | 158 | usb_kill_urb(ar2->urb[0]); |
159 | usb_kill_urb(ar2->urb[1]); | 159 | usb_kill_urb(ar2->urb[1]); |
@@ -337,14 +337,14 @@ static void ati_remote2_complete_key(struct urb *urb) | |||
337 | static int ati_remote2_input_init(struct ati_remote2 *ar2) | 337 | static int ati_remote2_input_init(struct ati_remote2 *ar2) |
338 | { | 338 | { |
339 | struct input_dev *idev; | 339 | struct input_dev *idev; |
340 | int i; | 340 | int i, retval; |
341 | 341 | ||
342 | idev = input_allocate_device(); | 342 | idev = input_allocate_device(); |
343 | if (!idev) | 343 | if (!idev) |
344 | return -ENOMEM; | 344 | return -ENOMEM; |
345 | 345 | ||
346 | ar2->idev = idev; | 346 | ar2->idev = idev; |
347 | idev->private = ar2; | 347 | input_set_drvdata(idev, ar2); |
348 | 348 | ||
349 | idev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_REL); | 349 | idev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_REL); |
350 | idev->keybit[LONG(BTN_MOUSE)] = BIT(BTN_LEFT) | BIT(BTN_RIGHT); | 350 | idev->keybit[LONG(BTN_MOUSE)] = BIT(BTN_LEFT) | BIT(BTN_RIGHT); |
@@ -362,13 +362,13 @@ static int ati_remote2_input_init(struct ati_remote2 *ar2) | |||
362 | idev->phys = ar2->phys; | 362 | idev->phys = ar2->phys; |
363 | 363 | ||
364 | usb_to_input_id(ar2->udev, &idev->id); | 364 | usb_to_input_id(ar2->udev, &idev->id); |
365 | idev->cdev.dev = &ar2->udev->dev; | 365 | idev->dev.parent = &ar2->udev->dev; |
366 | 366 | ||
367 | i = input_register_device(idev); | 367 | retval = input_register_device(idev); |
368 | if (i) | 368 | if (retval) |
369 | input_free_device(idev); | 369 | input_free_device(idev); |
370 | 370 | ||
371 | return i; | 371 | return retval; |
372 | } | 372 | } |
373 | 373 | ||
374 | static int ati_remote2_urb_init(struct ati_remote2 *ar2) | 374 | static int ati_remote2_urb_init(struct ati_remote2 *ar2) |
diff --git a/drivers/usb/input/gtco.c b/drivers/usb/input/gtco.c index ae756e0afc99..b2ca10f2fe0e 100644 --- a/drivers/usb/input/gtco.c +++ b/drivers/usb/input/gtco.c | |||
@@ -187,7 +187,6 @@ struct hid_descriptor | |||
187 | 187 | ||
188 | 188 | ||
189 | /* | 189 | /* |
190 | * | ||
191 | * This is an abbreviated parser for the HID Report Descriptor. We | 190 | * This is an abbreviated parser for the HID Report Descriptor. We |
192 | * know what devices we are talking to, so this is by no means meant | 191 | * know what devices we are talking to, so this is by no means meant |
193 | * to be generic. We can make some safe assumptions: | 192 | * to be generic. We can make some safe assumptions: |
@@ -204,7 +203,7 @@ struct hid_descriptor | |||
204 | static void parse_hid_report_descriptor(struct gtco *device, char * report, | 203 | static void parse_hid_report_descriptor(struct gtco *device, char * report, |
205 | int length) | 204 | int length) |
206 | { | 205 | { |
207 | int x,i=0; | 206 | int x, i = 0; |
208 | 207 | ||
209 | /* Tag primitive vars */ | 208 | /* Tag primitive vars */ |
210 | __u8 prefix; | 209 | __u8 prefix; |
@@ -215,7 +214,6 @@ static void parse_hid_report_descriptor(struct gtco *device, char * report, | |||
215 | __u16 data16 = 0; | 214 | __u16 data16 = 0; |
216 | __u32 data32 = 0; | 215 | __u32 data32 = 0; |
217 | 216 | ||
218 | |||
219 | /* For parsing logic */ | 217 | /* For parsing logic */ |
220 | int inputnum = 0; | 218 | int inputnum = 0; |
221 | __u32 usage = 0; | 219 | __u32 usage = 0; |
@@ -225,46 +223,46 @@ static void parse_hid_report_descriptor(struct gtco *device, char * report, | |||
225 | __u32 oldval[TAG_GLOB_MAX]; | 223 | __u32 oldval[TAG_GLOB_MAX]; |
226 | 224 | ||
227 | /* Debug stuff */ | 225 | /* Debug stuff */ |
228 | char maintype='x'; | 226 | char maintype = 'x'; |
229 | char globtype[12]; | 227 | char globtype[12]; |
230 | int indent=0; | 228 | int indent = 0; |
231 | char indentstr[10]=""; | 229 | char indentstr[10] = ""; |
232 | |||
233 | 230 | ||
234 | 231 | ||
235 | dbg("======>>>>>>PARSE<<<<<<======"); | 232 | dbg("======>>>>>>PARSE<<<<<<======"); |
236 | 233 | ||
237 | /* Walk this report and pull out the info we need */ | 234 | /* Walk this report and pull out the info we need */ |
238 | while (i<length){ | 235 | while (i < length) { |
239 | prefix=report[i]; | 236 | prefix = report[i]; |
240 | 237 | ||
241 | /* Skip over prefix */ | 238 | /* Skip over prefix */ |
242 | i++; | 239 | i++; |
243 | 240 | ||
244 | /* Determine data size and save the data in the proper variable */ | 241 | /* Determine data size and save the data in the proper variable */ |
245 | size = PREF_SIZE(prefix); | 242 | size = PREF_SIZE(prefix); |
246 | switch(size){ | 243 | switch (size) { |
247 | case 1: | 244 | case 1: |
248 | data = report[i]; | 245 | data = report[i]; |
249 | break; | 246 | break; |
250 | case 2: | 247 | case 2: |
251 | data16 = le16_to_cpu(get_unaligned((__le16*)(&(report[i])))); | 248 | data16 = le16_to_cpu(get_unaligned((__le16 *)&report[i])); |
252 | break; | 249 | break; |
253 | case 3: | 250 | case 3: |
254 | size = 4; | 251 | size = 4; |
255 | data32 = le32_to_cpu(get_unaligned((__le32*)(&(report[i])))); | 252 | data32 = le32_to_cpu(get_unaligned((__le32 *)&report[i])); |
253 | break; | ||
256 | } | 254 | } |
257 | 255 | ||
258 | /* Skip size of data */ | 256 | /* Skip size of data */ |
259 | i+=size; | 257 | i += size; |
260 | 258 | ||
261 | /* What we do depends on the tag type */ | 259 | /* What we do depends on the tag type */ |
262 | tag = PREF_TAG(prefix); | 260 | tag = PREF_TAG(prefix); |
263 | type = PREF_TYPE(prefix); | 261 | type = PREF_TYPE(prefix); |
264 | switch(type){ | 262 | switch (type) { |
265 | case TYPE_MAIN: | 263 | case TYPE_MAIN: |
266 | strcpy(globtype,""); | 264 | strcpy(globtype, ""); |
267 | switch(tag){ | 265 | switch (tag) { |
268 | 266 | ||
269 | case TAG_MAIN_INPUT: | 267 | case TAG_MAIN_INPUT: |
270 | /* | 268 | /* |
@@ -274,19 +272,17 @@ static void parse_hid_report_descriptor(struct gtco *device, char * report, | |||
274 | * min/max values | 272 | * min/max values |
275 | */ | 273 | */ |
276 | 274 | ||
277 | maintype='I'; | 275 | maintype = 'I'; |
278 | if (data==2){ | 276 | if (data == 2) |
279 | strcpy(globtype,"Variable"); | 277 | strcpy(globtype, "Variable"); |
280 | } | 278 | else if (data == 3) |
281 | if (data==3){ | 279 | strcpy(globtype, "Var|Const"); |
282 | strcpy(globtype,"Var|Const"); | ||
283 | } | ||
284 | 280 | ||
285 | dbg("::::: Saving Report: %d input #%d Max: 0x%X(%d) Min:0x%X(%d) of %d bits", | 281 | dbg("::::: Saving Report: %d input #%d Max: 0x%X(%d) Min:0x%X(%d) of %d bits", |
286 | globalval[TAG_GLOB_REPORT_ID],inputnum, | 282 | globalval[TAG_GLOB_REPORT_ID], inputnum, |
287 | globalval[TAG_GLOB_LOG_MAX],globalval[TAG_GLOB_LOG_MAX], | 283 | globalval[TAG_GLOB_LOG_MAX], globalval[TAG_GLOB_LOG_MAX], |
288 | globalval[TAG_GLOB_LOG_MIN],globalval[TAG_GLOB_LOG_MIN], | 284 | globalval[TAG_GLOB_LOG_MIN], globalval[TAG_GLOB_LOG_MIN], |
289 | (globalval[TAG_GLOB_REPORT_SZ] * globalval[TAG_GLOB_REPORT_CNT])); | 285 | globalval[TAG_GLOB_REPORT_SZ] * globalval[TAG_GLOB_REPORT_CNT]); |
290 | 286 | ||
291 | 287 | ||
292 | /* | 288 | /* |
@@ -295,43 +291,43 @@ static void parse_hid_report_descriptor(struct gtco *device, char * report, | |||
295 | that, we look for everything else by | 291 | that, we look for everything else by |
296 | local usage value | 292 | local usage value |
297 | */ | 293 | */ |
298 | switch (inputnum){ | 294 | switch (inputnum) { |
299 | case 0: /* X coord */ | 295 | case 0: /* X coord */ |
300 | dbg("GER: X Usage: 0x%x",usage); | 296 | dbg("GER: X Usage: 0x%x", usage); |
301 | if (device->max_X == 0){ | 297 | if (device->max_X == 0) { |
302 | device->max_X = globalval[TAG_GLOB_LOG_MAX]; | 298 | device->max_X = globalval[TAG_GLOB_LOG_MAX]; |
303 | device->min_X = globalval[TAG_GLOB_LOG_MIN]; | 299 | device->min_X = globalval[TAG_GLOB_LOG_MIN]; |
304 | } | 300 | } |
305 | |||
306 | break; | 301 | break; |
302 | |||
307 | case 1: /* Y coord */ | 303 | case 1: /* Y coord */ |
308 | dbg("GER: Y Usage: 0x%x",usage); | 304 | dbg("GER: Y Usage: 0x%x", usage); |
309 | if (device->max_Y == 0){ | 305 | if (device->max_Y == 0) { |
310 | device->max_Y = globalval[TAG_GLOB_LOG_MAX]; | 306 | device->max_Y = globalval[TAG_GLOB_LOG_MAX]; |
311 | device->min_Y = globalval[TAG_GLOB_LOG_MIN]; | 307 | device->min_Y = globalval[TAG_GLOB_LOG_MIN]; |
312 | } | 308 | } |
313 | break; | 309 | break; |
310 | |||
314 | default: | 311 | default: |
315 | /* Tilt X */ | 312 | /* Tilt X */ |
316 | if (usage == DIGITIZER_USAGE_TILT_X){ | 313 | if (usage == DIGITIZER_USAGE_TILT_X) { |
317 | if (device->maxtilt_X == 0){ | 314 | if (device->maxtilt_X == 0) { |
318 | device->maxtilt_X = globalval[TAG_GLOB_LOG_MAX]; | 315 | device->maxtilt_X = globalval[TAG_GLOB_LOG_MAX]; |
319 | device->mintilt_X = globalval[TAG_GLOB_LOG_MIN]; | 316 | device->mintilt_X = globalval[TAG_GLOB_LOG_MIN]; |
320 | } | 317 | } |
321 | } | 318 | } |
322 | 319 | ||
323 | /* Tilt Y */ | 320 | /* Tilt Y */ |
324 | if (usage == DIGITIZER_USAGE_TILT_Y){ | 321 | if (usage == DIGITIZER_USAGE_TILT_Y) { |
325 | if (device->maxtilt_Y == 0){ | 322 | if (device->maxtilt_Y == 0) { |
326 | device->maxtilt_Y = globalval[TAG_GLOB_LOG_MAX]; | 323 | device->maxtilt_Y = globalval[TAG_GLOB_LOG_MAX]; |
327 | device->mintilt_Y = globalval[TAG_GLOB_LOG_MIN]; | 324 | device->mintilt_Y = globalval[TAG_GLOB_LOG_MIN]; |
328 | } | 325 | } |
329 | } | 326 | } |
330 | 327 | ||
331 | |||
332 | /* Pressure */ | 328 | /* Pressure */ |
333 | if (usage == DIGITIZER_USAGE_TIP_PRESSURE){ | 329 | if (usage == DIGITIZER_USAGE_TIP_PRESSURE) { |
334 | if (device->maxpressure == 0){ | 330 | if (device->maxpressure == 0) { |
335 | device->maxpressure = globalval[TAG_GLOB_LOG_MAX]; | 331 | device->maxpressure = globalval[TAG_GLOB_LOG_MAX]; |
336 | device->minpressure = globalval[TAG_GLOB_LOG_MIN]; | 332 | device->minpressure = globalval[TAG_GLOB_LOG_MIN]; |
337 | } | 333 | } |
@@ -341,214 +337,226 @@ static void parse_hid_report_descriptor(struct gtco *device, char * report, | |||
341 | } | 337 | } |
342 | 338 | ||
343 | inputnum++; | 339 | inputnum++; |
344 | |||
345 | |||
346 | break; | 340 | break; |
341 | |||
347 | case TAG_MAIN_OUTPUT: | 342 | case TAG_MAIN_OUTPUT: |
348 | maintype='O'; | 343 | maintype = 'O'; |
349 | break; | 344 | break; |
345 | |||
350 | case TAG_MAIN_FEATURE: | 346 | case TAG_MAIN_FEATURE: |
351 | maintype='F'; | 347 | maintype = 'F'; |
352 | break; | 348 | break; |
349 | |||
353 | case TAG_MAIN_COL_START: | 350 | case TAG_MAIN_COL_START: |
354 | maintype='S'; | 351 | maintype = 'S'; |
355 | 352 | ||
356 | if (data==0){ | 353 | if (data == 0) { |
357 | dbg("======>>>>>> Physical"); | 354 | dbg("======>>>>>> Physical"); |
358 | strcpy(globtype,"Physical"); | 355 | strcpy(globtype, "Physical"); |
359 | }else{ | 356 | } else |
360 | dbg("======>>>>>>"); | 357 | dbg("======>>>>>>"); |
361 | } | ||
362 | 358 | ||
363 | /* Indent the debug output */ | 359 | /* Indent the debug output */ |
364 | indent++; | 360 | indent++; |
365 | for (x=0;x<indent;x++){ | 361 | for (x = 0; x < indent; x++) |
366 | indentstr[x]='-'; | 362 | indentstr[x] = '-'; |
367 | } | 363 | indentstr[x] = 0; |
368 | indentstr[x]=0; | ||
369 | 364 | ||
370 | /* Save global tags */ | 365 | /* Save global tags */ |
371 | for (x=0;x<TAG_GLOB_MAX;x++){ | 366 | for (x = 0; x < TAG_GLOB_MAX; x++) |
372 | oldval[x] = globalval[x]; | 367 | oldval[x] = globalval[x]; |
373 | } | ||
374 | 368 | ||
375 | break; | 369 | break; |
370 | |||
376 | case TAG_MAIN_COL_END: | 371 | case TAG_MAIN_COL_END: |
377 | dbg("<<<<<<======"); | 372 | dbg("<<<<<<======"); |
378 | maintype='E'; | 373 | maintype = 'E'; |
379 | indent--; | 374 | indent--; |
380 | for (x=0;x<indent;x++){ | 375 | for (x = 0; x < indent; x++) |
381 | indentstr[x]='-'; | 376 | indentstr[x] = '-'; |
382 | } | 377 | indentstr[x] = 0; |
383 | indentstr[x]=0; | ||
384 | 378 | ||
385 | /* Copy global tags back */ | 379 | /* Copy global tags back */ |
386 | for (x=0;x<TAG_GLOB_MAX;x++){ | 380 | for (x = 0; x < TAG_GLOB_MAX; x++) |
387 | globalval[x] = oldval[x]; | 381 | globalval[x] = oldval[x]; |
388 | } | ||
389 | 382 | ||
390 | break; | 383 | break; |
391 | } | 384 | } |
392 | 385 | ||
393 | switch (size){ | 386 | switch (size) { |
394 | case 1: | 387 | case 1: |
395 | dbg("%sMAINTAG:(%d) %c SIZE: %d Data: %s 0x%x", | 388 | dbg("%sMAINTAG:(%d) %c SIZE: %d Data: %s 0x%x", |
396 | indentstr,tag,maintype,size,globtype,data); | 389 | indentstr, tag, maintype, size, globtype, data); |
397 | break; | 390 | break; |
391 | |||
398 | case 2: | 392 | case 2: |
399 | dbg("%sMAINTAG:(%d) %c SIZE: %d Data: %s 0x%x", | 393 | dbg("%sMAINTAG:(%d) %c SIZE: %d Data: %s 0x%x", |
400 | indentstr,tag,maintype,size,globtype, data16); | 394 | indentstr, tag, maintype, size, globtype, data16); |
401 | break; | 395 | break; |
396 | |||
402 | case 4: | 397 | case 4: |
403 | dbg("%sMAINTAG:(%d) %c SIZE: %d Data: %s 0x%x", | 398 | dbg("%sMAINTAG:(%d) %c SIZE: %d Data: %s 0x%x", |
404 | indentstr,tag,maintype,size,globtype,data32); | 399 | indentstr, tag, maintype, size, globtype, data32); |
405 | break; | 400 | break; |
406 | } | 401 | } |
407 | break; | 402 | break; |
403 | |||
408 | case TYPE_GLOBAL: | 404 | case TYPE_GLOBAL: |
409 | switch(tag){ | 405 | switch (tag) { |
410 | case TAG_GLOB_USAGE: | 406 | case TAG_GLOB_USAGE: |
411 | /* | 407 | /* |
412 | * First time we hit the global usage tag, | 408 | * First time we hit the global usage tag, |
413 | * it should tell us the type of device | 409 | * it should tell us the type of device |
414 | */ | 410 | */ |
415 | if (device->usage == 0){ | 411 | if (device->usage == 0) |
416 | device->usage = data; | 412 | device->usage = data; |
417 | } | 413 | |
418 | strcpy(globtype,"USAGE"); | 414 | strcpy(globtype, "USAGE"); |
419 | break; | 415 | break; |
420 | case TAG_GLOB_LOG_MIN : | 416 | |
421 | strcpy(globtype,"LOG_MIN"); | 417 | case TAG_GLOB_LOG_MIN: |
418 | strcpy(globtype, "LOG_MIN"); | ||
422 | break; | 419 | break; |
423 | case TAG_GLOB_LOG_MAX : | 420 | |
424 | strcpy(globtype,"LOG_MAX"); | 421 | case TAG_GLOB_LOG_MAX: |
422 | strcpy(globtype, "LOG_MAX"); | ||
425 | break; | 423 | break; |
426 | case TAG_GLOB_PHYS_MIN : | 424 | |
427 | strcpy(globtype,"PHYS_MIN"); | 425 | case TAG_GLOB_PHYS_MIN: |
426 | strcpy(globtype, "PHYS_MIN"); | ||
428 | break; | 427 | break; |
429 | case TAG_GLOB_PHYS_MAX : | 428 | |
430 | strcpy(globtype,"PHYS_MAX"); | 429 | case TAG_GLOB_PHYS_MAX: |
430 | strcpy(globtype, "PHYS_MAX"); | ||
431 | break; | 431 | break; |
432 | case TAG_GLOB_UNIT_EXP : | 432 | |
433 | strcpy(globtype,"EXP"); | 433 | case TAG_GLOB_UNIT_EXP: |
434 | strcpy(globtype, "EXP"); | ||
434 | break; | 435 | break; |
435 | case TAG_GLOB_UNIT : | 436 | |
436 | strcpy(globtype,"UNIT"); | 437 | case TAG_GLOB_UNIT: |
438 | strcpy(globtype, "UNIT"); | ||
437 | break; | 439 | break; |
438 | case TAG_GLOB_REPORT_SZ : | 440 | |
439 | strcpy(globtype,"REPORT_SZ"); | 441 | case TAG_GLOB_REPORT_SZ: |
442 | strcpy(globtype, "REPORT_SZ"); | ||
440 | break; | 443 | break; |
441 | case TAG_GLOB_REPORT_ID : | 444 | |
442 | strcpy(globtype,"REPORT_ID"); | 445 | case TAG_GLOB_REPORT_ID: |
446 | strcpy(globtype, "REPORT_ID"); | ||
443 | /* New report, restart numbering */ | 447 | /* New report, restart numbering */ |
444 | inputnum=0; | 448 | inputnum = 0; |
445 | break; | 449 | break; |
450 | |||
446 | case TAG_GLOB_REPORT_CNT: | 451 | case TAG_GLOB_REPORT_CNT: |
447 | strcpy(globtype,"REPORT_CNT"); | 452 | strcpy(globtype, "REPORT_CNT"); |
448 | break; | 453 | break; |
449 | case TAG_GLOB_PUSH : | 454 | |
450 | strcpy(globtype,"PUSH"); | 455 | case TAG_GLOB_PUSH: |
456 | strcpy(globtype, "PUSH"); | ||
451 | break; | 457 | break; |
458 | |||
452 | case TAG_GLOB_POP: | 459 | case TAG_GLOB_POP: |
453 | strcpy(globtype,"POP"); | 460 | strcpy(globtype, "POP"); |
454 | break; | 461 | break; |
455 | } | 462 | } |
456 | 463 | ||
457 | |||
458 | /* Check to make sure we have a good tag number | 464 | /* Check to make sure we have a good tag number |
459 | so we don't overflow array */ | 465 | so we don't overflow array */ |
460 | if (tag < TAG_GLOB_MAX){ | 466 | if (tag < TAG_GLOB_MAX) { |
461 | switch (size){ | 467 | switch (size) { |
462 | case 1: | 468 | case 1: |
463 | dbg("%sGLOBALTAG:%s(%d) SIZE: %d Data: 0x%x",indentstr,globtype,tag,size,data); | 469 | dbg("%sGLOBALTAG:%s(%d) SIZE: %d Data: 0x%x", |
464 | globalval[tag]=data; | 470 | indentstr, globtype, tag, size, data); |
471 | globalval[tag] = data; | ||
465 | break; | 472 | break; |
473 | |||
466 | case 2: | 474 | case 2: |
467 | dbg("%sGLOBALTAG:%s(%d) SIZE: %d Data: 0x%x",indentstr,globtype,tag,size,data16); | 475 | dbg("%sGLOBALTAG:%s(%d) SIZE: %d Data: 0x%x", |
468 | globalval[tag]=data16; | 476 | indentstr, globtype, tag, size, data16); |
477 | globalval[tag] = data16; | ||
469 | break; | 478 | break; |
479 | |||
470 | case 4: | 480 | case 4: |
471 | dbg("%sGLOBALTAG:%s(%d) SIZE: %d Data: 0x%x",indentstr,globtype,tag,size,data32); | 481 | dbg("%sGLOBALTAG:%s(%d) SIZE: %d Data: 0x%x", |
472 | globalval[tag]=data32; | 482 | indentstr, globtype, tag, size, data32); |
483 | globalval[tag] = data32; | ||
473 | break; | 484 | break; |
474 | } | 485 | } |
475 | }else{ | 486 | } else { |
476 | dbg("%sGLOBALTAG: ILLEGAL TAG:%d SIZE: %d ", | 487 | dbg("%sGLOBALTAG: ILLEGAL TAG:%d SIZE: %d ", |
477 | indentstr,tag,size); | 488 | indentstr, tag, size); |
478 | } | 489 | } |
479 | |||
480 | |||
481 | break; | 490 | break; |
482 | 491 | ||
483 | case TYPE_LOCAL: | 492 | case TYPE_LOCAL: |
484 | switch(tag){ | 493 | switch (tag) { |
485 | case TAG_GLOB_USAGE: | 494 | case TAG_GLOB_USAGE: |
486 | strcpy(globtype,"USAGE"); | 495 | strcpy(globtype, "USAGE"); |
487 | /* Always 1 byte */ | 496 | /* Always 1 byte */ |
488 | usage = data; | 497 | usage = data; |
489 | break; | 498 | break; |
490 | case TAG_GLOB_LOG_MIN : | 499 | |
491 | strcpy(globtype,"MIN"); | 500 | case TAG_GLOB_LOG_MIN: |
501 | strcpy(globtype, "MIN"); | ||
492 | break; | 502 | break; |
493 | case TAG_GLOB_LOG_MAX : | 503 | |
494 | strcpy(globtype,"MAX"); | 504 | case TAG_GLOB_LOG_MAX: |
505 | strcpy(globtype, "MAX"); | ||
495 | break; | 506 | break; |
507 | |||
496 | default: | 508 | default: |
497 | strcpy(globtype,"UNKNOWN"); | 509 | strcpy(globtype, "UNKNOWN"); |
510 | break; | ||
498 | } | 511 | } |
499 | 512 | ||
500 | switch (size){ | 513 | switch (size) { |
501 | case 1: | 514 | case 1: |
502 | dbg("%sLOCALTAG:(%d) %s SIZE: %d Data: 0x%x", | 515 | dbg("%sLOCALTAG:(%d) %s SIZE: %d Data: 0x%x", |
503 | indentstr,tag,globtype,size,data); | 516 | indentstr, tag, globtype, size, data); |
504 | break; | 517 | break; |
518 | |||
505 | case 2: | 519 | case 2: |
506 | dbg("%sLOCALTAG:(%d) %s SIZE: %d Data: 0x%x", | 520 | dbg("%sLOCALTAG:(%d) %s SIZE: %d Data: 0x%x", |
507 | indentstr,tag,globtype,size,data16); | 521 | indentstr, tag, globtype, size, data16); |
508 | break; | 522 | break; |
523 | |||
509 | case 4: | 524 | case 4: |
510 | dbg("%sLOCALTAG:(%d) %s SIZE: %d Data: 0x%x", | 525 | dbg("%sLOCALTAG:(%d) %s SIZE: %d Data: 0x%x", |
511 | indentstr,tag,globtype,size,data32); | 526 | indentstr, tag, globtype, size, data32); |
512 | break; | 527 | break; |
513 | } | 528 | } |
514 | 529 | ||
515 | break; | 530 | break; |
516 | } | 531 | } |
517 | |||
518 | } | 532 | } |
519 | |||
520 | } | 533 | } |
521 | 534 | ||
522 | |||
523 | |||
524 | /* INPUT DRIVER Routines */ | 535 | /* INPUT DRIVER Routines */ |
525 | 536 | ||
526 | |||
527 | /* | 537 | /* |
528 | * Called when opening the input device. This will submit the URB to | 538 | * Called when opening the input device. This will submit the URB to |
529 | * the usb system so we start getting reports | 539 | * the usb system so we start getting reports |
530 | */ | 540 | */ |
531 | static int gtco_input_open(struct input_dev *inputdev) | 541 | static int gtco_input_open(struct input_dev *inputdev) |
532 | { | 542 | { |
533 | struct gtco *device; | 543 | struct gtco *device = input_get_drvdata(inputdev); |
534 | device = inputdev->private; | ||
535 | 544 | ||
536 | device->urbinfo->dev = device->usbdev; | 545 | device->urbinfo->dev = device->usbdev; |
537 | if (usb_submit_urb(device->urbinfo, GFP_KERNEL)) { | 546 | if (usb_submit_urb(device->urbinfo, GFP_KERNEL)) |
538 | return -EIO; | 547 | return -EIO; |
539 | } | 548 | |
540 | return 0; | 549 | return 0; |
541 | } | 550 | } |
542 | 551 | ||
543 | /** | 552 | /* |
544 | Called when closing the input device. This will unlink the URB | 553 | * Called when closing the input device. This will unlink the URB |
545 | */ | 554 | */ |
546 | static void gtco_input_close(struct input_dev *inputdev) | 555 | static void gtco_input_close(struct input_dev *inputdev) |
547 | { | 556 | { |
548 | struct gtco *device = inputdev->private; | 557 | struct gtco *device = input_get_drvdata(inputdev); |
549 | 558 | ||
550 | usb_kill_urb(device->urbinfo); | 559 | usb_kill_urb(device->urbinfo); |
551 | |||
552 | } | 560 | } |
553 | 561 | ||
554 | 562 | ||
@@ -560,19 +568,16 @@ static void gtco_input_close(struct input_dev *inputdev) | |||
560 | * placed in the struct gtco structure | 568 | * placed in the struct gtco structure |
561 | * | 569 | * |
562 | */ | 570 | */ |
563 | static void gtco_setup_caps(struct input_dev *inputdev) | 571 | static void gtco_setup_caps(struct input_dev *inputdev) |
564 | { | 572 | { |
565 | struct gtco *device = inputdev->private; | 573 | struct gtco *device = input_get_drvdata(inputdev); |
566 | |||
567 | 574 | ||
568 | /* Which events */ | 575 | /* Which events */ |
569 | inputdev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS) | BIT(EV_MSC); | 576 | inputdev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS) | BIT(EV_MSC); |
570 | 577 | ||
571 | |||
572 | /* Misc event menu block */ | 578 | /* Misc event menu block */ |
573 | inputdev->mscbit[0] = BIT(MSC_SCAN)|BIT(MSC_SERIAL)|BIT(MSC_RAW) ; | 579 | inputdev->mscbit[0] = BIT(MSC_SCAN)|BIT(MSC_SERIAL)|BIT(MSC_RAW) ; |
574 | 580 | ||
575 | |||
576 | /* Absolute values based on HID report info */ | 581 | /* Absolute values based on HID report info */ |
577 | input_set_abs_params(inputdev, ABS_X, device->min_X, device->max_X, | 582 | input_set_abs_params(inputdev, ABS_X, device->min_X, device->max_X, |
578 | 0, 0); | 583 | 0, 0); |
@@ -590,17 +595,12 @@ static void gtco_setup_caps(struct input_dev *inputdev) | |||
590 | input_set_abs_params(inputdev, ABS_PRESSURE, device->minpressure, | 595 | input_set_abs_params(inputdev, ABS_PRESSURE, device->minpressure, |
591 | device->maxpressure, 0, 0); | 596 | device->maxpressure, 0, 0); |
592 | 597 | ||
593 | |||
594 | /* Transducer */ | 598 | /* Transducer */ |
595 | input_set_abs_params(inputdev, ABS_MISC, 0,0xFF, 0, 0); | 599 | input_set_abs_params(inputdev, ABS_MISC, 0, 0xFF, 0, 0); |
596 | |||
597 | } | 600 | } |
598 | 601 | ||
599 | |||
600 | |||
601 | /* USB Routines */ | 602 | /* USB Routines */ |
602 | 603 | ||
603 | |||
604 | /* | 604 | /* |
605 | * URB callback routine. Called when we get IRQ reports from the | 605 | * URB callback routine. Called when we get IRQ reports from the |
606 | * digitizer. | 606 | * digitizer. |
@@ -610,9 +610,7 @@ static void gtco_setup_caps(struct input_dev *inputdev) | |||
610 | */ | 610 | */ |
611 | static void gtco_urb_callback(struct urb *urbinfo) | 611 | static void gtco_urb_callback(struct urb *urbinfo) |
612 | { | 612 | { |
613 | 613 | struct gtco *device = urbinfo->context; | |
614 | |||
615 | struct gtco *device = urbinfo->context; | ||
616 | struct input_dev *inputdev; | 614 | struct input_dev *inputdev; |
617 | int rc; | 615 | int rc; |
618 | u32 val = 0; | 616 | u32 val = 0; |
@@ -621,19 +619,20 @@ static void gtco_urb_callback(struct urb *urbinfo) | |||
621 | 619 | ||
622 | inputdev = device->inputdevice; | 620 | inputdev = device->inputdevice; |
623 | 621 | ||
624 | |||
625 | /* Was callback OK? */ | 622 | /* Was callback OK? */ |
626 | if ((urbinfo->status == -ECONNRESET ) || | 623 | if (urbinfo->status == -ECONNRESET || |
627 | (urbinfo->status == -ENOENT ) || | 624 | urbinfo->status == -ENOENT || |
628 | (urbinfo->status == -ESHUTDOWN )){ | 625 | urbinfo->status == -ESHUTDOWN) { |
629 | 626 | ||
630 | /* Shutdown is occurring. Return and don't queue up any more */ | 627 | /* Shutdown is occurring. Return and don't queue up any more */ |
631 | return; | 628 | return; |
632 | } | 629 | } |
633 | 630 | ||
634 | if (urbinfo->status != 0 ) { | 631 | if (urbinfo->status != 0) { |
635 | /* Some unknown error. Hopefully temporary. Just go and */ | 632 | /* |
636 | /* requeue an URB */ | 633 | * Some unknown error. Hopefully temporary. Just go and |
634 | * requeue an URB | ||
635 | */ | ||
637 | goto resubmit; | 636 | goto resubmit; |
638 | } | 637 | } |
639 | 638 | ||
@@ -642,10 +641,9 @@ static void gtco_urb_callback(struct urb *urbinfo) | |||
642 | */ | 641 | */ |
643 | 642 | ||
644 | /* PID dependent when we interpret the report */ | 643 | /* PID dependent when we interpret the report */ |
645 | if ((inputdev->id.product == PID_1000 )|| | 644 | if (inputdev->id.product == PID_1000 || |
646 | (inputdev->id.product == PID_1001 )|| | 645 | inputdev->id.product == PID_1001 || |
647 | (inputdev->id.product == PID_1002 )) | 646 | inputdev->id.product == PID_1002) { |
648 | { | ||
649 | 647 | ||
650 | /* | 648 | /* |
651 | * Switch on the report ID | 649 | * Switch on the report ID |
@@ -653,10 +651,10 @@ static void gtco_urb_callback(struct urb *urbinfo) | |||
653 | * the report number. We can just fall through the case | 651 | * the report number. We can just fall through the case |
654 | * statements if we start with the highest number report | 652 | * statements if we start with the highest number report |
655 | */ | 653 | */ |
656 | switch(device->buffer[0]){ | 654 | switch (device->buffer[0]) { |
657 | case 5: | 655 | case 5: |
658 | /* Pressure is 9 bits */ | 656 | /* Pressure is 9 bits */ |
659 | val = ((u16)(device->buffer[8]) << 1); | 657 | val = ((u16)(device->buffer[8]) << 1); |
660 | val |= (u16)(device->buffer[7] >> 7); | 658 | val |= (u16)(device->buffer[7] >> 7); |
661 | input_report_abs(inputdev, ABS_PRESSURE, | 659 | input_report_abs(inputdev, ABS_PRESSURE, |
662 | device->buffer[8]); | 660 | device->buffer[8]); |
@@ -664,7 +662,6 @@ static void gtco_urb_callback(struct urb *urbinfo) | |||
664 | /* Mask out the Y tilt value used for pressure */ | 662 | /* Mask out the Y tilt value used for pressure */ |
665 | device->buffer[7] = (u8)((device->buffer[7]) & 0x7F); | 663 | device->buffer[7] = (u8)((device->buffer[7]) & 0x7F); |
666 | 664 | ||
667 | |||
668 | /* Fall thru */ | 665 | /* Fall thru */ |
669 | case 4: | 666 | case 4: |
670 | /* Tilt */ | 667 | /* Tilt */ |
@@ -684,11 +681,10 @@ static void gtco_urb_callback(struct urb *urbinfo) | |||
684 | input_report_abs(inputdev, ABS_TILT_Y, (s32)valsigned); | 681 | input_report_abs(inputdev, ABS_TILT_Y, (s32)valsigned); |
685 | 682 | ||
686 | /* Fall thru */ | 683 | /* Fall thru */ |
687 | |||
688 | case 2: | 684 | case 2: |
689 | case 3: | 685 | case 3: |
690 | /* Convert buttons, only 5 bits possible */ | 686 | /* Convert buttons, only 5 bits possible */ |
691 | val = (device->buffer[5])&MASK_BUTTON; | 687 | val = (device->buffer[5]) & MASK_BUTTON; |
692 | 688 | ||
693 | /* We don't apply any meaning to the bitmask, | 689 | /* We don't apply any meaning to the bitmask, |
694 | just report */ | 690 | just report */ |
@@ -696,132 +692,109 @@ static void gtco_urb_callback(struct urb *urbinfo) | |||
696 | 692 | ||
697 | /* Fall thru */ | 693 | /* Fall thru */ |
698 | case 1: | 694 | case 1: |
699 | |||
700 | /* All reports have X and Y coords in the same place */ | 695 | /* All reports have X and Y coords in the same place */ |
701 | val = le16_to_cpu(get_unaligned((__le16 *) &(device->buffer[1]))); | 696 | val = le16_to_cpu(get_unaligned((__le16 *)&device->buffer[1])); |
702 | input_report_abs(inputdev, ABS_X, val); | 697 | input_report_abs(inputdev, ABS_X, val); |
703 | 698 | ||
704 | val = le16_to_cpu(get_unaligned((__le16 *) &(device->buffer[3]))); | 699 | val = le16_to_cpu(get_unaligned((__le16 *)&device->buffer[3])); |
705 | input_report_abs(inputdev, ABS_Y, val); | 700 | input_report_abs(inputdev, ABS_Y, val); |
706 | 701 | ||
707 | |||
708 | /* Ditto for proximity bit */ | 702 | /* Ditto for proximity bit */ |
709 | if (device->buffer[5]& MASK_INRANGE){ | 703 | val = device->buffer[5] & MASK_INRANGE ? 1 : 0; |
710 | val = 1; | ||
711 | }else{ | ||
712 | val=0; | ||
713 | } | ||
714 | input_report_abs(inputdev, ABS_DISTANCE, val); | 704 | input_report_abs(inputdev, ABS_DISTANCE, val); |
715 | 705 | ||
716 | |||
717 | /* Report 1 is an exception to how we handle buttons */ | 706 | /* Report 1 is an exception to how we handle buttons */ |
718 | /* Buttons are an index, not a bitmask */ | 707 | /* Buttons are an index, not a bitmask */ |
719 | if (device->buffer[0] == 1){ | 708 | if (device->buffer[0] == 1) { |
720 | 709 | ||
721 | /* Convert buttons, 5 bit index */ | 710 | /* |
722 | /* Report value of index set as one, | 711 | * Convert buttons, 5 bit index |
723 | the rest as 0 */ | 712 | * Report value of index set as one, |
724 | val = device->buffer[5]& MASK_BUTTON; | 713 | * the rest as 0 |
714 | */ | ||
715 | val = device->buffer[5] & MASK_BUTTON; | ||
725 | dbg("======>>>>>>REPORT 1: val 0x%X(%d)", | 716 | dbg("======>>>>>>REPORT 1: val 0x%X(%d)", |
726 | val,val); | 717 | val, val); |
727 | 718 | ||
728 | /* | 719 | /* |
729 | * We don't apply any meaning to the button | 720 | * We don't apply any meaning to the button |
730 | * index, just report it | 721 | * index, just report it |
731 | */ | 722 | */ |
732 | input_event(inputdev, EV_MSC, MSC_SERIAL, val); | 723 | input_event(inputdev, EV_MSC, MSC_SERIAL, val); |
733 | |||
734 | |||
735 | } | 724 | } |
736 | |||
737 | break; | 725 | break; |
726 | |||
738 | case 7: | 727 | case 7: |
739 | /* Menu blocks */ | 728 | /* Menu blocks */ |
740 | input_event(inputdev, EV_MSC, MSC_SCAN, | 729 | input_event(inputdev, EV_MSC, MSC_SCAN, |
741 | device->buffer[1]); | 730 | device->buffer[1]); |
742 | |||
743 | |||
744 | break; | 731 | break; |
745 | |||
746 | } | 732 | } |
747 | |||
748 | |||
749 | } | 733 | } |
734 | |||
750 | /* Other pid class */ | 735 | /* Other pid class */ |
751 | if ((inputdev->id.product == PID_400 )|| | 736 | if (inputdev->id.product == PID_400 || |
752 | (inputdev->id.product == PID_401 )) | 737 | inputdev->id.product == PID_401) { |
753 | { | ||
754 | 738 | ||
755 | /* Report 2 */ | 739 | /* Report 2 */ |
756 | if (device->buffer[0] == 2){ | 740 | if (device->buffer[0] == 2) { |
757 | /* Menu blocks */ | 741 | /* Menu blocks */ |
758 | input_event(inputdev, EV_MSC, MSC_SCAN, | 742 | input_event(inputdev, EV_MSC, MSC_SCAN, device->buffer[1]); |
759 | device->buffer[1]); | ||
760 | } | 743 | } |
761 | 744 | ||
762 | /* Report 1 */ | 745 | /* Report 1 */ |
763 | if (device->buffer[0] == 1){ | 746 | if (device->buffer[0] == 1) { |
764 | char buttonbyte; | 747 | char buttonbyte; |
765 | 748 | ||
766 | |||
767 | /* IF X max > 64K, we still a bit from the y report */ | 749 | /* IF X max > 64K, we still a bit from the y report */ |
768 | if (device->max_X > 0x10000){ | 750 | if (device->max_X > 0x10000) { |
769 | 751 | ||
770 | val = (u16)(((u16)(device->buffer[2]<<8))|((u8)(device->buffer[1]))); | 752 | val = (u16)(((u16)(device->buffer[2] << 8)) | (u8)device->buffer[1]); |
771 | val |= (u32)(((u8)device->buffer[3]&0x1)<< 16); | 753 | val |= (u32)(((u8)device->buffer[3] & 0x1) << 16); |
772 | 754 | ||
773 | input_report_abs(inputdev, ABS_X, val); | 755 | input_report_abs(inputdev, ABS_X, val); |
774 | 756 | ||
775 | le_buffer[0] = (u8)((u8)(device->buffer[3])>>1); | 757 | le_buffer[0] = (u8)((u8)(device->buffer[3]) >> 1); |
776 | le_buffer[0] |= (u8)((device->buffer[3]&0x1)<<7); | 758 | le_buffer[0] |= (u8)((device->buffer[3] & 0x1) << 7); |
777 | |||
778 | le_buffer[1] = (u8)(device->buffer[4]>>1); | ||
779 | le_buffer[1] |= (u8)((device->buffer[5]&0x1)<<7); | ||
780 | 759 | ||
781 | val = le16_to_cpu(get_unaligned((__le16 *)(le_buffer))); | 760 | le_buffer[1] = (u8)(device->buffer[4] >> 1); |
761 | le_buffer[1] |= (u8)((device->buffer[5] & 0x1) << 7); | ||
782 | 762 | ||
763 | val = le16_to_cpu(get_unaligned((__le16 *)le_buffer)); | ||
783 | input_report_abs(inputdev, ABS_Y, val); | 764 | input_report_abs(inputdev, ABS_Y, val); |
784 | 765 | ||
785 | |||
786 | /* | 766 | /* |
787 | * Shift the button byte right by one to | 767 | * Shift the button byte right by one to |
788 | * make it look like the standard report | 768 | * make it look like the standard report |
789 | */ | 769 | */ |
790 | buttonbyte = (device->buffer[5])>>1; | 770 | buttonbyte = device->buffer[5] >> 1; |
791 | }else{ | 771 | } else { |
792 | 772 | ||
793 | val = le16_to_cpu(get_unaligned((__le16 *) (&(device->buffer[1])))); | 773 | val = le16_to_cpu(get_unaligned((__le16 *)&device->buffer[1])); |
794 | input_report_abs(inputdev, ABS_X, val); | 774 | input_report_abs(inputdev, ABS_X, val); |
795 | 775 | ||
796 | val = le16_to_cpu(get_unaligned((__le16 *) (&(device->buffer[3])))); | 776 | val = le16_to_cpu(get_unaligned((__le16 *)&device->buffer[3])); |
797 | input_report_abs(inputdev, ABS_Y, val); | 777 | input_report_abs(inputdev, ABS_Y, val); |
798 | 778 | ||
799 | buttonbyte = device->buffer[5]; | 779 | buttonbyte = device->buffer[5]; |
800 | |||
801 | } | 780 | } |
802 | 781 | ||
803 | |||
804 | /* BUTTONS and PROXIMITY */ | 782 | /* BUTTONS and PROXIMITY */ |
805 | if (buttonbyte& MASK_INRANGE){ | 783 | val = buttonbyte & MASK_INRANGE ? 1 : 0; |
806 | val = 1; | ||
807 | }else{ | ||
808 | val=0; | ||
809 | } | ||
810 | input_report_abs(inputdev, ABS_DISTANCE, val); | 784 | input_report_abs(inputdev, ABS_DISTANCE, val); |
811 | 785 | ||
812 | /* Convert buttons, only 4 bits possible */ | 786 | /* Convert buttons, only 4 bits possible */ |
813 | val = buttonbyte&0x0F; | 787 | val = buttonbyte & 0x0F; |
814 | #ifdef USE_BUTTONS | 788 | #ifdef USE_BUTTONS |
815 | for ( i=0;i<5;i++){ | 789 | for (i = 0; i < 5; i++) |
816 | input_report_key(inputdev, BTN_DIGI+i,val&(1<<i)); | 790 | input_report_key(inputdev, BTN_DIGI + i, val & (1 << i)); |
817 | } | ||
818 | #else | 791 | #else |
819 | /* We don't apply any meaning to the bitmask, just report */ | 792 | /* We don't apply any meaning to the bitmask, just report */ |
820 | input_event(inputdev, EV_MSC, MSC_SERIAL, val); | 793 | input_event(inputdev, EV_MSC, MSC_SERIAL, val); |
821 | #endif | 794 | #endif |
795 | |||
822 | /* TRANSDUCER */ | 796 | /* TRANSDUCER */ |
823 | input_report_abs(inputdev, ABS_MISC, device->buffer[6]); | 797 | input_report_abs(inputdev, ABS_MISC, device->buffer[6]); |
824 | |||
825 | } | 798 | } |
826 | } | 799 | } |
827 | 800 | ||
@@ -833,10 +806,8 @@ static void gtco_urb_callback(struct urb *urbinfo) | |||
833 | 806 | ||
834 | resubmit: | 807 | resubmit: |
835 | rc = usb_submit_urb(urbinfo, GFP_ATOMIC); | 808 | rc = usb_submit_urb(urbinfo, GFP_ATOMIC); |
836 | if (rc != 0) { | 809 | if (rc != 0) |
837 | err("usb_submit_urb failed rc=0x%x",rc); | 810 | err("usb_submit_urb failed rc=0x%x", rc); |
838 | } | ||
839 | |||
840 | } | 811 | } |
841 | 812 | ||
842 | /* | 813 | /* |
@@ -854,58 +825,46 @@ static int gtco_probe(struct usb_interface *usbinterface, | |||
854 | const struct usb_device_id *id) | 825 | const struct usb_device_id *id) |
855 | { | 826 | { |
856 | 827 | ||
857 | struct gtco *device = NULL; | 828 | struct gtco *gtco; |
858 | char path[PATHLENGTH]; | 829 | struct input_dev *input_dev; |
859 | struct input_dev *inputdev; | ||
860 | struct hid_descriptor *hid_desc; | 830 | struct hid_descriptor *hid_desc; |
861 | char *report; | 831 | char *report = NULL; |
862 | int result=0, retry; | 832 | int result = 0, retry; |
833 | int error; | ||
863 | struct usb_endpoint_descriptor *endpoint; | 834 | struct usb_endpoint_descriptor *endpoint; |
864 | 835 | ||
865 | /* Allocate memory for device structure */ | 836 | /* Allocate memory for device structure */ |
866 | device = kzalloc(sizeof(struct gtco), GFP_KERNEL); | 837 | gtco = kzalloc(sizeof(struct gtco), GFP_KERNEL); |
867 | if (device == NULL) { | 838 | input_dev = input_allocate_device(); |
839 | if (!gtco || !input_dev) { | ||
868 | err("No more memory"); | 840 | err("No more memory"); |
869 | return -ENOMEM; | 841 | error = -ENOMEM; |
842 | goto err_free_devs; | ||
870 | } | 843 | } |
871 | 844 | ||
872 | 845 | /* Set pointer to the input device */ | |
873 | device->inputdevice = input_allocate_device(); | 846 | gtco->inputdevice = input_dev; |
874 | if (!device->inputdevice){ | ||
875 | kfree(device); | ||
876 | err("No more memory"); | ||
877 | return -ENOMEM; | ||
878 | } | ||
879 | |||
880 | /* Get pointer to the input device */ | ||
881 | inputdev = device->inputdevice; | ||
882 | 847 | ||
883 | /* Save interface information */ | 848 | /* Save interface information */ |
884 | device->usbdev = usb_get_dev(interface_to_usbdev(usbinterface)); | 849 | gtco->usbdev = usb_get_dev(interface_to_usbdev(usbinterface)); |
885 | |||
886 | 850 | ||
887 | /* Allocate some data for incoming reports */ | 851 | /* Allocate some data for incoming reports */ |
888 | device->buffer = usb_buffer_alloc(device->usbdev, REPORT_MAX_SIZE, | 852 | gtco->buffer = usb_buffer_alloc(gtco->usbdev, REPORT_MAX_SIZE, |
889 | GFP_KERNEL, &(device->buf_dma)); | 853 | GFP_KERNEL, >co->buf_dma); |
890 | if (!device->buffer){ | 854 | if (!gtco->buffer) { |
891 | input_free_device(device->inputdevice); | 855 | err("No more memory for us buffers"); |
892 | kfree(device); | 856 | error = -ENOMEM; |
893 | err("No more memory"); | 857 | goto err_free_devs; |
894 | return -ENOMEM; | ||
895 | } | 858 | } |
896 | 859 | ||
897 | /* Allocate URB for reports */ | 860 | /* Allocate URB for reports */ |
898 | device->urbinfo = usb_alloc_urb(0, GFP_KERNEL); | 861 | gtco->urbinfo = usb_alloc_urb(0, GFP_KERNEL); |
899 | if (!device->urbinfo) { | 862 | if (!gtco->urbinfo) { |
900 | usb_buffer_free(device->usbdev, REPORT_MAX_SIZE, | 863 | err("Failed to allocate URB"); |
901 | device->buffer, device->buf_dma); | ||
902 | input_free_device(device->inputdevice); | ||
903 | kfree(device); | ||
904 | err("No more memory"); | ||
905 | return -ENOMEM; | 864 | return -ENOMEM; |
865 | goto err_free_buf; | ||
906 | } | 866 | } |
907 | 867 | ||
908 | |||
909 | /* | 868 | /* |
910 | * The endpoint is always altsetting 0, we know this since we know | 869 | * The endpoint is always altsetting 0, we know this since we know |
911 | * this device only has one interrupt endpoint | 870 | * this device only has one interrupt endpoint |
@@ -913,51 +872,43 @@ static int gtco_probe(struct usb_interface *usbinterface, | |||
913 | endpoint = &usbinterface->altsetting[0].endpoint[0].desc; | 872 | endpoint = &usbinterface->altsetting[0].endpoint[0].desc; |
914 | 873 | ||
915 | /* Some debug */ | 874 | /* Some debug */ |
916 | dbg("gtco # interfaces: %d",usbinterface->num_altsetting); | 875 | dbg("gtco # interfaces: %d", usbinterface->num_altsetting); |
917 | dbg("num endpoints: %d",usbinterface->cur_altsetting->desc.bNumEndpoints); | 876 | dbg("num endpoints: %d", usbinterface->cur_altsetting->desc.bNumEndpoints); |
918 | dbg("interface class: %d",usbinterface->cur_altsetting->desc.bInterfaceClass); | 877 | dbg("interface class: %d", usbinterface->cur_altsetting->desc.bInterfaceClass); |
919 | dbg("endpoint: attribute:0x%x type:0x%x",endpoint->bmAttributes,endpoint->bDescriptorType); | 878 | dbg("endpoint: attribute:0x%x type:0x%x", endpoint->bmAttributes, endpoint->bDescriptorType); |
920 | if ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT) | 879 | if ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT) |
921 | dbg("endpoint: we have interrupt endpoint\n"); | 880 | dbg("endpoint: we have interrupt endpoint\n"); |
922 | 881 | ||
923 | dbg("endpoint extra len:%d ",usbinterface->altsetting[0].extralen); | 882 | dbg("endpoint extra len:%d ", usbinterface->altsetting[0].extralen); |
924 | |||
925 | |||
926 | 883 | ||
927 | /* | 884 | /* |
928 | * Find the HID descriptor so we can find out the size of the | 885 | * Find the HID descriptor so we can find out the size of the |
929 | * HID report descriptor | 886 | * HID report descriptor |
930 | */ | 887 | */ |
931 | if (usb_get_extra_descriptor(usbinterface->cur_altsetting, | 888 | if (usb_get_extra_descriptor(usbinterface->cur_altsetting, |
932 | HID_DEVICE_TYPE,&hid_desc) != 0){ | 889 | HID_DEVICE_TYPE, &hid_desc) != 0){ |
933 | err("Can't retrieve exta USB descriptor to get hid report descriptor length"); | 890 | err("Can't retrieve exta USB descriptor to get hid report descriptor length"); |
934 | usb_buffer_free(device->usbdev, REPORT_MAX_SIZE, | 891 | error = -EIO; |
935 | device->buffer, device->buf_dma); | 892 | goto err_free_urb; |
936 | input_free_device(device->inputdevice); | ||
937 | kfree(device); | ||
938 | return -EIO; | ||
939 | } | 893 | } |
940 | 894 | ||
941 | dbg("Extra descriptor success: type:%d len:%d", | 895 | dbg("Extra descriptor success: type:%d len:%d", |
942 | hid_desc->bDescriptorType, hid_desc->wDescriptorLength); | 896 | hid_desc->bDescriptorType, hid_desc->wDescriptorLength); |
943 | 897 | ||
944 | if (!(report = kzalloc(hid_desc->wDescriptorLength, GFP_KERNEL))) { | 898 | report = kzalloc(hid_desc->wDescriptorLength, GFP_KERNEL); |
945 | usb_buffer_free(device->usbdev, REPORT_MAX_SIZE, | 899 | if (!report) { |
946 | device->buffer, device->buf_dma); | 900 | err("No more memory for report"); |
947 | 901 | error = -ENOMEM; | |
948 | input_free_device(device->inputdevice); | 902 | goto err_free_urb; |
949 | kfree(device); | ||
950 | err("No more memory"); | ||
951 | return -ENOMEM; | ||
952 | } | 903 | } |
953 | 904 | ||
954 | /* Couple of tries to get reply */ | 905 | /* Couple of tries to get reply */ |
955 | for (retry=0;retry<3;retry++) { | 906 | for (retry = 0; retry < 3; retry++) { |
956 | result = usb_control_msg(device->usbdev, | 907 | result = usb_control_msg(gtco->usbdev, |
957 | usb_rcvctrlpipe(device->usbdev, 0), | 908 | usb_rcvctrlpipe(gtco->usbdev, 0), |
958 | USB_REQ_GET_DESCRIPTOR, | 909 | USB_REQ_GET_DESCRIPTOR, |
959 | USB_RECIP_INTERFACE | USB_DIR_IN, | 910 | USB_RECIP_INTERFACE | USB_DIR_IN, |
960 | (REPORT_DEVICE_TYPE << 8), | 911 | REPORT_DEVICE_TYPE << 8, |
961 | 0, /* interface */ | 912 | 0, /* interface */ |
962 | report, | 913 | report, |
963 | hid_desc->wDescriptorLength, | 914 | hid_desc->wDescriptorLength, |
@@ -969,72 +920,76 @@ static int gtco_probe(struct usb_interface *usbinterface, | |||
969 | 920 | ||
970 | /* If we didn't get the report, fail */ | 921 | /* If we didn't get the report, fail */ |
971 | dbg("usb_control_msg result: :%d", result); | 922 | dbg("usb_control_msg result: :%d", result); |
972 | if (result != hid_desc->wDescriptorLength){ | 923 | if (result != hid_desc->wDescriptorLength) { |
973 | kfree(report); | ||
974 | usb_buffer_free(device->usbdev, REPORT_MAX_SIZE, | ||
975 | device->buffer, device->buf_dma); | ||
976 | input_free_device(device->inputdevice); | ||
977 | kfree(device); | ||
978 | err("Failed to get HID Report Descriptor of size: %d", | 924 | err("Failed to get HID Report Descriptor of size: %d", |
979 | hid_desc->wDescriptorLength); | 925 | hid_desc->wDescriptorLength); |
980 | return -EIO; | 926 | error = -EIO; |
927 | goto err_free_urb; | ||
981 | } | 928 | } |
982 | 929 | ||
983 | |||
984 | /* Now we parse the report */ | 930 | /* Now we parse the report */ |
985 | parse_hid_report_descriptor(device,report,result); | 931 | parse_hid_report_descriptor(gtco, report, result); |
986 | 932 | ||
987 | /* Now we delete it */ | 933 | /* Now we delete it */ |
988 | kfree(report); | 934 | kfree(report); |
989 | 935 | ||
990 | /* Create a device file node */ | 936 | /* Create a device file node */ |
991 | usb_make_path(device->usbdev, path, PATHLENGTH); | 937 | usb_make_path(gtco->usbdev, gtco->usbpath, sizeof(gtco->usbpath)); |
992 | sprintf(device->usbpath, "%s/input0", path); | 938 | strlcat(gtco->usbpath, "/input0", sizeof(gtco->usbpath)); |
993 | |||
994 | 939 | ||
995 | /* Set Input device functions */ | 940 | /* Set Input device functions */ |
996 | inputdev->open = gtco_input_open; | 941 | input_dev->open = gtco_input_open; |
997 | inputdev->close = gtco_input_close; | 942 | input_dev->close = gtco_input_close; |
998 | 943 | ||
999 | /* Set input device information */ | 944 | /* Set input device information */ |
1000 | inputdev->name = "GTCO_CalComp"; | 945 | input_dev->name = "GTCO_CalComp"; |
1001 | inputdev->phys = device->usbpath; | 946 | input_dev->phys = gtco->usbpath; |
1002 | inputdev->private = device; | ||
1003 | 947 | ||
948 | input_set_drvdata(input_dev, gtco); | ||
1004 | 949 | ||
1005 | /* Now set up all the input device capabilities */ | 950 | /* Now set up all the input device capabilities */ |
1006 | gtco_setup_caps(inputdev); | 951 | gtco_setup_caps(input_dev); |
1007 | 952 | ||
1008 | /* Set input device required ID information */ | 953 | /* Set input device required ID information */ |
1009 | usb_to_input_id(device->usbdev, &device->inputdevice->id); | 954 | usb_to_input_id(gtco->usbdev, &input_dev->id); |
1010 | inputdev->cdev.dev = &usbinterface->dev; | 955 | input_dev->dev.parent = &usbinterface->dev; |
1011 | 956 | ||
1012 | /* Setup the URB, it will be posted later on open of input device */ | 957 | /* Setup the URB, it will be posted later on open of input device */ |
1013 | endpoint = &usbinterface->altsetting[0].endpoint[0].desc; | 958 | endpoint = &usbinterface->altsetting[0].endpoint[0].desc; |
1014 | 959 | ||
1015 | usb_fill_int_urb(device->urbinfo, | 960 | usb_fill_int_urb(gtco->urbinfo, |
1016 | device->usbdev, | 961 | gtco->usbdev, |
1017 | usb_rcvintpipe(device->usbdev, | 962 | usb_rcvintpipe(gtco->usbdev, |
1018 | endpoint->bEndpointAddress), | 963 | endpoint->bEndpointAddress), |
1019 | device->buffer, | 964 | gtco->buffer, |
1020 | REPORT_MAX_SIZE, | 965 | REPORT_MAX_SIZE, |
1021 | gtco_urb_callback, | 966 | gtco_urb_callback, |
1022 | device, | 967 | gtco, |
1023 | endpoint->bInterval); | 968 | endpoint->bInterval); |
1024 | 969 | ||
1025 | device->urbinfo->transfer_dma = device->buf_dma; | 970 | gtco->urbinfo->transfer_dma = gtco->buf_dma; |
1026 | device->urbinfo->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 971 | gtco->urbinfo->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; |
1027 | |||
1028 | 972 | ||
1029 | /* Save device pointer in USB interface device */ | 973 | /* Save gtco pointer in USB interface gtco */ |
1030 | usb_set_intfdata(usbinterface, device); | 974 | usb_set_intfdata(usbinterface, gtco); |
1031 | 975 | ||
1032 | /* All done, now register the input device */ | 976 | /* All done, now register the input device */ |
1033 | input_register_device(inputdev); | 977 | error = input_register_device(input_dev); |
978 | if (error) | ||
979 | goto err_free_urb; | ||
1034 | 980 | ||
1035 | info( "gtco driver created usb: %s\n", path); | ||
1036 | return 0; | 981 | return 0; |
1037 | 982 | ||
983 | err_free_urb: | ||
984 | usb_free_urb(gtco->urbinfo); | ||
985 | err_free_buf: | ||
986 | usb_buffer_free(gtco->usbdev, REPORT_MAX_SIZE, | ||
987 | gtco->buffer, gtco->buf_dma); | ||
988 | err_free_devs: | ||
989 | kfree(report); | ||
990 | input_free_device(input_dev); | ||
991 | kfree(gtco); | ||
992 | return error; | ||
1038 | } | 993 | } |
1039 | 994 | ||
1040 | /* | 995 | /* |
@@ -1044,47 +999,46 @@ static int gtco_probe(struct usb_interface *usbinterface, | |||
1044 | */ | 999 | */ |
1045 | static void gtco_disconnect(struct usb_interface *interface) | 1000 | static void gtco_disconnect(struct usb_interface *interface) |
1046 | { | 1001 | { |
1047 | |||
1048 | /* Grab private device ptr */ | 1002 | /* Grab private device ptr */ |
1049 | struct gtco *device = usb_get_intfdata (interface); | 1003 | struct gtco *gtco = usb_get_intfdata(interface); |
1050 | 1004 | ||
1051 | /* Now reverse all the registration stuff */ | 1005 | /* Now reverse all the registration stuff */ |
1052 | if (device) { | 1006 | if (gtco) { |
1053 | input_unregister_device(device->inputdevice); | 1007 | input_unregister_device(gtco->inputdevice); |
1054 | usb_kill_urb(device->urbinfo); | 1008 | usb_kill_urb(gtco->urbinfo); |
1055 | usb_free_urb(device->urbinfo); | 1009 | usb_free_urb(gtco->urbinfo); |
1056 | usb_buffer_free(device->usbdev, REPORT_MAX_SIZE, | 1010 | usb_buffer_free(gtco->usbdev, REPORT_MAX_SIZE, |
1057 | device->buffer, device->buf_dma); | 1011 | gtco->buffer, gtco->buf_dma); |
1058 | kfree(device); | 1012 | kfree(gtco); |
1059 | } | 1013 | } |
1060 | 1014 | ||
1061 | info("gtco driver disconnected"); | 1015 | info("gtco driver disconnected"); |
1062 | } | 1016 | } |
1063 | 1017 | ||
1064 | |||
1065 | /* STANDARD MODULE LOAD ROUTINES */ | 1018 | /* STANDARD MODULE LOAD ROUTINES */ |
1066 | 1019 | ||
1067 | static struct usb_driver gtco_driverinfo_table = { | 1020 | static struct usb_driver gtco_driverinfo_table = { |
1068 | #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,16)) | 1021 | .name = "gtco", |
1069 | .owner = THIS_MODULE, | 1022 | .id_table = gtco_usbid_table, |
1070 | #endif | 1023 | .probe = gtco_probe, |
1071 | .name = "gtco", | 1024 | .disconnect = gtco_disconnect, |
1072 | .id_table = gtco_usbid_table, | ||
1073 | .probe = gtco_probe, | ||
1074 | .disconnect = gtco_disconnect, | ||
1075 | }; | 1025 | }; |
1026 | |||
1076 | /* | 1027 | /* |
1077 | * Register this module with the USB subsystem | 1028 | * Register this module with the USB subsystem |
1078 | */ | 1029 | */ |
1079 | static int __init gtco_init(void) | 1030 | static int __init gtco_init(void) |
1080 | { | 1031 | { |
1081 | int rc; | 1032 | int error; |
1082 | rc = usb_register(>co_driverinfo_table); | 1033 | |
1083 | if (rc) { | 1034 | error = usb_register(>co_driverinfo_table); |
1084 | err("usb_register() failed rc=0x%x", rc); | 1035 | if (error) { |
1036 | err("usb_register() failed rc=0x%x", error); | ||
1037 | return error; | ||
1085 | } | 1038 | } |
1086 | printk("GTCO usb driver version: %s",GTCO_VERSION); | 1039 | |
1087 | return rc; | 1040 | printk("GTCO usb driver version: %s", GTCO_VERSION); |
1041 | return 0; | ||
1088 | } | 1042 | } |
1089 | 1043 | ||
1090 | /* | 1044 | /* |
@@ -1095,7 +1049,7 @@ static void __exit gtco_exit(void) | |||
1095 | usb_deregister(>co_driverinfo_table); | 1049 | usb_deregister(>co_driverinfo_table); |
1096 | } | 1050 | } |
1097 | 1051 | ||
1098 | module_init (gtco_init); | 1052 | module_init(gtco_init); |
1099 | module_exit (gtco_exit); | 1053 | module_exit(gtco_exit); |
1100 | 1054 | ||
1101 | MODULE_LICENSE("GPL"); | 1055 | MODULE_LICENSE("GPL"); |
diff --git a/drivers/usb/input/itmtouch.c b/drivers/usb/input/itmtouch.c deleted file mode 100644 index aac968aab860..000000000000 --- a/drivers/usb/input/itmtouch.c +++ /dev/null | |||
@@ -1,271 +0,0 @@ | |||
1 | /****************************************************************************** | ||
2 | * itmtouch.c -- Driver for ITM touchscreen panel | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or | ||
5 | * modify it under the terms of the GNU General Public License as | ||
6 | * published by the Free Software Foundation; either version 2 of the | ||
7 | * License, or (at your option) any later version. | ||
8 | * | ||
9 | * This program is distributed in the hope that it will be useful, but | ||
10 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
12 | * General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program; if not, write to the Free Software | ||
16 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
17 | * | ||
18 | * Based upon original work by Chris Collins <xfire-itmtouch@xware.cx>. | ||
19 | * | ||
20 | * Kudos to ITM for providing me with the datasheet for the panel, | ||
21 | * even though it was a day later than I had finished writing this | ||
22 | * driver. | ||
23 | * | ||
24 | * It has meant that I've been able to correct my interpretation of the | ||
25 | * protocol packets however. | ||
26 | * | ||
27 | * CC -- 2003/9/29 | ||
28 | * | ||
29 | * History | ||
30 | * 1.0 & 1.1 2003 (CC) vojtech@suse.cz | ||
31 | * Original version for 2.4.x kernels | ||
32 | * | ||
33 | * 1.2 02/03/2005 (HCE) hc@mivu.no | ||
34 | * Complete rewrite to support Linux 2.6.10, thanks to mtouchusb.c for hints. | ||
35 | * Unfortunately no calibration support at this time. | ||
36 | * | ||
37 | * 1.2.1 09/03/2005 (HCE) hc@mivu.no | ||
38 | * Code cleanup and adjusting syntax to start matching kernel standards | ||
39 | * | ||
40 | * 1.2.2 10/05/2006 (MJA) massad@gmail.com | ||
41 | * Flag for detecting if the screen was being touch was incorrectly | ||
42 | * inverted, so no touch events were being detected. | ||
43 | * | ||
44 | *****************************************************************************/ | ||
45 | |||
46 | #include <linux/kernel.h> | ||
47 | #include <linux/slab.h> | ||
48 | #include <linux/module.h> | ||
49 | #include <linux/init.h> | ||
50 | #include <linux/usb/input.h> | ||
51 | |||
52 | /* only an 8 byte buffer necessary for a single packet */ | ||
53 | #define ITM_BUFSIZE 8 | ||
54 | #define PATH_SIZE 64 | ||
55 | |||
56 | #define USB_VENDOR_ID_ITMINC 0x0403 | ||
57 | #define USB_PRODUCT_ID_TOUCHPANEL 0xf9e9 | ||
58 | |||
59 | #define DRIVER_AUTHOR "Hans-Christian Egtvedt <hc@mivu.no>" | ||
60 | #define DRIVER_VERSION "v1.2.2" | ||
61 | #define DRIVER_DESC "USB ITM Inc Touch Panel Driver" | ||
62 | #define DRIVER_LICENSE "GPL" | ||
63 | |||
64 | MODULE_AUTHOR( DRIVER_AUTHOR ); | ||
65 | MODULE_DESCRIPTION( DRIVER_DESC ); | ||
66 | MODULE_LICENSE( DRIVER_LICENSE ); | ||
67 | |||
68 | struct itmtouch_dev { | ||
69 | struct usb_device *usbdev; /* usb device */ | ||
70 | struct input_dev *inputdev; /* input device */ | ||
71 | struct urb *readurb; /* urb */ | ||
72 | char rbuf[ITM_BUFSIZE]; /* data */ | ||
73 | int users; | ||
74 | char name[128]; | ||
75 | char phys[64]; | ||
76 | }; | ||
77 | |||
78 | static struct usb_device_id itmtouch_ids [] = { | ||
79 | { USB_DEVICE(USB_VENDOR_ID_ITMINC, USB_PRODUCT_ID_TOUCHPANEL) }, | ||
80 | { } | ||
81 | }; | ||
82 | |||
83 | static void itmtouch_irq(struct urb *urb) | ||
84 | { | ||
85 | struct itmtouch_dev *itmtouch = urb->context; | ||
86 | unsigned char *data = urb->transfer_buffer; | ||
87 | struct input_dev *dev = itmtouch->inputdev; | ||
88 | int retval; | ||
89 | |||
90 | switch (urb->status) { | ||
91 | case 0: | ||
92 | /* success */ | ||
93 | break; | ||
94 | case -ETIME: | ||
95 | /* this urb is timing out */ | ||
96 | dbg("%s - urb timed out - was the device unplugged?", | ||
97 | __FUNCTION__); | ||
98 | return; | ||
99 | case -ECONNRESET: | ||
100 | case -ENOENT: | ||
101 | case -ESHUTDOWN: | ||
102 | /* this urb is terminated, clean up */ | ||
103 | dbg("%s - urb shutting down with status: %d", | ||
104 | __FUNCTION__, urb->status); | ||
105 | return; | ||
106 | default: | ||
107 | dbg("%s - nonzero urb status received: %d", | ||
108 | __FUNCTION__, urb->status); | ||
109 | goto exit; | ||
110 | } | ||
111 | |||
112 | /* if pressure has been released, then don't report X/Y */ | ||
113 | if (!(data[7] & 0x20)) { | ||
114 | input_report_abs(dev, ABS_X, (data[0] & 0x1F) << 7 | (data[3] & 0x7F)); | ||
115 | input_report_abs(dev, ABS_Y, (data[1] & 0x1F) << 7 | (data[4] & 0x7F)); | ||
116 | } | ||
117 | |||
118 | input_report_abs(dev, ABS_PRESSURE, (data[2] & 1) << 7 | (data[5] & 0x7F)); | ||
119 | input_report_key(dev, BTN_TOUCH, ~data[7] & 0x20); | ||
120 | input_sync(dev); | ||
121 | |||
122 | exit: | ||
123 | retval = usb_submit_urb (urb, GFP_ATOMIC); | ||
124 | if (retval) | ||
125 | printk(KERN_ERR "%s - usb_submit_urb failed with result: %d", | ||
126 | __FUNCTION__, retval); | ||
127 | } | ||
128 | |||
129 | static int itmtouch_open(struct input_dev *input) | ||
130 | { | ||
131 | struct itmtouch_dev *itmtouch = input->private; | ||
132 | |||
133 | itmtouch->readurb->dev = itmtouch->usbdev; | ||
134 | |||
135 | if (usb_submit_urb(itmtouch->readurb, GFP_KERNEL)) | ||
136 | return -EIO; | ||
137 | |||
138 | return 0; | ||
139 | } | ||
140 | |||
141 | static void itmtouch_close(struct input_dev *input) | ||
142 | { | ||
143 | struct itmtouch_dev *itmtouch = input->private; | ||
144 | |||
145 | usb_kill_urb(itmtouch->readurb); | ||
146 | } | ||
147 | |||
148 | static int itmtouch_probe(struct usb_interface *intf, const struct usb_device_id *id) | ||
149 | { | ||
150 | struct itmtouch_dev *itmtouch; | ||
151 | struct input_dev *input_dev; | ||
152 | struct usb_host_interface *interface; | ||
153 | struct usb_endpoint_descriptor *endpoint; | ||
154 | struct usb_device *udev = interface_to_usbdev(intf); | ||
155 | unsigned int pipe; | ||
156 | unsigned int maxp; | ||
157 | |||
158 | interface = intf->cur_altsetting; | ||
159 | endpoint = &interface->endpoint[0].desc; | ||
160 | |||
161 | itmtouch = kzalloc(sizeof(struct itmtouch_dev), GFP_KERNEL); | ||
162 | input_dev = input_allocate_device(); | ||
163 | if (!itmtouch || !input_dev) { | ||
164 | err("%s - Out of memory.", __FUNCTION__); | ||
165 | goto fail; | ||
166 | } | ||
167 | |||
168 | itmtouch->usbdev = udev; | ||
169 | itmtouch->inputdev = input_dev; | ||
170 | |||
171 | if (udev->manufacturer) | ||
172 | strlcpy(itmtouch->name, udev->manufacturer, sizeof(itmtouch->name)); | ||
173 | |||
174 | if (udev->product) { | ||
175 | if (udev->manufacturer) | ||
176 | strlcat(itmtouch->name, " ", sizeof(itmtouch->name)); | ||
177 | strlcat(itmtouch->name, udev->product, sizeof(itmtouch->name)); | ||
178 | } | ||
179 | |||
180 | if (!strlen(itmtouch->name)) | ||
181 | sprintf(itmtouch->name, "USB ITM touchscreen"); | ||
182 | |||
183 | usb_make_path(udev, itmtouch->phys, sizeof(itmtouch->phys)); | ||
184 | strlcpy(itmtouch->phys, "/input0", sizeof(itmtouch->phys)); | ||
185 | |||
186 | input_dev->name = itmtouch->name; | ||
187 | input_dev->phys = itmtouch->phys; | ||
188 | usb_to_input_id(udev, &input_dev->id); | ||
189 | input_dev->cdev.dev = &intf->dev; | ||
190 | input_dev->private = itmtouch; | ||
191 | |||
192 | input_dev->open = itmtouch_open; | ||
193 | input_dev->close = itmtouch_close; | ||
194 | |||
195 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | ||
196 | input_dev->absbit[0] = BIT(ABS_X) | BIT(ABS_Y) | BIT(ABS_PRESSURE); | ||
197 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | ||
198 | |||
199 | /* device limits */ | ||
200 | /* as specified by the ITM datasheet, X and Y are 12bit, | ||
201 | * Z (pressure) is 8 bit. However, the fields are defined up | ||
202 | * to 14 bits for future possible expansion. | ||
203 | */ | ||
204 | input_set_abs_params(input_dev, ABS_X, 0, 0x0FFF, 2, 0); | ||
205 | input_set_abs_params(input_dev, ABS_Y, 0, 0x0FFF, 2, 0); | ||
206 | input_set_abs_params(input_dev, ABS_PRESSURE, 0, 0xFF, 2, 0); | ||
207 | |||
208 | /* initialise the URB so we can read from the transport stream */ | ||
209 | pipe = usb_rcvintpipe(itmtouch->usbdev, endpoint->bEndpointAddress); | ||
210 | maxp = usb_maxpacket(udev, pipe, usb_pipeout(pipe)); | ||
211 | |||
212 | if (maxp > ITM_BUFSIZE) | ||
213 | maxp = ITM_BUFSIZE; | ||
214 | |||
215 | itmtouch->readurb = usb_alloc_urb(0, GFP_KERNEL); | ||
216 | if (!itmtouch->readurb) { | ||
217 | dbg("%s - usb_alloc_urb failed: itmtouch->readurb", __FUNCTION__); | ||
218 | goto fail; | ||
219 | } | ||
220 | |||
221 | usb_fill_int_urb(itmtouch->readurb, itmtouch->usbdev, pipe, itmtouch->rbuf, | ||
222 | maxp, itmtouch_irq, itmtouch, endpoint->bInterval); | ||
223 | |||
224 | input_register_device(itmtouch->inputdev); | ||
225 | |||
226 | usb_set_intfdata(intf, itmtouch); | ||
227 | |||
228 | return 0; | ||
229 | |||
230 | fail: input_free_device(input_dev); | ||
231 | kfree(itmtouch); | ||
232 | return -ENOMEM; | ||
233 | } | ||
234 | |||
235 | static void itmtouch_disconnect(struct usb_interface *intf) | ||
236 | { | ||
237 | struct itmtouch_dev *itmtouch = usb_get_intfdata(intf); | ||
238 | |||
239 | usb_set_intfdata(intf, NULL); | ||
240 | |||
241 | if (itmtouch) { | ||
242 | input_unregister_device(itmtouch->inputdev); | ||
243 | usb_kill_urb(itmtouch->readurb); | ||
244 | usb_free_urb(itmtouch->readurb); | ||
245 | kfree(itmtouch); | ||
246 | } | ||
247 | } | ||
248 | |||
249 | MODULE_DEVICE_TABLE(usb, itmtouch_ids); | ||
250 | |||
251 | static struct usb_driver itmtouch_driver = { | ||
252 | .name = "itmtouch", | ||
253 | .probe = itmtouch_probe, | ||
254 | .disconnect = itmtouch_disconnect, | ||
255 | .id_table = itmtouch_ids, | ||
256 | }; | ||
257 | |||
258 | static int __init itmtouch_init(void) | ||
259 | { | ||
260 | info(DRIVER_DESC " " DRIVER_VERSION); | ||
261 | info(DRIVER_AUTHOR); | ||
262 | return usb_register(&itmtouch_driver); | ||
263 | } | ||
264 | |||
265 | static void __exit itmtouch_exit(void) | ||
266 | { | ||
267 | usb_deregister(&itmtouch_driver); | ||
268 | } | ||
269 | |||
270 | module_init(itmtouch_init); | ||
271 | module_exit(itmtouch_exit); | ||
diff --git a/drivers/usb/input/kbtab.c b/drivers/usb/input/kbtab.c index fedbcb127c21..c4781b9d1297 100644 --- a/drivers/usb/input/kbtab.c +++ b/drivers/usb/input/kbtab.c | |||
@@ -100,7 +100,7 @@ MODULE_DEVICE_TABLE(usb, kbtab_ids); | |||
100 | 100 | ||
101 | static int kbtab_open(struct input_dev *dev) | 101 | static int kbtab_open(struct input_dev *dev) |
102 | { | 102 | { |
103 | struct kbtab *kbtab = dev->private; | 103 | struct kbtab *kbtab = input_get_drvdata(dev); |
104 | 104 | ||
105 | kbtab->irq->dev = kbtab->usbdev; | 105 | kbtab->irq->dev = kbtab->usbdev; |
106 | if (usb_submit_urb(kbtab->irq, GFP_KERNEL)) | 106 | if (usb_submit_urb(kbtab->irq, GFP_KERNEL)) |
@@ -111,7 +111,7 @@ static int kbtab_open(struct input_dev *dev) | |||
111 | 111 | ||
112 | static void kbtab_close(struct input_dev *dev) | 112 | static void kbtab_close(struct input_dev *dev) |
113 | { | 113 | { |
114 | struct kbtab *kbtab = dev->private; | 114 | struct kbtab *kbtab = input_get_drvdata(dev); |
115 | 115 | ||
116 | usb_kill_urb(kbtab->irq); | 116 | usb_kill_urb(kbtab->irq); |
117 | } | 117 | } |
@@ -122,6 +122,7 @@ static int kbtab_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
122 | struct usb_endpoint_descriptor *endpoint; | 122 | struct usb_endpoint_descriptor *endpoint; |
123 | struct kbtab *kbtab; | 123 | struct kbtab *kbtab; |
124 | struct input_dev *input_dev; | 124 | struct input_dev *input_dev; |
125 | int error = -ENOMEM; | ||
125 | 126 | ||
126 | kbtab = kzalloc(sizeof(struct kbtab), GFP_KERNEL); | 127 | kbtab = kzalloc(sizeof(struct kbtab), GFP_KERNEL); |
127 | input_dev = input_allocate_device(); | 128 | input_dev = input_allocate_device(); |
@@ -145,8 +146,9 @@ static int kbtab_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
145 | input_dev->name = "KB Gear Tablet"; | 146 | input_dev->name = "KB Gear Tablet"; |
146 | input_dev->phys = kbtab->phys; | 147 | input_dev->phys = kbtab->phys; |
147 | usb_to_input_id(dev, &input_dev->id); | 148 | usb_to_input_id(dev, &input_dev->id); |
148 | input_dev->cdev.dev = &intf->dev; | 149 | input_dev->dev.parent = &intf->dev; |
149 | input_dev->private = kbtab; | 150 | |
151 | input_set_drvdata(input_dev, kbtab); | ||
150 | 152 | ||
151 | input_dev->open = kbtab_open; | 153 | input_dev->open = kbtab_open; |
152 | input_dev->close = kbtab_close; | 154 | input_dev->close = kbtab_close; |
@@ -168,15 +170,19 @@ static int kbtab_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
168 | kbtab->irq->transfer_dma = kbtab->data_dma; | 170 | kbtab->irq->transfer_dma = kbtab->data_dma; |
169 | kbtab->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 171 | kbtab->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; |
170 | 172 | ||
171 | input_register_device(kbtab->dev); | 173 | error = input_register_device(kbtab->dev); |
174 | if (error) | ||
175 | goto fail3; | ||
172 | 176 | ||
173 | usb_set_intfdata(intf, kbtab); | 177 | usb_set_intfdata(intf, kbtab); |
178 | |||
174 | return 0; | 179 | return 0; |
175 | 180 | ||
176 | fail2: usb_buffer_free(dev, 10, kbtab->data, kbtab->data_dma); | 181 | fail3: usb_free_urb(kbtab->irq); |
177 | fail1: input_free_device(input_dev); | 182 | fail2: usb_buffer_free(dev, 10, kbtab->data, kbtab->data_dma); |
183 | fail1: input_free_device(input_dev); | ||
178 | kfree(kbtab); | 184 | kfree(kbtab); |
179 | return -ENOMEM; | 185 | return error; |
180 | } | 186 | } |
181 | 187 | ||
182 | static void kbtab_disconnect(struct usb_interface *intf) | 188 | static void kbtab_disconnect(struct usb_interface *intf) |
diff --git a/drivers/usb/input/keyspan_remote.c b/drivers/usb/input/keyspan_remote.c index 98bd323369c7..1bffc9fa98c2 100644 --- a/drivers/usb/input/keyspan_remote.c +++ b/drivers/usb/input/keyspan_remote.c | |||
@@ -394,7 +394,7 @@ resubmit: | |||
394 | 394 | ||
395 | static int keyspan_open(struct input_dev *dev) | 395 | static int keyspan_open(struct input_dev *dev) |
396 | { | 396 | { |
397 | struct usb_keyspan *remote = dev->private; | 397 | struct usb_keyspan *remote = input_get_drvdata(dev); |
398 | 398 | ||
399 | remote->irq_urb->dev = remote->udev; | 399 | remote->irq_urb->dev = remote->udev; |
400 | if (usb_submit_urb(remote->irq_urb, GFP_KERNEL)) | 400 | if (usb_submit_urb(remote->irq_urb, GFP_KERNEL)) |
@@ -405,7 +405,7 @@ static int keyspan_open(struct input_dev *dev) | |||
405 | 405 | ||
406 | static void keyspan_close(struct input_dev *dev) | 406 | static void keyspan_close(struct input_dev *dev) |
407 | { | 407 | { |
408 | struct usb_keyspan *remote = dev->private; | 408 | struct usb_keyspan *remote = input_get_drvdata(dev); |
409 | 409 | ||
410 | usb_kill_urb(remote->irq_urb); | 410 | usb_kill_urb(remote->irq_urb); |
411 | } | 411 | } |
@@ -437,7 +437,7 @@ static int keyspan_probe(struct usb_interface *interface, const struct usb_devic | |||
437 | struct usb_endpoint_descriptor *endpoint; | 437 | struct usb_endpoint_descriptor *endpoint; |
438 | struct usb_keyspan *remote; | 438 | struct usb_keyspan *remote; |
439 | struct input_dev *input_dev; | 439 | struct input_dev *input_dev; |
440 | int i, retval; | 440 | int i, error; |
441 | 441 | ||
442 | endpoint = keyspan_get_in_endpoint(interface->cur_altsetting); | 442 | endpoint = keyspan_get_in_endpoint(interface->cur_altsetting); |
443 | if (!endpoint) | 443 | if (!endpoint) |
@@ -446,7 +446,7 @@ static int keyspan_probe(struct usb_interface *interface, const struct usb_devic | |||
446 | remote = kzalloc(sizeof(*remote), GFP_KERNEL); | 446 | remote = kzalloc(sizeof(*remote), GFP_KERNEL); |
447 | input_dev = input_allocate_device(); | 447 | input_dev = input_allocate_device(); |
448 | if (!remote || !input_dev) { | 448 | if (!remote || !input_dev) { |
449 | retval = -ENOMEM; | 449 | error = -ENOMEM; |
450 | goto fail1; | 450 | goto fail1; |
451 | } | 451 | } |
452 | 452 | ||
@@ -458,19 +458,19 @@ static int keyspan_probe(struct usb_interface *interface, const struct usb_devic | |||
458 | 458 | ||
459 | remote->in_buffer = usb_buffer_alloc(udev, RECV_SIZE, GFP_ATOMIC, &remote->in_dma); | 459 | remote->in_buffer = usb_buffer_alloc(udev, RECV_SIZE, GFP_ATOMIC, &remote->in_dma); |
460 | if (!remote->in_buffer) { | 460 | if (!remote->in_buffer) { |
461 | retval = -ENOMEM; | 461 | error = -ENOMEM; |
462 | goto fail1; | 462 | goto fail1; |
463 | } | 463 | } |
464 | 464 | ||
465 | remote->irq_urb = usb_alloc_urb(0, GFP_KERNEL); | 465 | remote->irq_urb = usb_alloc_urb(0, GFP_KERNEL); |
466 | if (!remote->irq_urb) { | 466 | if (!remote->irq_urb) { |
467 | retval = -ENOMEM; | 467 | error = -ENOMEM; |
468 | goto fail2; | 468 | goto fail2; |
469 | } | 469 | } |
470 | 470 | ||
471 | retval = keyspan_setup(udev); | 471 | error = keyspan_setup(udev); |
472 | if (retval) { | 472 | if (error) { |
473 | retval = -ENODEV; | 473 | error = -ENODEV; |
474 | goto fail3; | 474 | goto fail3; |
475 | } | 475 | } |
476 | 476 | ||
@@ -495,14 +495,15 @@ static int keyspan_probe(struct usb_interface *interface, const struct usb_devic | |||
495 | input_dev->name = remote->name; | 495 | input_dev->name = remote->name; |
496 | input_dev->phys = remote->phys; | 496 | input_dev->phys = remote->phys; |
497 | usb_to_input_id(udev, &input_dev->id); | 497 | usb_to_input_id(udev, &input_dev->id); |
498 | input_dev->cdev.dev = &interface->dev; | 498 | input_dev->dev.parent = &interface->dev; |
499 | 499 | ||
500 | input_dev->evbit[0] = BIT(EV_KEY); /* We will only report KEY events. */ | 500 | input_dev->evbit[0] = BIT(EV_KEY); /* We will only report KEY events. */ |
501 | for (i = 0; i < ARRAY_SIZE(keyspan_key_table); i++) | 501 | for (i = 0; i < ARRAY_SIZE(keyspan_key_table); i++) |
502 | if (keyspan_key_table[i] != KEY_RESERVED) | 502 | if (keyspan_key_table[i] != KEY_RESERVED) |
503 | set_bit(keyspan_key_table[i], input_dev->keybit); | 503 | set_bit(keyspan_key_table[i], input_dev->keybit); |
504 | 504 | ||
505 | input_dev->private = remote; | 505 | input_set_drvdata(input_dev, remote); |
506 | |||
506 | input_dev->open = keyspan_open; | 507 | input_dev->open = keyspan_open; |
507 | input_dev->close = keyspan_close; | 508 | input_dev->close = keyspan_close; |
508 | 509 | ||
@@ -517,7 +518,9 @@ static int keyspan_probe(struct usb_interface *interface, const struct usb_devic | |||
517 | remote->irq_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 518 | remote->irq_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; |
518 | 519 | ||
519 | /* we can register the device now, as it is ready */ | 520 | /* we can register the device now, as it is ready */ |
520 | input_register_device(remote->input); | 521 | error = input_register_device(remote->input); |
522 | if (error) | ||
523 | goto fail3; | ||
521 | 524 | ||
522 | /* save our data pointer in this interface device */ | 525 | /* save our data pointer in this interface device */ |
523 | usb_set_intfdata(interface, remote); | 526 | usb_set_intfdata(interface, remote); |
@@ -529,7 +532,7 @@ static int keyspan_probe(struct usb_interface *interface, const struct usb_devic | |||
529 | fail1: kfree(remote); | 532 | fail1: kfree(remote); |
530 | input_free_device(input_dev); | 533 | input_free_device(input_dev); |
531 | 534 | ||
532 | return retval; | 535 | return error; |
533 | } | 536 | } |
534 | 537 | ||
535 | /* | 538 | /* |
diff --git a/drivers/usb/input/mtouchusb.c b/drivers/usb/input/mtouchusb.c deleted file mode 100644 index 92c4e07da4c8..000000000000 --- a/drivers/usb/input/mtouchusb.c +++ /dev/null | |||
@@ -1,332 +0,0 @@ | |||
1 | /****************************************************************************** | ||
2 | * mtouchusb.c -- Driver for Microtouch (Now 3M) USB Touchscreens | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or | ||
5 | * modify it under the terms of the GNU General Public License as | ||
6 | * published by the Free Software Foundation; either version 2 of the | ||
7 | * License, or (at your option) any later version. | ||
8 | * | ||
9 | * This program is distributed in the hope that it will be useful, but | ||
10 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
12 | * General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program; if not, write to the Free Software | ||
16 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
17 | * | ||
18 | * Based upon original work by Radoslaw Garbacz (usb-support@ite.pl) | ||
19 | * (http://freshmeat.net/projects/3mtouchscreendriver) | ||
20 | * | ||
21 | * History | ||
22 | * | ||
23 | * 0.3 & 0.4 2002 (TEJ) tejohnson@yahoo.com | ||
24 | * Updated to 2.4.18, then 2.4.19 | ||
25 | * Old version still relied on stealing a minor | ||
26 | * | ||
27 | * 0.5 02/26/2004 (TEJ) tejohnson@yahoo.com | ||
28 | * Complete rewrite using Linux Input in 2.6.3 | ||
29 | * Unfortunately no calibration support at this time | ||
30 | * | ||
31 | * 1.4 04/25/2004 (TEJ) tejohnson@yahoo.com | ||
32 | * Changed reset from standard USB dev reset to vendor reset | ||
33 | * Changed data sent to host from compensated to raw coordinates | ||
34 | * Eliminated vendor/product module params | ||
35 | * Performed multiple successful tests with an EXII-5010UC | ||
36 | * | ||
37 | * 1.5 02/27/2005 ddstreet@ieee.org | ||
38 | * Added module parameter to select raw or hw-calibrated coordinate reporting | ||
39 | * | ||
40 | *****************************************************************************/ | ||
41 | |||
42 | #include <linux/kernel.h> | ||
43 | #include <linux/slab.h> | ||
44 | #include <linux/module.h> | ||
45 | #include <linux/init.h> | ||
46 | #include <linux/usb/input.h> | ||
47 | |||
48 | #define MTOUCHUSB_MIN_XC 0x0 | ||
49 | #define MTOUCHUSB_MAX_RAW_XC 0x4000 | ||
50 | #define MTOUCHUSB_MAX_CALIB_XC 0xffff | ||
51 | #define MTOUCHUSB_XC_FUZZ 0x0 | ||
52 | #define MTOUCHUSB_XC_FLAT 0x0 | ||
53 | #define MTOUCHUSB_MIN_YC 0x0 | ||
54 | #define MTOUCHUSB_MAX_RAW_YC 0x4000 | ||
55 | #define MTOUCHUSB_MAX_CALIB_YC 0xffff | ||
56 | #define MTOUCHUSB_YC_FUZZ 0x0 | ||
57 | #define MTOUCHUSB_YC_FLAT 0x0 | ||
58 | |||
59 | #define MTOUCHUSB_ASYNC_REPORT 1 | ||
60 | #define MTOUCHUSB_RESET 7 | ||
61 | #define MTOUCHUSB_REPORT_DATA_SIZE 11 | ||
62 | #define MTOUCHUSB_REQ_CTRLLR_ID 10 | ||
63 | |||
64 | #define MTOUCHUSB_GET_RAW_XC(data) (data[8]<<8 | data[7]) | ||
65 | #define MTOUCHUSB_GET_CALIB_XC(data) (data[4]<<8 | data[3]) | ||
66 | #define MTOUCHUSB_GET_RAW_YC(data) (data[10]<<8 | data[9]) | ||
67 | #define MTOUCHUSB_GET_CALIB_YC(data) (data[6]<<8 | data[5]) | ||
68 | #define MTOUCHUSB_GET_XC(data) (raw_coordinates ? \ | ||
69 | MTOUCHUSB_GET_RAW_XC(data) : \ | ||
70 | MTOUCHUSB_GET_CALIB_XC(data)) | ||
71 | #define MTOUCHUSB_GET_YC(data) (raw_coordinates ? \ | ||
72 | MTOUCHUSB_GET_RAW_YC(data) : \ | ||
73 | MTOUCHUSB_GET_CALIB_YC(data)) | ||
74 | #define MTOUCHUSB_GET_TOUCHED(data) ((data[2] & 0x40) ? 1:0) | ||
75 | |||
76 | #define DRIVER_VERSION "v1.5" | ||
77 | #define DRIVER_AUTHOR "Todd E. Johnson, tejohnson@yahoo.com" | ||
78 | #define DRIVER_DESC "3M USB Touchscreen Driver" | ||
79 | #define DRIVER_LICENSE "GPL" | ||
80 | |||
81 | static int raw_coordinates = 1; | ||
82 | |||
83 | module_param(raw_coordinates, bool, S_IRUGO | S_IWUSR); | ||
84 | MODULE_PARM_DESC(raw_coordinates, "report raw coordinate values (y, default) or hardware-calibrated coordinate values (n)"); | ||
85 | |||
86 | struct mtouch_usb { | ||
87 | unsigned char *data; | ||
88 | dma_addr_t data_dma; | ||
89 | struct urb *irq; | ||
90 | struct usb_device *udev; | ||
91 | struct input_dev *input; | ||
92 | char name[128]; | ||
93 | char phys[64]; | ||
94 | }; | ||
95 | |||
96 | static struct usb_device_id mtouchusb_devices[] = { | ||
97 | { USB_DEVICE(0x0596, 0x0001) }, | ||
98 | { } | ||
99 | }; | ||
100 | |||
101 | static void mtouchusb_irq(struct urb *urb) | ||
102 | { | ||
103 | struct mtouch_usb *mtouch = urb->context; | ||
104 | int retval; | ||
105 | |||
106 | switch (urb->status) { | ||
107 | case 0: | ||
108 | /* success */ | ||
109 | break; | ||
110 | case -ETIME: | ||
111 | /* this urb is timing out */ | ||
112 | dbg("%s - urb timed out - was the device unplugged?", | ||
113 | __FUNCTION__); | ||
114 | return; | ||
115 | case -ECONNRESET: | ||
116 | case -ENOENT: | ||
117 | case -ESHUTDOWN: | ||
118 | /* this urb is terminated, clean up */ | ||
119 | dbg("%s - urb shutting down with status: %d", | ||
120 | __FUNCTION__, urb->status); | ||
121 | return; | ||
122 | default: | ||
123 | dbg("%s - nonzero urb status received: %d", | ||
124 | __FUNCTION__, urb->status); | ||
125 | goto exit; | ||
126 | } | ||
127 | |||
128 | input_report_key(mtouch->input, BTN_TOUCH, | ||
129 | MTOUCHUSB_GET_TOUCHED(mtouch->data)); | ||
130 | input_report_abs(mtouch->input, ABS_X, MTOUCHUSB_GET_XC(mtouch->data)); | ||
131 | input_report_abs(mtouch->input, ABS_Y, | ||
132 | (raw_coordinates ? MTOUCHUSB_MAX_RAW_YC : MTOUCHUSB_MAX_CALIB_YC) | ||
133 | - MTOUCHUSB_GET_YC(mtouch->data)); | ||
134 | input_sync(mtouch->input); | ||
135 | |||
136 | exit: | ||
137 | retval = usb_submit_urb(urb, GFP_ATOMIC); | ||
138 | if (retval) | ||
139 | err("%s - usb_submit_urb failed with result: %d", | ||
140 | __FUNCTION__, retval); | ||
141 | } | ||
142 | |||
143 | static int mtouchusb_open(struct input_dev *input) | ||
144 | { | ||
145 | struct mtouch_usb *mtouch = input->private; | ||
146 | |||
147 | mtouch->irq->dev = mtouch->udev; | ||
148 | |||
149 | if (usb_submit_urb(mtouch->irq, GFP_ATOMIC)) | ||
150 | return -EIO; | ||
151 | |||
152 | return 0; | ||
153 | } | ||
154 | |||
155 | static void mtouchusb_close(struct input_dev *input) | ||
156 | { | ||
157 | struct mtouch_usb *mtouch = input->private; | ||
158 | |||
159 | usb_kill_urb(mtouch->irq); | ||
160 | } | ||
161 | |||
162 | static int mtouchusb_alloc_buffers(struct usb_device *udev, struct mtouch_usb *mtouch) | ||
163 | { | ||
164 | dbg("%s - called", __FUNCTION__); | ||
165 | |||
166 | mtouch->data = usb_buffer_alloc(udev, MTOUCHUSB_REPORT_DATA_SIZE, | ||
167 | GFP_ATOMIC, &mtouch->data_dma); | ||
168 | |||
169 | if (!mtouch->data) | ||
170 | return -1; | ||
171 | |||
172 | return 0; | ||
173 | } | ||
174 | |||
175 | static void mtouchusb_free_buffers(struct usb_device *udev, struct mtouch_usb *mtouch) | ||
176 | { | ||
177 | dbg("%s - called", __FUNCTION__); | ||
178 | |||
179 | if (mtouch->data) | ||
180 | usb_buffer_free(udev, MTOUCHUSB_REPORT_DATA_SIZE, | ||
181 | mtouch->data, mtouch->data_dma); | ||
182 | } | ||
183 | |||
184 | static int mtouchusb_probe(struct usb_interface *intf, const struct usb_device_id *id) | ||
185 | { | ||
186 | struct mtouch_usb *mtouch; | ||
187 | struct input_dev *input_dev; | ||
188 | struct usb_host_interface *interface; | ||
189 | struct usb_endpoint_descriptor *endpoint; | ||
190 | struct usb_device *udev = interface_to_usbdev(intf); | ||
191 | int nRet; | ||
192 | |||
193 | dbg("%s - called", __FUNCTION__); | ||
194 | |||
195 | dbg("%s - setting interface", __FUNCTION__); | ||
196 | interface = intf->cur_altsetting; | ||
197 | |||
198 | dbg("%s - setting endpoint", __FUNCTION__); | ||
199 | endpoint = &interface->endpoint[0].desc; | ||
200 | |||
201 | mtouch = kzalloc(sizeof(struct mtouch_usb), GFP_KERNEL); | ||
202 | input_dev = input_allocate_device(); | ||
203 | if (!mtouch || !input_dev) { | ||
204 | err("%s - Out of memory.", __FUNCTION__); | ||
205 | goto fail1; | ||
206 | } | ||
207 | |||
208 | dbg("%s - allocating buffers", __FUNCTION__); | ||
209 | if (mtouchusb_alloc_buffers(udev, mtouch)) | ||
210 | goto fail2; | ||
211 | |||
212 | mtouch->udev = udev; | ||
213 | mtouch->input = input_dev; | ||
214 | |||
215 | if (udev->manufacturer) | ||
216 | strlcpy(mtouch->name, udev->manufacturer, sizeof(mtouch->name)); | ||
217 | |||
218 | if (udev->product) { | ||
219 | if (udev->manufacturer) | ||
220 | strlcat(mtouch->name, " ", sizeof(mtouch->name)); | ||
221 | strlcat(mtouch->name, udev->product, sizeof(mtouch->name)); | ||
222 | } | ||
223 | |||
224 | if (!strlen(mtouch->name)) | ||
225 | snprintf(mtouch->name, sizeof(mtouch->name), | ||
226 | "USB Touchscreen %04x:%04x", | ||
227 | le16_to_cpu(udev->descriptor.idVendor), | ||
228 | le16_to_cpu(udev->descriptor.idProduct)); | ||
229 | |||
230 | usb_make_path(udev, mtouch->phys, sizeof(mtouch->phys)); | ||
231 | strlcpy(mtouch->phys, "/input0", sizeof(mtouch->phys)); | ||
232 | |||
233 | input_dev->name = mtouch->name; | ||
234 | input_dev->phys = mtouch->phys; | ||
235 | usb_to_input_id(udev, &input_dev->id); | ||
236 | input_dev->cdev.dev = &intf->dev; | ||
237 | input_dev->private = mtouch; | ||
238 | |||
239 | input_dev->open = mtouchusb_open; | ||
240 | input_dev->close = mtouchusb_close; | ||
241 | |||
242 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | ||
243 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | ||
244 | input_set_abs_params(input_dev, ABS_X, MTOUCHUSB_MIN_XC, | ||
245 | raw_coordinates ? MTOUCHUSB_MAX_RAW_XC : MTOUCHUSB_MAX_CALIB_XC, | ||
246 | MTOUCHUSB_XC_FUZZ, MTOUCHUSB_XC_FLAT); | ||
247 | input_set_abs_params(input_dev, ABS_Y, MTOUCHUSB_MIN_YC, | ||
248 | raw_coordinates ? MTOUCHUSB_MAX_RAW_YC : MTOUCHUSB_MAX_CALIB_YC, | ||
249 | MTOUCHUSB_YC_FUZZ, MTOUCHUSB_YC_FLAT); | ||
250 | |||
251 | nRet = usb_control_msg(mtouch->udev, usb_rcvctrlpipe(udev, 0), | ||
252 | MTOUCHUSB_RESET, | ||
253 | USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | ||
254 | 1, 0, NULL, 0, USB_CTRL_SET_TIMEOUT); | ||
255 | dbg("%s - usb_control_msg - MTOUCHUSB_RESET - bytes|err: %d", | ||
256 | __FUNCTION__, nRet); | ||
257 | |||
258 | dbg("%s - usb_alloc_urb: mtouch->irq", __FUNCTION__); | ||
259 | mtouch->irq = usb_alloc_urb(0, GFP_KERNEL); | ||
260 | if (!mtouch->irq) { | ||
261 | dbg("%s - usb_alloc_urb failed: mtouch->irq", __FUNCTION__); | ||
262 | goto fail2; | ||
263 | } | ||
264 | |||
265 | dbg("%s - usb_fill_int_urb", __FUNCTION__); | ||
266 | usb_fill_int_urb(mtouch->irq, mtouch->udev, | ||
267 | usb_rcvintpipe(mtouch->udev, 0x81), | ||
268 | mtouch->data, MTOUCHUSB_REPORT_DATA_SIZE, | ||
269 | mtouchusb_irq, mtouch, endpoint->bInterval); | ||
270 | |||
271 | dbg("%s - input_register_device", __FUNCTION__); | ||
272 | input_register_device(mtouch->input); | ||
273 | |||
274 | nRet = usb_control_msg(mtouch->udev, usb_rcvctrlpipe(udev, 0), | ||
275 | MTOUCHUSB_ASYNC_REPORT, | ||
276 | USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | ||
277 | 1, 1, NULL, 0, USB_CTRL_SET_TIMEOUT); | ||
278 | dbg("%s - usb_control_msg - MTOUCHUSB_ASYNC_REPORT - bytes|err: %d", | ||
279 | __FUNCTION__, nRet); | ||
280 | |||
281 | usb_set_intfdata(intf, mtouch); | ||
282 | return 0; | ||
283 | |||
284 | fail2: mtouchusb_free_buffers(udev, mtouch); | ||
285 | fail1: input_free_device(input_dev); | ||
286 | kfree(mtouch); | ||
287 | return -ENOMEM; | ||
288 | } | ||
289 | |||
290 | static void mtouchusb_disconnect(struct usb_interface *intf) | ||
291 | { | ||
292 | struct mtouch_usb *mtouch = usb_get_intfdata(intf); | ||
293 | |||
294 | dbg("%s - called", __FUNCTION__); | ||
295 | usb_set_intfdata(intf, NULL); | ||
296 | if (mtouch) { | ||
297 | dbg("%s - mtouch is initialized, cleaning up", __FUNCTION__); | ||
298 | usb_kill_urb(mtouch->irq); | ||
299 | input_unregister_device(mtouch->input); | ||
300 | usb_free_urb(mtouch->irq); | ||
301 | mtouchusb_free_buffers(interface_to_usbdev(intf), mtouch); | ||
302 | kfree(mtouch); | ||
303 | } | ||
304 | } | ||
305 | |||
306 | MODULE_DEVICE_TABLE(usb, mtouchusb_devices); | ||
307 | |||
308 | static struct usb_driver mtouchusb_driver = { | ||
309 | .name = "mtouchusb", | ||
310 | .probe = mtouchusb_probe, | ||
311 | .disconnect = mtouchusb_disconnect, | ||
312 | .id_table = mtouchusb_devices, | ||
313 | }; | ||
314 | |||
315 | static int __init mtouchusb_init(void) | ||
316 | { | ||
317 | dbg("%s - called", __FUNCTION__); | ||
318 | return usb_register(&mtouchusb_driver); | ||
319 | } | ||
320 | |||
321 | static void __exit mtouchusb_cleanup(void) | ||
322 | { | ||
323 | dbg("%s - called", __FUNCTION__); | ||
324 | usb_deregister(&mtouchusb_driver); | ||
325 | } | ||
326 | |||
327 | module_init(mtouchusb_init); | ||
328 | module_exit(mtouchusb_cleanup); | ||
329 | |||
330 | MODULE_AUTHOR(DRIVER_AUTHOR); | ||
331 | MODULE_DESCRIPTION(DRIVER_DESC); | ||
332 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/usb/input/powermate.c b/drivers/usb/input/powermate.c index fea97e5437f8..4f93a760faee 100644 --- a/drivers/usb/input/powermate.c +++ b/drivers/usb/input/powermate.c | |||
@@ -252,7 +252,7 @@ static void powermate_pulse_led(struct powermate_device *pm, int static_brightne | |||
252 | static int powermate_input_event(struct input_dev *dev, unsigned int type, unsigned int code, int _value) | 252 | static int powermate_input_event(struct input_dev *dev, unsigned int type, unsigned int code, int _value) |
253 | { | 253 | { |
254 | unsigned int command = (unsigned int)_value; | 254 | unsigned int command = (unsigned int)_value; |
255 | struct powermate_device *pm = dev->private; | 255 | struct powermate_device *pm = input_get_drvdata(dev); |
256 | 256 | ||
257 | if (type == EV_MSC && code == MSC_PULSELED){ | 257 | if (type == EV_MSC && code == MSC_PULSELED){ |
258 | /* | 258 | /* |
@@ -308,7 +308,7 @@ static int powermate_probe(struct usb_interface *intf, const struct usb_device_i | |||
308 | struct powermate_device *pm; | 308 | struct powermate_device *pm; |
309 | struct input_dev *input_dev; | 309 | struct input_dev *input_dev; |
310 | int pipe, maxp; | 310 | int pipe, maxp; |
311 | int err = -ENOMEM; | 311 | int error = -ENOMEM; |
312 | 312 | ||
313 | interface = intf->cur_altsetting; | 313 | interface = intf->cur_altsetting; |
314 | endpoint = &interface->endpoint[0].desc; | 314 | endpoint = &interface->endpoint[0].desc; |
@@ -359,8 +359,9 @@ static int powermate_probe(struct usb_interface *intf, const struct usb_device_i | |||
359 | 359 | ||
360 | input_dev->phys = pm->phys; | 360 | input_dev->phys = pm->phys; |
361 | usb_to_input_id(udev, &input_dev->id); | 361 | usb_to_input_id(udev, &input_dev->id); |
362 | input_dev->cdev.dev = &intf->dev; | 362 | input_dev->dev.parent = &intf->dev; |
363 | input_dev->private = pm; | 363 | |
364 | input_set_drvdata(input_dev, pm); | ||
364 | 365 | ||
365 | input_dev->event = powermate_input_event; | 366 | input_dev->event = powermate_input_event; |
366 | 367 | ||
@@ -387,11 +388,14 @@ static int powermate_probe(struct usb_interface *intf, const struct usb_device_i | |||
387 | 388 | ||
388 | /* register our interrupt URB with the USB system */ | 389 | /* register our interrupt URB with the USB system */ |
389 | if (usb_submit_urb(pm->irq, GFP_KERNEL)) { | 390 | if (usb_submit_urb(pm->irq, GFP_KERNEL)) { |
390 | err = -EIO; | 391 | error = -EIO; |
391 | goto fail4; | 392 | goto fail4; |
392 | } | 393 | } |
393 | 394 | ||
394 | input_register_device(pm->input); | 395 | error = input_register_device(pm->input); |
396 | if (error) | ||
397 | goto fail5; | ||
398 | |||
395 | 399 | ||
396 | /* force an update of everything */ | 400 | /* force an update of everything */ |
397 | pm->requires_update = UPDATE_PULSE_ASLEEP | UPDATE_PULSE_AWAKE | UPDATE_PULSE_MODE | UPDATE_STATIC_BRIGHTNESS; | 401 | pm->requires_update = UPDATE_PULSE_ASLEEP | UPDATE_PULSE_AWAKE | UPDATE_PULSE_MODE | UPDATE_STATIC_BRIGHTNESS; |
@@ -400,12 +404,13 @@ static int powermate_probe(struct usb_interface *intf, const struct usb_device_i | |||
400 | usb_set_intfdata(intf, pm); | 404 | usb_set_intfdata(intf, pm); |
401 | return 0; | 405 | return 0; |
402 | 406 | ||
403 | fail4: usb_free_urb(pm->config); | 407 | fail5: usb_kill_urb(pm->irq); |
404 | fail3: usb_free_urb(pm->irq); | 408 | fail4: usb_free_urb(pm->config); |
405 | fail2: powermate_free_buffers(udev, pm); | 409 | fail3: usb_free_urb(pm->irq); |
406 | fail1: input_free_device(input_dev); | 410 | fail2: powermate_free_buffers(udev, pm); |
411 | fail1: input_free_device(input_dev); | ||
407 | kfree(pm); | 412 | kfree(pm); |
408 | return err; | 413 | return error; |
409 | } | 414 | } |
410 | 415 | ||
411 | /* Called when a USB device we've accepted ownership of is removed */ | 416 | /* Called when a USB device we've accepted ownership of is removed */ |
diff --git a/drivers/usb/input/touchkitusb.c b/drivers/usb/input/touchkitusb.c deleted file mode 100644 index 2a314b065922..000000000000 --- a/drivers/usb/input/touchkitusb.c +++ /dev/null | |||
@@ -1,392 +0,0 @@ | |||
1 | /****************************************************************************** | ||
2 | * touchkitusb.c -- Driver for eGalax TouchKit USB Touchscreens | ||
3 | * | ||
4 | * Copyright (C) 2004-2005 by Daniel Ritz <daniel.ritz@gmx.ch> | ||
5 | * Copyright (C) by Todd E. Johnson (mtouchusb.c) | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or | ||
8 | * modify it under the terms of the GNU General Public License as | ||
9 | * published by the Free Software Foundation; either version 2 of the | ||
10 | * License, or (at your option) any later version. | ||
11 | * | ||
12 | * This program is distributed in the hope that it will be useful, but | ||
13 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
15 | * General Public License for more details. | ||
16 | * | ||
17 | * You should have received a copy of the GNU General Public License | ||
18 | * along with this program; if not, write to the Free Software | ||
19 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
20 | * | ||
21 | * Based upon mtouchusb.c | ||
22 | * | ||
23 | *****************************************************************************/ | ||
24 | |||
25 | //#define DEBUG | ||
26 | |||
27 | #include <linux/kernel.h> | ||
28 | #include <linux/slab.h> | ||
29 | #include <linux/module.h> | ||
30 | #include <linux/init.h> | ||
31 | #include <linux/usb/input.h> | ||
32 | |||
33 | #define TOUCHKIT_MIN_XC 0x0 | ||
34 | #define TOUCHKIT_MAX_XC 0x07ff | ||
35 | #define TOUCHKIT_XC_FUZZ 0x0 | ||
36 | #define TOUCHKIT_XC_FLAT 0x0 | ||
37 | #define TOUCHKIT_MIN_YC 0x0 | ||
38 | #define TOUCHKIT_MAX_YC 0x07ff | ||
39 | #define TOUCHKIT_YC_FUZZ 0x0 | ||
40 | #define TOUCHKIT_YC_FLAT 0x0 | ||
41 | #define TOUCHKIT_REPORT_DATA_SIZE 16 | ||
42 | |||
43 | #define TOUCHKIT_DOWN 0x01 | ||
44 | |||
45 | #define TOUCHKIT_PKT_TYPE_MASK 0xFE | ||
46 | #define TOUCHKIT_PKT_TYPE_REPT 0x80 | ||
47 | #define TOUCHKIT_PKT_TYPE_DIAG 0x0A | ||
48 | |||
49 | #define DRIVER_VERSION "v0.1" | ||
50 | #define DRIVER_AUTHOR "Daniel Ritz <daniel.ritz@gmx.ch>" | ||
51 | #define DRIVER_DESC "eGalax TouchKit USB HID Touchscreen Driver" | ||
52 | |||
53 | static int swap_xy; | ||
54 | module_param(swap_xy, bool, 0644); | ||
55 | MODULE_PARM_DESC(swap_xy, "If set X and Y axes are swapped."); | ||
56 | |||
57 | struct touchkit_usb { | ||
58 | unsigned char *data; | ||
59 | dma_addr_t data_dma; | ||
60 | char buffer[TOUCHKIT_REPORT_DATA_SIZE]; | ||
61 | int buf_len; | ||
62 | struct urb *irq; | ||
63 | struct usb_device *udev; | ||
64 | struct input_dev *input; | ||
65 | char name[128]; | ||
66 | char phys[64]; | ||
67 | }; | ||
68 | |||
69 | static struct usb_device_id touchkit_devices[] = { | ||
70 | {USB_DEVICE(0x3823, 0x0001)}, | ||
71 | {USB_DEVICE(0x0123, 0x0001)}, | ||
72 | {USB_DEVICE(0x0eef, 0x0001)}, | ||
73 | {USB_DEVICE(0x0eef, 0x0002)}, | ||
74 | {} | ||
75 | }; | ||
76 | |||
77 | /* helpers to read the data */ | ||
78 | static inline int touchkit_get_touched(char *data) | ||
79 | { | ||
80 | return (data[0] & TOUCHKIT_DOWN) ? 1 : 0; | ||
81 | } | ||
82 | |||
83 | static inline int touchkit_get_x(char *data) | ||
84 | { | ||
85 | return ((data[3] & 0x0F) << 7) | (data[4] & 0x7F); | ||
86 | } | ||
87 | |||
88 | static inline int touchkit_get_y(char *data) | ||
89 | { | ||
90 | return ((data[1] & 0x0F) << 7) | (data[2] & 0x7F); | ||
91 | } | ||
92 | |||
93 | |||
94 | /* processes one input packet. */ | ||
95 | static void touchkit_process_pkt(struct touchkit_usb *touchkit, char *pkt) | ||
96 | { | ||
97 | int x, y; | ||
98 | |||
99 | /* only process report packets */ | ||
100 | if ((pkt[0] & TOUCHKIT_PKT_TYPE_MASK) != TOUCHKIT_PKT_TYPE_REPT) | ||
101 | return; | ||
102 | |||
103 | if (swap_xy) { | ||
104 | y = touchkit_get_x(pkt); | ||
105 | x = touchkit_get_y(pkt); | ||
106 | } else { | ||
107 | x = touchkit_get_x(pkt); | ||
108 | y = touchkit_get_y(pkt); | ||
109 | } | ||
110 | |||
111 | input_report_key(touchkit->input, BTN_TOUCH, touchkit_get_touched(pkt)); | ||
112 | input_report_abs(touchkit->input, ABS_X, x); | ||
113 | input_report_abs(touchkit->input, ABS_Y, y); | ||
114 | input_sync(touchkit->input); | ||
115 | } | ||
116 | |||
117 | |||
118 | static int touchkit_get_pkt_len(char *buf) | ||
119 | { | ||
120 | switch (buf[0] & TOUCHKIT_PKT_TYPE_MASK) { | ||
121 | case TOUCHKIT_PKT_TYPE_REPT: | ||
122 | return 5; | ||
123 | |||
124 | case TOUCHKIT_PKT_TYPE_DIAG: | ||
125 | return buf[1] + 2; | ||
126 | } | ||
127 | |||
128 | return 0; | ||
129 | } | ||
130 | |||
131 | static void touchkit_process(struct touchkit_usb *touchkit, int len) | ||
132 | { | ||
133 | char *buffer; | ||
134 | int pkt_len, buf_len, pos; | ||
135 | |||
136 | /* if the buffer contains data, append */ | ||
137 | if (unlikely(touchkit->buf_len)) { | ||
138 | int tmp; | ||
139 | |||
140 | /* if only 1 byte in buffer, add another one to get length */ | ||
141 | if (touchkit->buf_len == 1) | ||
142 | touchkit->buffer[1] = touchkit->data[0]; | ||
143 | |||
144 | pkt_len = touchkit_get_pkt_len(touchkit->buffer); | ||
145 | |||
146 | /* unknown packet: drop everything */ | ||
147 | if (!pkt_len) | ||
148 | return; | ||
149 | |||
150 | /* append, process */ | ||
151 | tmp = pkt_len - touchkit->buf_len; | ||
152 | memcpy(touchkit->buffer + touchkit->buf_len, touchkit->data, tmp); | ||
153 | touchkit_process_pkt(touchkit, touchkit->buffer); | ||
154 | |||
155 | buffer = touchkit->data + tmp; | ||
156 | buf_len = len - tmp; | ||
157 | } else { | ||
158 | buffer = touchkit->data; | ||
159 | buf_len = len; | ||
160 | } | ||
161 | |||
162 | /* only one byte left in buffer */ | ||
163 | if (unlikely(buf_len == 1)) { | ||
164 | touchkit->buffer[0] = buffer[0]; | ||
165 | touchkit->buf_len = 1; | ||
166 | return; | ||
167 | } | ||
168 | |||
169 | /* loop over the buffer */ | ||
170 | pos = 0; | ||
171 | while (pos < buf_len) { | ||
172 | /* get packet len */ | ||
173 | pkt_len = touchkit_get_pkt_len(buffer + pos); | ||
174 | |||
175 | /* unknown packet: drop everything */ | ||
176 | if (unlikely(!pkt_len)) | ||
177 | return; | ||
178 | |||
179 | /* full packet: process */ | ||
180 | if (likely(pkt_len <= buf_len)) { | ||
181 | touchkit_process_pkt(touchkit, buffer + pos); | ||
182 | } else { | ||
183 | /* incomplete packet: save in buffer */ | ||
184 | memcpy(touchkit->buffer, buffer + pos, buf_len - pos); | ||
185 | touchkit->buf_len = buf_len - pos; | ||
186 | } | ||
187 | pos += pkt_len; | ||
188 | } | ||
189 | } | ||
190 | |||
191 | |||
192 | static void touchkit_irq(struct urb *urb) | ||
193 | { | ||
194 | struct touchkit_usb *touchkit = urb->context; | ||
195 | int retval; | ||
196 | |||
197 | switch (urb->status) { | ||
198 | case 0: | ||
199 | /* success */ | ||
200 | break; | ||
201 | case -ETIME: | ||
202 | /* this urb is timing out */ | ||
203 | dbg("%s - urb timed out - was the device unplugged?", | ||
204 | __FUNCTION__); | ||
205 | return; | ||
206 | case -ECONNRESET: | ||
207 | case -ENOENT: | ||
208 | case -ESHUTDOWN: | ||
209 | /* this urb is terminated, clean up */ | ||
210 | dbg("%s - urb shutting down with status: %d", | ||
211 | __FUNCTION__, urb->status); | ||
212 | return; | ||
213 | default: | ||
214 | dbg("%s - nonzero urb status received: %d", | ||
215 | __FUNCTION__, urb->status); | ||
216 | goto exit; | ||
217 | } | ||
218 | |||
219 | touchkit_process(touchkit, urb->actual_length); | ||
220 | |||
221 | exit: | ||
222 | retval = usb_submit_urb(urb, GFP_ATOMIC); | ||
223 | if (retval) | ||
224 | err("%s - usb_submit_urb failed with result: %d", | ||
225 | __FUNCTION__, retval); | ||
226 | } | ||
227 | |||
228 | static int touchkit_open(struct input_dev *input) | ||
229 | { | ||
230 | struct touchkit_usb *touchkit = input->private; | ||
231 | |||
232 | touchkit->irq->dev = touchkit->udev; | ||
233 | |||
234 | if (usb_submit_urb(touchkit->irq, GFP_ATOMIC)) | ||
235 | return -EIO; | ||
236 | |||
237 | return 0; | ||
238 | } | ||
239 | |||
240 | static void touchkit_close(struct input_dev *input) | ||
241 | { | ||
242 | struct touchkit_usb *touchkit = input->private; | ||
243 | |||
244 | usb_kill_urb(touchkit->irq); | ||
245 | } | ||
246 | |||
247 | static int touchkit_alloc_buffers(struct usb_device *udev, | ||
248 | struct touchkit_usb *touchkit) | ||
249 | { | ||
250 | touchkit->data = usb_buffer_alloc(udev, TOUCHKIT_REPORT_DATA_SIZE, | ||
251 | GFP_ATOMIC, &touchkit->data_dma); | ||
252 | |||
253 | if (!touchkit->data) | ||
254 | return -1; | ||
255 | |||
256 | return 0; | ||
257 | } | ||
258 | |||
259 | static void touchkit_free_buffers(struct usb_device *udev, | ||
260 | struct touchkit_usb *touchkit) | ||
261 | { | ||
262 | if (touchkit->data) | ||
263 | usb_buffer_free(udev, TOUCHKIT_REPORT_DATA_SIZE, | ||
264 | touchkit->data, touchkit->data_dma); | ||
265 | } | ||
266 | |||
267 | static int touchkit_probe(struct usb_interface *intf, | ||
268 | const struct usb_device_id *id) | ||
269 | { | ||
270 | struct touchkit_usb *touchkit; | ||
271 | struct input_dev *input_dev; | ||
272 | struct usb_host_interface *interface; | ||
273 | struct usb_endpoint_descriptor *endpoint; | ||
274 | struct usb_device *udev = interface_to_usbdev(intf); | ||
275 | |||
276 | interface = intf->cur_altsetting; | ||
277 | endpoint = &interface->endpoint[0].desc; | ||
278 | |||
279 | touchkit = kzalloc(sizeof(struct touchkit_usb), GFP_KERNEL); | ||
280 | input_dev = input_allocate_device(); | ||
281 | if (!touchkit || !input_dev) | ||
282 | goto out_free; | ||
283 | |||
284 | if (touchkit_alloc_buffers(udev, touchkit)) | ||
285 | goto out_free; | ||
286 | |||
287 | touchkit->irq = usb_alloc_urb(0, GFP_KERNEL); | ||
288 | if (!touchkit->irq) { | ||
289 | dbg("%s - usb_alloc_urb failed: touchkit->irq", __FUNCTION__); | ||
290 | goto out_free_buffers; | ||
291 | } | ||
292 | |||
293 | touchkit->udev = udev; | ||
294 | touchkit->input = input_dev; | ||
295 | |||
296 | if (udev->manufacturer) | ||
297 | strlcpy(touchkit->name, udev->manufacturer, sizeof(touchkit->name)); | ||
298 | |||
299 | if (udev->product) { | ||
300 | if (udev->manufacturer) | ||
301 | strlcat(touchkit->name, " ", sizeof(touchkit->name)); | ||
302 | strlcat(touchkit->name, udev->product, sizeof(touchkit->name)); | ||
303 | } | ||
304 | |||
305 | if (!strlen(touchkit->name)) | ||
306 | snprintf(touchkit->name, sizeof(touchkit->name), | ||
307 | "USB Touchscreen %04x:%04x", | ||
308 | le16_to_cpu(udev->descriptor.idVendor), | ||
309 | le16_to_cpu(udev->descriptor.idProduct)); | ||
310 | |||
311 | usb_make_path(udev, touchkit->phys, sizeof(touchkit->phys)); | ||
312 | strlcpy(touchkit->phys, "/input0", sizeof(touchkit->phys)); | ||
313 | |||
314 | input_dev->name = touchkit->name; | ||
315 | input_dev->phys = touchkit->phys; | ||
316 | usb_to_input_id(udev, &input_dev->id); | ||
317 | input_dev->cdev.dev = &intf->dev; | ||
318 | input_dev->private = touchkit; | ||
319 | input_dev->open = touchkit_open; | ||
320 | input_dev->close = touchkit_close; | ||
321 | |||
322 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | ||
323 | input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH); | ||
324 | input_set_abs_params(input_dev, ABS_X, TOUCHKIT_MIN_XC, TOUCHKIT_MAX_XC, | ||
325 | TOUCHKIT_XC_FUZZ, TOUCHKIT_XC_FLAT); | ||
326 | input_set_abs_params(input_dev, ABS_Y, TOUCHKIT_MIN_YC, TOUCHKIT_MAX_YC, | ||
327 | TOUCHKIT_YC_FUZZ, TOUCHKIT_YC_FLAT); | ||
328 | |||
329 | usb_fill_int_urb(touchkit->irq, touchkit->udev, | ||
330 | usb_rcvintpipe(touchkit->udev, 0x81), | ||
331 | touchkit->data, TOUCHKIT_REPORT_DATA_SIZE, | ||
332 | touchkit_irq, touchkit, endpoint->bInterval); | ||
333 | |||
334 | touchkit->irq->transfer_dma = touchkit->data_dma; | ||
335 | touchkit->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | ||
336 | |||
337 | input_register_device(touchkit->input); | ||
338 | |||
339 | usb_set_intfdata(intf, touchkit); | ||
340 | return 0; | ||
341 | |||
342 | out_free_buffers: | ||
343 | touchkit_free_buffers(udev, touchkit); | ||
344 | out_free: | ||
345 | input_free_device(input_dev); | ||
346 | kfree(touchkit); | ||
347 | return -ENOMEM; | ||
348 | } | ||
349 | |||
350 | static void touchkit_disconnect(struct usb_interface *intf) | ||
351 | { | ||
352 | struct touchkit_usb *touchkit = usb_get_intfdata(intf); | ||
353 | |||
354 | dbg("%s - called", __FUNCTION__); | ||
355 | |||
356 | if (!touchkit) | ||
357 | return; | ||
358 | |||
359 | dbg("%s - touchkit is initialized, cleaning up", __FUNCTION__); | ||
360 | usb_set_intfdata(intf, NULL); | ||
361 | usb_kill_urb(touchkit->irq); | ||
362 | input_unregister_device(touchkit->input); | ||
363 | usb_free_urb(touchkit->irq); | ||
364 | touchkit_free_buffers(interface_to_usbdev(intf), touchkit); | ||
365 | kfree(touchkit); | ||
366 | } | ||
367 | |||
368 | MODULE_DEVICE_TABLE(usb, touchkit_devices); | ||
369 | |||
370 | static struct usb_driver touchkit_driver = { | ||
371 | .name = "touchkitusb", | ||
372 | .probe = touchkit_probe, | ||
373 | .disconnect = touchkit_disconnect, | ||
374 | .id_table = touchkit_devices, | ||
375 | }; | ||
376 | |||
377 | static int __init touchkit_init(void) | ||
378 | { | ||
379 | return usb_register(&touchkit_driver); | ||
380 | } | ||
381 | |||
382 | static void __exit touchkit_cleanup(void) | ||
383 | { | ||
384 | usb_deregister(&touchkit_driver); | ||
385 | } | ||
386 | |||
387 | module_init(touchkit_init); | ||
388 | module_exit(touchkit_cleanup); | ||
389 | |||
390 | MODULE_AUTHOR(DRIVER_AUTHOR); | ||
391 | MODULE_DESCRIPTION(DRIVER_DESC); | ||
392 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/usb/input/usbtouchscreen.c b/drivers/usb/input/usbtouchscreen.c index 86e37a20f8e5..e0829413336b 100644 --- a/drivers/usb/input/usbtouchscreen.c +++ b/drivers/usb/input/usbtouchscreen.c | |||
@@ -647,7 +647,7 @@ exit: | |||
647 | 647 | ||
648 | static int usbtouch_open(struct input_dev *input) | 648 | static int usbtouch_open(struct input_dev *input) |
649 | { | 649 | { |
650 | struct usbtouch_usb *usbtouch = input->private; | 650 | struct usbtouch_usb *usbtouch = input_get_drvdata(input); |
651 | 651 | ||
652 | usbtouch->irq->dev = usbtouch->udev; | 652 | usbtouch->irq->dev = usbtouch->udev; |
653 | 653 | ||
@@ -659,7 +659,7 @@ static int usbtouch_open(struct input_dev *input) | |||
659 | 659 | ||
660 | static void usbtouch_close(struct input_dev *input) | 660 | static void usbtouch_close(struct input_dev *input) |
661 | { | 661 | { |
662 | struct usbtouch_usb *usbtouch = input->private; | 662 | struct usbtouch_usb *usbtouch = input_get_drvdata(input); |
663 | 663 | ||
664 | usb_kill_urb(usbtouch->irq); | 664 | usb_kill_urb(usbtouch->irq); |
665 | } | 665 | } |
@@ -740,8 +740,10 @@ static int usbtouch_probe(struct usb_interface *intf, | |||
740 | input_dev->name = usbtouch->name; | 740 | input_dev->name = usbtouch->name; |
741 | input_dev->phys = usbtouch->phys; | 741 | input_dev->phys = usbtouch->phys; |
742 | usb_to_input_id(udev, &input_dev->id); | 742 | usb_to_input_id(udev, &input_dev->id); |
743 | input_dev->cdev.dev = &intf->dev; | 743 | input_dev->dev.parent = &intf->dev; |
744 | input_dev->private = usbtouch; | 744 | |
745 | input_set_drvdata(input_dev, usbtouch); | ||
746 | |||
745 | input_dev->open = usbtouch_open; | 747 | input_dev->open = usbtouch_open; |
746 | input_dev->close = usbtouch_close; | 748 | input_dev->close = usbtouch_close; |
747 | 749 | ||
diff --git a/drivers/usb/input/wacom_sys.c b/drivers/usb/input/wacom_sys.c index 12b42746ded8..1fe48208c2f4 100644 --- a/drivers/usb/input/wacom_sys.c +++ b/drivers/usb/input/wacom_sys.c | |||
@@ -122,7 +122,7 @@ void wacom_input_sync(void *wcombo) | |||
122 | 122 | ||
123 | static int wacom_open(struct input_dev *dev) | 123 | static int wacom_open(struct input_dev *dev) |
124 | { | 124 | { |
125 | struct wacom *wacom = dev->private; | 125 | struct wacom *wacom = input_get_drvdata(dev); |
126 | 126 | ||
127 | wacom->irq->dev = wacom->usbdev; | 127 | wacom->irq->dev = wacom->usbdev; |
128 | if (usb_submit_urb(wacom->irq, GFP_KERNEL)) | 128 | if (usb_submit_urb(wacom->irq, GFP_KERNEL)) |
@@ -133,7 +133,7 @@ static int wacom_open(struct input_dev *dev) | |||
133 | 133 | ||
134 | static void wacom_close(struct input_dev *dev) | 134 | static void wacom_close(struct input_dev *dev) |
135 | { | 135 | { |
136 | struct wacom *wacom = dev->private; | 136 | struct wacom *wacom = input_get_drvdata(dev); |
137 | 137 | ||
138 | usb_kill_urb(wacom->irq); | 138 | usb_kill_urb(wacom->irq); |
139 | } | 139 | } |
@@ -201,6 +201,7 @@ static int wacom_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
201 | struct wacom *wacom; | 201 | struct wacom *wacom; |
202 | struct wacom_wac *wacom_wac; | 202 | struct wacom_wac *wacom_wac; |
203 | struct input_dev *input_dev; | 203 | struct input_dev *input_dev; |
204 | int error = -ENOMEM; | ||
204 | char rep_data[2], limit = 0; | 205 | char rep_data[2], limit = 0; |
205 | 206 | ||
206 | wacom = kzalloc(sizeof(struct wacom), GFP_KERNEL); | 207 | wacom = kzalloc(sizeof(struct wacom), GFP_KERNEL); |
@@ -229,8 +230,10 @@ static int wacom_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
229 | wacom->wacom_wac = wacom_wac; | 230 | wacom->wacom_wac = wacom_wac; |
230 | usb_to_input_id(dev, &input_dev->id); | 231 | usb_to_input_id(dev, &input_dev->id); |
231 | 232 | ||
232 | input_dev->cdev.dev = &intf->dev; | 233 | input_dev->dev.parent = &intf->dev; |
233 | input_dev->private = wacom; | 234 | |
235 | input_set_drvdata(input_dev, wacom); | ||
236 | |||
234 | input_dev->open = wacom_open; | 237 | input_dev->open = wacom_open; |
235 | input_dev->close = wacom_close; | 238 | input_dev->close = wacom_close; |
236 | 239 | ||
@@ -252,7 +255,9 @@ static int wacom_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
252 | wacom->irq->transfer_dma = wacom->data_dma; | 255 | wacom->irq->transfer_dma = wacom->data_dma; |
253 | wacom->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 256 | wacom->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; |
254 | 257 | ||
255 | input_register_device(wacom->dev); | 258 | error = input_register_device(wacom->dev); |
259 | if (error) | ||
260 | goto fail3; | ||
256 | 261 | ||
257 | /* Ask the tablet to report tablet data. Repeat until it succeeds */ | 262 | /* Ask the tablet to report tablet data. Repeat until it succeeds */ |
258 | do { | 263 | do { |
@@ -265,11 +270,12 @@ static int wacom_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
265 | usb_set_intfdata(intf, wacom); | 270 | usb_set_intfdata(intf, wacom); |
266 | return 0; | 271 | return 0; |
267 | 272 | ||
268 | fail2: usb_buffer_free(dev, 10, wacom_wac->data, wacom->data_dma); | 273 | fail3: usb_free_urb(wacom->irq); |
269 | fail1: input_free_device(input_dev); | 274 | fail2: usb_buffer_free(dev, 10, wacom_wac->data, wacom->data_dma); |
275 | fail1: input_free_device(input_dev); | ||
270 | kfree(wacom); | 276 | kfree(wacom); |
271 | kfree(wacom_wac); | 277 | kfree(wacom_wac); |
272 | return -ENOMEM; | 278 | return error; |
273 | } | 279 | } |
274 | 280 | ||
275 | static void wacom_disconnect(struct usb_interface *intf) | 281 | static void wacom_disconnect(struct usb_interface *intf) |
diff --git a/drivers/usb/input/xpad.c b/drivers/usb/input/xpad.c index e4bc76ebc835..735723912950 100644 --- a/drivers/usb/input/xpad.c +++ b/drivers/usb/input/xpad.c | |||
@@ -267,7 +267,7 @@ exit: | |||
267 | 267 | ||
268 | static int xpad_open (struct input_dev *dev) | 268 | static int xpad_open (struct input_dev *dev) |
269 | { | 269 | { |
270 | struct usb_xpad *xpad = dev->private; | 270 | struct usb_xpad *xpad = input_get_drvdata(dev); |
271 | 271 | ||
272 | xpad->irq_in->dev = xpad->udev; | 272 | xpad->irq_in->dev = xpad->udev; |
273 | if (usb_submit_urb(xpad->irq_in, GFP_KERNEL)) | 273 | if (usb_submit_urb(xpad->irq_in, GFP_KERNEL)) |
@@ -278,7 +278,7 @@ static int xpad_open (struct input_dev *dev) | |||
278 | 278 | ||
279 | static void xpad_close (struct input_dev *dev) | 279 | static void xpad_close (struct input_dev *dev) |
280 | { | 280 | { |
281 | struct usb_xpad *xpad = dev->private; | 281 | struct usb_xpad *xpad = input_get_drvdata(dev); |
282 | 282 | ||
283 | usb_kill_urb(xpad->irq_in); | 283 | usb_kill_urb(xpad->irq_in); |
284 | } | 284 | } |
@@ -312,6 +312,7 @@ static int xpad_probe(struct usb_interface *intf, const struct usb_device_id *id | |||
312 | struct input_dev *input_dev; | 312 | struct input_dev *input_dev; |
313 | struct usb_endpoint_descriptor *ep_irq_in; | 313 | struct usb_endpoint_descriptor *ep_irq_in; |
314 | int i; | 314 | int i; |
315 | int error = -ENOMEM; | ||
315 | 316 | ||
316 | for (i = 0; xpad_device[i].idVendor; i++) { | 317 | for (i = 0; xpad_device[i].idVendor; i++) { |
317 | if ((le16_to_cpu(udev->descriptor.idVendor) == xpad_device[i].idVendor) && | 318 | if ((le16_to_cpu(udev->descriptor.idVendor) == xpad_device[i].idVendor) && |
@@ -344,8 +345,10 @@ static int xpad_probe(struct usb_interface *intf, const struct usb_device_id *id | |||
344 | input_dev->name = xpad_device[i].name; | 345 | input_dev->name = xpad_device[i].name; |
345 | input_dev->phys = xpad->phys; | 346 | input_dev->phys = xpad->phys; |
346 | usb_to_input_id(udev, &input_dev->id); | 347 | usb_to_input_id(udev, &input_dev->id); |
347 | input_dev->cdev.dev = &intf->dev; | 348 | input_dev->dev.parent = &intf->dev; |
348 | input_dev->private = xpad; | 349 | |
350 | input_set_drvdata(input_dev, xpad); | ||
351 | |||
349 | input_dev->open = xpad_open; | 352 | input_dev->open = xpad_open; |
350 | input_dev->close = xpad_close; | 353 | input_dev->close = xpad_close; |
351 | 354 | ||
@@ -373,15 +376,18 @@ static int xpad_probe(struct usb_interface *intf, const struct usb_device_id *id | |||
373 | xpad->irq_in->transfer_dma = xpad->idata_dma; | 376 | xpad->irq_in->transfer_dma = xpad->idata_dma; |
374 | xpad->irq_in->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 377 | xpad->irq_in->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; |
375 | 378 | ||
376 | input_register_device(xpad->dev); | 379 | error = input_register_device(xpad->dev); |
380 | if (error) | ||
381 | goto fail3; | ||
377 | 382 | ||
378 | usb_set_intfdata(intf, xpad); | 383 | usb_set_intfdata(intf, xpad); |
379 | return 0; | 384 | return 0; |
380 | 385 | ||
381 | fail2: usb_buffer_free(udev, XPAD_PKT_LEN, xpad->idata, xpad->idata_dma); | 386 | fail3: usb_free_urb(xpad->irq_in); |
382 | fail1: input_free_device(input_dev); | 387 | fail2: usb_buffer_free(udev, XPAD_PKT_LEN, xpad->idata, xpad->idata_dma); |
388 | fail1: input_free_device(input_dev); | ||
383 | kfree(xpad); | 389 | kfree(xpad); |
384 | return -ENOMEM; | 390 | return error; |
385 | 391 | ||
386 | } | 392 | } |
387 | 393 | ||
diff --git a/drivers/usb/input/yealink.c b/drivers/usb/input/yealink.c index caff8e6d7448..c54f1a5dcb4a 100644 --- a/drivers/usb/input/yealink.c +++ b/drivers/usb/input/yealink.c | |||
@@ -502,7 +502,7 @@ static int input_ev(struct input_dev *dev, unsigned int type, | |||
502 | 502 | ||
503 | static int input_open(struct input_dev *dev) | 503 | static int input_open(struct input_dev *dev) |
504 | { | 504 | { |
505 | struct yealink_dev *yld = dev->private; | 505 | struct yealink_dev *yld = input_get_drvdata(dev); |
506 | int i, ret; | 506 | int i, ret; |
507 | 507 | ||
508 | dbg("%s", __FUNCTION__); | 508 | dbg("%s", __FUNCTION__); |
@@ -529,7 +529,7 @@ static int input_open(struct input_dev *dev) | |||
529 | 529 | ||
530 | static void input_close(struct input_dev *dev) | 530 | static void input_close(struct input_dev *dev) |
531 | { | 531 | { |
532 | struct yealink_dev *yld = dev->private; | 532 | struct yealink_dev *yld = input_get_drvdata(dev); |
533 | 533 | ||
534 | usb_kill_urb(yld->urb_ctl); | 534 | usb_kill_urb(yld->urb_ctl); |
535 | usb_kill_urb(yld->urb_irq); | 535 | usb_kill_urb(yld->urb_irq); |
@@ -937,9 +937,10 @@ static int usb_probe(struct usb_interface *intf, const struct usb_device_id *id) | |||
937 | input_dev->name = nfo->name; | 937 | input_dev->name = nfo->name; |
938 | input_dev->phys = yld->phys; | 938 | input_dev->phys = yld->phys; |
939 | usb_to_input_id(udev, &input_dev->id); | 939 | usb_to_input_id(udev, &input_dev->id); |
940 | input_dev->cdev.dev = &intf->dev; | 940 | input_dev->dev.parent = &intf->dev; |
941 | |||
942 | input_set_drvdata(input_dev, yld); | ||
941 | 943 | ||
942 | input_dev->private = yld; | ||
943 | input_dev->open = input_open; | 944 | input_dev->open = input_open; |
944 | input_dev->close = input_close; | 945 | input_dev->close = input_close; |
945 | /* input_dev->event = input_ev; TODO */ | 946 | /* input_dev->event = input_ev; TODO */ |
@@ -955,7 +956,9 @@ static int usb_probe(struct usb_interface *intf, const struct usb_device_id *id) | |||
955 | } | 956 | } |
956 | } | 957 | } |
957 | 958 | ||
958 | input_register_device(yld->idev); | 959 | ret = input_register_device(yld->idev); |
960 | if (ret) | ||
961 | return usb_cleanup(yld, ret); | ||
959 | 962 | ||
960 | usb_set_intfdata(intf, yld); | 963 | usb_set_intfdata(intf, yld); |
961 | 964 | ||
diff --git a/include/asm-arm/arch-pxa/pxa27x_keyboard.h b/include/asm-arm/arch-pxa/pxa27x_keyboard.h new file mode 100644 index 000000000000..3aaff923b2ca --- /dev/null +++ b/include/asm-arm/arch-pxa/pxa27x_keyboard.h | |||
@@ -0,0 +1,13 @@ | |||
1 | #define PXAKBD_MAXROW 8 | ||
2 | #define PXAKBD_MAXCOL 8 | ||
3 | |||
4 | struct pxa27x_keyboard_platform_data { | ||
5 | int nr_rows, nr_cols; | ||
6 | int keycodes[PXAKBD_MAXROW][PXAKBD_MAXCOL]; | ||
7 | int gpio_modes[PXAKBD_MAXROW + PXAKBD_MAXCOL]; | ||
8 | |||
9 | #ifdef CONFIG_PM | ||
10 | u32 reg_kpc; | ||
11 | u32 reg_kprec; | ||
12 | #endif | ||
13 | }; | ||
diff --git a/include/linux/gpio_keys.h b/include/linux/gpio_keys.h index 2b217c7b9312..265d17830a0f 100644 --- a/include/linux/gpio_keys.h +++ b/include/linux/gpio_keys.h | |||
@@ -3,10 +3,11 @@ | |||
3 | 3 | ||
4 | struct gpio_keys_button { | 4 | struct gpio_keys_button { |
5 | /* Configuration parameters */ | 5 | /* Configuration parameters */ |
6 | int keycode; | 6 | int code; /* input event code (KEY_*, SW_*) */ |
7 | int gpio; | 7 | int gpio; |
8 | int active_low; | 8 | int active_low; |
9 | char *desc; | 9 | char *desc; |
10 | int type; /* input event type (EV_KEY, EV_SW) */ | ||
10 | }; | 11 | }; |
11 | 12 | ||
12 | struct gpio_keys_platform_data { | 13 | struct gpio_keys_platform_data { |
diff --git a/include/linux/hp_sdc.h b/include/linux/hp_sdc.h index debd71515312..9db3d454887f 100644 --- a/include/linux/hp_sdc.h +++ b/include/linux/hp_sdc.h | |||
@@ -71,6 +71,7 @@ typedef struct { | |||
71 | struct semaphore *semaphore; /* Semaphore to sleep on. */ | 71 | struct semaphore *semaphore; /* Semaphore to sleep on. */ |
72 | } act; | 72 | } act; |
73 | } hp_sdc_transaction; | 73 | } hp_sdc_transaction; |
74 | int __hp_sdc_enqueue_transaction(hp_sdc_transaction *this); | ||
74 | int hp_sdc_enqueue_transaction(hp_sdc_transaction *this); | 75 | int hp_sdc_enqueue_transaction(hp_sdc_transaction *this); |
75 | int hp_sdc_dequeue_transaction(hp_sdc_transaction *this); | 76 | int hp_sdc_dequeue_transaction(hp_sdc_transaction *this); |
76 | 77 | ||
diff --git a/include/linux/input-polldev.h b/include/linux/input-polldev.h new file mode 100644 index 000000000000..597a0077b3c5 --- /dev/null +++ b/include/linux/input-polldev.h | |||
@@ -0,0 +1,46 @@ | |||
1 | #ifndef _INPUT_POLLDEV_H | ||
2 | #define _INPUT_POLLDEV_H | ||
3 | |||
4 | /* | ||
5 | * Copyright (c) 2007 Dmitry Torokhov | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or modify it | ||
8 | * under the terms of the GNU General Public License version 2 as published by | ||
9 | * the Free Software Foundation. | ||
10 | */ | ||
11 | |||
12 | #include <linux/input.h> | ||
13 | #include <linux/workqueue.h> | ||
14 | |||
15 | /** | ||
16 | * struct input_polled_dev - simple polled input device | ||
17 | * @private: private driver data | ||
18 | * @flush: driver-supplied method that flushes device's state upon | ||
19 | * opening (optional) | ||
20 | * @poll: driver-supplied method that polls the device and posts | ||
21 | * input events (mandatory). | ||
22 | * @poll_interval: specifies how often the poll() method shoudl be called. | ||
23 | * @input: input device structire associated with the polled device. | ||
24 | * Must be properly initialized by the driver (id, name, phys, bits). | ||
25 | * | ||
26 | * Polled input device provides a skeleton for supporting simple input | ||
27 | * devices that do not raise interrupts but have to be periodically | ||
28 | * scanned or polled to detect changes in their state. | ||
29 | */ | ||
30 | struct input_polled_dev { | ||
31 | void *private; | ||
32 | |||
33 | void (*flush)(struct input_polled_dev *dev); | ||
34 | void (*poll)(struct input_polled_dev *dev); | ||
35 | unsigned int poll_interval; /* msec */ | ||
36 | |||
37 | struct input_dev *input; | ||
38 | struct delayed_work work; | ||
39 | }; | ||
40 | |||
41 | struct input_polled_dev *input_allocate_polled_device(void); | ||
42 | void input_free_polled_device(struct input_polled_dev *dev); | ||
43 | int input_register_polled_device(struct input_polled_dev *dev); | ||
44 | void input_unregister_polled_device(struct input_polled_dev *dev); | ||
45 | |||
46 | #endif | ||
diff --git a/include/linux/input.h b/include/linux/input.h index 327122548c4d..439954d09752 100644 --- a/include/linux/input.h +++ b/include/linux/input.h | |||
@@ -506,6 +506,7 @@ struct input_absinfo { | |||
506 | #define KEY_VOICEMAIL 0x1ac | 506 | #define KEY_VOICEMAIL 0x1ac |
507 | #define KEY_ADDRESSBOOK 0x1ad | 507 | #define KEY_ADDRESSBOOK 0x1ad |
508 | #define KEY_MESSENGER 0x1ae | 508 | #define KEY_MESSENGER 0x1ae |
509 | #define KEY_DISPLAYTOGGLE 0x1af /* Turn display (LCD) on and off */ | ||
509 | 510 | ||
510 | #define KEY_DEL_EOL 0x1c0 | 511 | #define KEY_DEL_EOL 0x1c0 |
511 | #define KEY_DEL_EOS 0x1c1 | 512 | #define KEY_DEL_EOS 0x1c1 |
@@ -914,33 +915,6 @@ struct ff_effect { | |||
914 | #define BIT(x) (1UL<<((x)%BITS_PER_LONG)) | 915 | #define BIT(x) (1UL<<((x)%BITS_PER_LONG)) |
915 | #define LONG(x) ((x)/BITS_PER_LONG) | 916 | #define LONG(x) ((x)/BITS_PER_LONG) |
916 | 917 | ||
917 | #define INPUT_KEYCODE(dev, scancode) ((dev->keycodesize == 1) ? ((u8*)dev->keycode)[scancode] : \ | ||
918 | ((dev->keycodesize == 2) ? ((u16*)dev->keycode)[scancode] : (((u32*)dev->keycode)[scancode]))) | ||
919 | |||
920 | #define SET_INPUT_KEYCODE(dev, scancode, val) \ | ||
921 | ({ unsigned __old; \ | ||
922 | switch (dev->keycodesize) { \ | ||
923 | case 1: { \ | ||
924 | u8 *k = (u8 *)dev->keycode; \ | ||
925 | __old = k[scancode]; \ | ||
926 | k[scancode] = val; \ | ||
927 | break; \ | ||
928 | } \ | ||
929 | case 2: { \ | ||
930 | u16 *k = (u16 *)dev->keycode; \ | ||
931 | __old = k[scancode]; \ | ||
932 | k[scancode] = val; \ | ||
933 | break; \ | ||
934 | } \ | ||
935 | default: { \ | ||
936 | u32 *k = (u32 *)dev->keycode; \ | ||
937 | __old = k[scancode]; \ | ||
938 | k[scancode] = val; \ | ||
939 | break; \ | ||
940 | } \ | ||
941 | } \ | ||
942 | __old; }) | ||
943 | |||
944 | struct input_dev { | 918 | struct input_dev { |
945 | 919 | ||
946 | void *private; | 920 | void *private; |
@@ -963,6 +937,8 @@ struct input_dev { | |||
963 | unsigned int keycodemax; | 937 | unsigned int keycodemax; |
964 | unsigned int keycodesize; | 938 | unsigned int keycodesize; |
965 | void *keycode; | 939 | void *keycode; |
940 | int (*setkeycode)(struct input_dev *dev, int scancode, int keycode); | ||
941 | int (*getkeycode)(struct input_dev *dev, int scancode, int *keycode); | ||
966 | 942 | ||
967 | struct ff_device *ff; | 943 | struct ff_device *ff; |
968 | 944 | ||
@@ -997,6 +973,9 @@ struct input_dev { | |||
997 | unsigned int users; | 973 | unsigned int users; |
998 | 974 | ||
999 | struct class_device cdev; | 975 | struct class_device cdev; |
976 | union { /* temporarily so while we switching to struct device */ | ||
977 | struct device *parent; | ||
978 | } dev; | ||
1000 | 979 | ||
1001 | struct list_head h_list; | 980 | struct list_head h_list; |
1002 | struct list_head node; | 981 | struct list_head node; |
@@ -1075,7 +1054,7 @@ struct input_handler { | |||
1075 | void *private; | 1054 | void *private; |
1076 | 1055 | ||
1077 | void (*event)(struct input_handle *handle, unsigned int type, unsigned int code, int value); | 1056 | void (*event)(struct input_handle *handle, unsigned int type, unsigned int code, int value); |
1078 | struct input_handle* (*connect)(struct input_handler *handler, struct input_dev *dev, const struct input_device_id *id); | 1057 | int (*connect)(struct input_handler *handler, struct input_dev *dev, const struct input_device_id *id); |
1079 | void (*disconnect)(struct input_handle *handle); | 1058 | void (*disconnect)(struct input_handle *handle); |
1080 | void (*start)(struct input_handle *handle); | 1059 | void (*start)(struct input_handle *handle); |
1081 | 1060 | ||
@@ -1105,7 +1084,7 @@ struct input_handle { | |||
1105 | }; | 1084 | }; |
1106 | 1085 | ||
1107 | #define to_dev(n) container_of(n,struct input_dev,node) | 1086 | #define to_dev(n) container_of(n,struct input_dev,node) |
1108 | #define to_handler(n) container_of(n,struct input_handler,node); | 1087 | #define to_handler(n) container_of(n,struct input_handler,node) |
1109 | #define to_handle(n) container_of(n,struct input_handle,d_node) | 1088 | #define to_handle(n) container_of(n,struct input_handle,d_node) |
1110 | #define to_handle_h(n) container_of(n,struct input_handle,h_node) | 1089 | #define to_handle_h(n) container_of(n,struct input_handle,h_node) |
1111 | 1090 | ||
@@ -1122,12 +1101,25 @@ static inline void input_put_device(struct input_dev *dev) | |||
1122 | class_device_put(&dev->cdev); | 1101 | class_device_put(&dev->cdev); |
1123 | } | 1102 | } |
1124 | 1103 | ||
1104 | static inline void *input_get_drvdata(struct input_dev *dev) | ||
1105 | { | ||
1106 | return dev->private; | ||
1107 | } | ||
1108 | |||
1109 | static inline void input_set_drvdata(struct input_dev *dev, void *data) | ||
1110 | { | ||
1111 | dev->private = data; | ||
1112 | } | ||
1113 | |||
1125 | int input_register_device(struct input_dev *); | 1114 | int input_register_device(struct input_dev *); |
1126 | void input_unregister_device(struct input_dev *); | 1115 | void input_unregister_device(struct input_dev *); |
1127 | 1116 | ||
1128 | int input_register_handler(struct input_handler *); | 1117 | int input_register_handler(struct input_handler *); |
1129 | void input_unregister_handler(struct input_handler *); | 1118 | void input_unregister_handler(struct input_handler *); |
1130 | 1119 | ||
1120 | int input_register_handle(struct input_handle *); | ||
1121 | void input_unregister_handle(struct input_handle *); | ||
1122 | |||
1131 | int input_grab_device(struct input_handle *); | 1123 | int input_grab_device(struct input_handle *); |
1132 | void input_release_device(struct input_handle *); | 1124 | void input_release_device(struct input_handle *); |
1133 | 1125 | ||
@@ -1169,6 +1161,8 @@ static inline void input_sync(struct input_dev *dev) | |||
1169 | input_event(dev, EV_SYN, SYN_REPORT, 0); | 1161 | input_event(dev, EV_SYN, SYN_REPORT, 0); |
1170 | } | 1162 | } |
1171 | 1163 | ||
1164 | void input_set_capability(struct input_dev *dev, unsigned int type, unsigned int code); | ||
1165 | |||
1172 | static inline void input_set_abs_params(struct input_dev *dev, int axis, int min, int max, int fuzz, int flat) | 1166 | static inline void input_set_abs_params(struct input_dev *dev, int axis, int min, int max, int fuzz, int flat) |
1173 | { | 1167 | { |
1174 | dev->absmin[axis] = min; | 1168 | dev->absmin[axis] = min; |