]>
Commit | Line | Data |
---|---|---|
c04148f9 AH |
1 | /* |
2 | * Driver for the VoIP USB phones with CM109 chipsets. | |
3 | * | |
4 | * Copyright (C) 2007 - 2008 Alfred E. Heggestad <aeh@db.org> | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or | |
7 | * modify it under the terms of the GNU General Public License as | |
8 | * published by the Free Software Foundation, version 2. | |
9 | */ | |
10 | ||
11 | /* | |
12 | * Tested devices: | |
13 | * - Komunikate KIP1000 | |
14 | * - Genius G-talk | |
15 | * - Allied-Telesis Corega USBPH01 | |
16 | * - ... | |
17 | * | |
18 | * This driver is based on the yealink.c driver | |
19 | * | |
20 | * Thanks to: | |
21 | * - Authors of yealink.c | |
22 | * - Thomas Reitmayr | |
23 | * - Oliver Neukum for good review comments and code | |
24 | * - Shaun Jackman <sjackman@gmail.com> for Genius G-talk keymap | |
25 | * - Dmitry Torokhov for valuable input and review | |
26 | * | |
27 | * Todo: | |
28 | * - Read/write EEPROM | |
29 | */ | |
30 | ||
31 | #include <linux/kernel.h> | |
32 | #include <linux/init.h> | |
33 | #include <linux/slab.h> | |
34 | #include <linux/module.h> | |
35 | #include <linux/moduleparam.h> | |
36 | #include <linux/rwsem.h> | |
37 | #include <linux/usb/input.h> | |
38 | ||
c04148f9 AH |
39 | #define DRIVER_VERSION "20080805" |
40 | #define DRIVER_AUTHOR "Alfred E. Heggestad" | |
41 | #define DRIVER_DESC "CM109 phone driver" | |
42 | ||
43 | static char *phone = "kip1000"; | |
44 | module_param(phone, charp, S_IRUSR); | |
734f0bae | 45 | MODULE_PARM_DESC(phone, "Phone name {kip1000, gtalk, usbph01, atcom}"); |
c04148f9 AH |
46 | |
47 | enum { | |
48 | /* HID Registers */ | |
49 | HID_IR0 = 0x00, /* Record/Playback-mute button, Volume up/down */ | |
50 | HID_IR1 = 0x01, /* GPI, generic registers or EEPROM_DATA0 */ | |
51 | HID_IR2 = 0x02, /* Generic registers or EEPROM_DATA1 */ | |
52 | HID_IR3 = 0x03, /* Generic registers or EEPROM_CTRL */ | |
53 | HID_OR0 = 0x00, /* Mapping control, buzzer, SPDIF (offset 0x04) */ | |
54 | HID_OR1 = 0x01, /* GPO - General Purpose Output */ | |
55 | HID_OR2 = 0x02, /* Set GPIO to input/output mode */ | |
56 | HID_OR3 = 0x03, /* SPDIF status channel or EEPROM_CTRL */ | |
57 | ||
58 | /* HID_IR0 */ | |
59 | RECORD_MUTE = 1 << 3, | |
60 | PLAYBACK_MUTE = 1 << 2, | |
61 | VOLUME_DOWN = 1 << 1, | |
62 | VOLUME_UP = 1 << 0, | |
63 | ||
64 | /* HID_OR0 */ | |
65 | /* bits 7-6 | |
66 | 0: HID_OR1-2 are used for GPO; HID_OR0, 3 are used for buzzer | |
67 | and SPDIF | |
68 | 1: HID_OR0-3 are used as generic HID registers | |
69 | 2: Values written to HID_OR0-3 are also mapped to MCU_CTRL, | |
70 | EEPROM_DATA0-1, EEPROM_CTRL (see Note) | |
71 | 3: Reserved | |
72 | */ | |
73 | HID_OR_GPO_BUZ_SPDIF = 0 << 6, | |
74 | HID_OR_GENERIC_HID_REG = 1 << 6, | |
75 | HID_OR_MAP_MCU_EEPROM = 2 << 6, | |
76 | ||
77 | BUZZER_ON = 1 << 5, | |
78 | ||
79 | /* up to 256 normal keys, up to 16 special keys */ | |
80 | KEYMAP_SIZE = 256 + 16, | |
81 | }; | |
82 | ||
83 | /* CM109 protocol packet */ | |
84 | struct cm109_ctl_packet { | |
85 | u8 byte[4]; | |
86 | } __attribute__ ((packed)); | |
87 | ||
88 | enum { USB_PKT_LEN = sizeof(struct cm109_ctl_packet) }; | |
89 | ||
90 | /* CM109 device structure */ | |
91 | struct cm109_dev { | |
92 | struct input_dev *idev; /* input device */ | |
93 | struct usb_device *udev; /* usb device */ | |
94 | struct usb_interface *intf; | |
95 | ||
96 | /* irq input channel */ | |
97 | struct cm109_ctl_packet *irq_data; | |
98 | dma_addr_t irq_dma; | |
99 | struct urb *urb_irq; | |
100 | ||
101 | /* control output channel */ | |
102 | struct cm109_ctl_packet *ctl_data; | |
103 | dma_addr_t ctl_dma; | |
104 | struct usb_ctrlrequest *ctl_req; | |
c04148f9 AH |
105 | struct urb *urb_ctl; |
106 | /* | |
107 | * The 3 bitfields below are protected by ctl_submit_lock. | |
108 | * They have to be separate since they are accessed from IRQ | |
109 | * context. | |
110 | */ | |
111 | unsigned irq_urb_pending:1; /* irq_urb is in flight */ | |
112 | unsigned ctl_urb_pending:1; /* ctl_urb is in flight */ | |
113 | unsigned buzzer_pending:1; /* need to issue buzz command */ | |
114 | spinlock_t ctl_submit_lock; | |
115 | ||
116 | unsigned char buzzer_state; /* on/off */ | |
117 | ||
118 | /* flags */ | |
119 | unsigned open:1; | |
120 | unsigned resetting:1; | |
121 | unsigned shutdown:1; | |
122 | ||
123 | /* This mutex protects writes to the above flags */ | |
124 | struct mutex pm_mutex; | |
125 | ||
126 | unsigned short keymap[KEYMAP_SIZE]; | |
127 | ||
128 | char phys[64]; /* physical device path */ | |
129 | int key_code; /* last reported key */ | |
130 | int keybit; /* 0=new scan 1,2,4,8=scan columns */ | |
131 | u8 gpi; /* Cached value of GPI (high nibble) */ | |
132 | }; | |
133 | ||
134 | /****************************************************************************** | |
135 | * CM109 key interface | |
136 | *****************************************************************************/ | |
137 | ||
138 | static unsigned short special_keymap(int code) | |
139 | { | |
140 | if (code > 0xff) { | |
141 | switch (code - 0xff) { | |
142 | case RECORD_MUTE: return KEY_MUTE; | |
143 | case PLAYBACK_MUTE: return KEY_MUTE; | |
144 | case VOLUME_DOWN: return KEY_VOLUMEDOWN; | |
145 | case VOLUME_UP: return KEY_VOLUMEUP; | |
146 | } | |
147 | } | |
148 | return KEY_RESERVED; | |
149 | } | |
150 | ||
151 | /* Map device buttons to internal key events. | |
152 | * | |
153 | * The "up" and "down" keys, are symbolised by arrows on the button. | |
154 | * The "pickup" and "hangup" keys are symbolised by a green and red phone | |
155 | * on the button. | |
156 | ||
157 | Komunikate KIP1000 Keyboard Matrix | |
158 | ||
159 | -> -- 1 -- 2 -- 3 --> GPI pin 4 (0x10) | |
160 | | | | | | |
161 | <- -- 4 -- 5 -- 6 --> GPI pin 5 (0x20) | |
162 | | | | | | |
163 | END - 7 -- 8 -- 9 --> GPI pin 6 (0x40) | |
164 | | | | | | |
165 | OK -- * -- 0 -- # --> GPI pin 7 (0x80) | |
166 | | | | | | |
167 | ||
168 | /|\ /|\ /|\ /|\ | |
169 | | | | | | |
170 | GPO | |
171 | pin: 3 2 1 0 | |
172 | 0x8 0x4 0x2 0x1 | |
173 | ||
174 | */ | |
175 | static unsigned short keymap_kip1000(int scancode) | |
176 | { | |
177 | switch (scancode) { /* phone key: */ | |
178 | case 0x82: return KEY_NUMERIC_0; /* 0 */ | |
179 | case 0x14: return KEY_NUMERIC_1; /* 1 */ | |
180 | case 0x12: return KEY_NUMERIC_2; /* 2 */ | |
181 | case 0x11: return KEY_NUMERIC_3; /* 3 */ | |
182 | case 0x24: return KEY_NUMERIC_4; /* 4 */ | |
183 | case 0x22: return KEY_NUMERIC_5; /* 5 */ | |
184 | case 0x21: return KEY_NUMERIC_6; /* 6 */ | |
185 | case 0x44: return KEY_NUMERIC_7; /* 7 */ | |
186 | case 0x42: return KEY_NUMERIC_8; /* 8 */ | |
187 | case 0x41: return KEY_NUMERIC_9; /* 9 */ | |
188 | case 0x81: return KEY_NUMERIC_POUND; /* # */ | |
189 | case 0x84: return KEY_NUMERIC_STAR; /* * */ | |
190 | case 0x88: return KEY_ENTER; /* pickup */ | |
191 | case 0x48: return KEY_ESC; /* hangup */ | |
192 | case 0x28: return KEY_LEFT; /* IN */ | |
193 | case 0x18: return KEY_RIGHT; /* OUT */ | |
194 | default: return special_keymap(scancode); | |
195 | } | |
196 | } | |
197 | ||
198 | /* | |
199 | Contributed by Shaun Jackman <sjackman@gmail.com> | |
200 | ||
201 | Genius G-Talk keyboard matrix | |
202 | 0 1 2 3 | |
203 | 4: 0 4 8 Talk | |
204 | 5: 1 5 9 End | |
205 | 6: 2 6 # Up | |
206 | 7: 3 7 * Down | |
207 | */ | |
208 | static unsigned short keymap_gtalk(int scancode) | |
209 | { | |
210 | switch (scancode) { | |
211 | case 0x11: return KEY_NUMERIC_0; | |
212 | case 0x21: return KEY_NUMERIC_1; | |
213 | case 0x41: return KEY_NUMERIC_2; | |
214 | case 0x81: return KEY_NUMERIC_3; | |
215 | case 0x12: return KEY_NUMERIC_4; | |
216 | case 0x22: return KEY_NUMERIC_5; | |
217 | case 0x42: return KEY_NUMERIC_6; | |
218 | case 0x82: return KEY_NUMERIC_7; | |
219 | case 0x14: return KEY_NUMERIC_8; | |
220 | case 0x24: return KEY_NUMERIC_9; | |
221 | case 0x44: return KEY_NUMERIC_POUND; /* # */ | |
222 | case 0x84: return KEY_NUMERIC_STAR; /* * */ | |
223 | case 0x18: return KEY_ENTER; /* Talk (green handset) */ | |
224 | case 0x28: return KEY_ESC; /* End (red handset) */ | |
225 | case 0x48: return KEY_UP; /* Menu up (rocker switch) */ | |
226 | case 0x88: return KEY_DOWN; /* Menu down (rocker switch) */ | |
227 | default: return special_keymap(scancode); | |
228 | } | |
229 | } | |
230 | ||
231 | /* | |
232 | * Keymap for Allied-Telesis Corega USBPH01 | |
233 | * http://www.alliedtelesis-corega.com/2/1344/1437/1360/chprd.html | |
234 | * | |
235 | * Contributed by july@nat.bg | |
236 | */ | |
237 | static unsigned short keymap_usbph01(int scancode) | |
238 | { | |
239 | switch (scancode) { | |
240 | case 0x11: return KEY_NUMERIC_0; /* 0 */ | |
241 | case 0x21: return KEY_NUMERIC_1; /* 1 */ | |
242 | case 0x41: return KEY_NUMERIC_2; /* 2 */ | |
243 | case 0x81: return KEY_NUMERIC_3; /* 3 */ | |
244 | case 0x12: return KEY_NUMERIC_4; /* 4 */ | |
245 | case 0x22: return KEY_NUMERIC_5; /* 5 */ | |
246 | case 0x42: return KEY_NUMERIC_6; /* 6 */ | |
247 | case 0x82: return KEY_NUMERIC_7; /* 7 */ | |
248 | case 0x14: return KEY_NUMERIC_8; /* 8 */ | |
249 | case 0x24: return KEY_NUMERIC_9; /* 9 */ | |
250 | case 0x44: return KEY_NUMERIC_POUND; /* # */ | |
251 | case 0x84: return KEY_NUMERIC_STAR; /* * */ | |
252 | case 0x18: return KEY_ENTER; /* pickup */ | |
253 | case 0x28: return KEY_ESC; /* hangup */ | |
254 | case 0x48: return KEY_LEFT; /* IN */ | |
255 | case 0x88: return KEY_RIGHT; /* OUT */ | |
256 | default: return special_keymap(scancode); | |
257 | } | |
258 | } | |
259 | ||
734f0bae DG |
260 | /* |
261 | * Keymap for ATCom AU-100 | |
631dd1a8 | 262 | * http://www.atcom.cn/products.html |
734f0bae DG |
263 | * http://www.packetizer.com/products/au100/ |
264 | * http://www.voip-info.org/wiki/view/AU-100 | |
265 | * | |
266 | * Contributed by daniel@gimpelevich.san-francisco.ca.us | |
267 | */ | |
268 | static unsigned short keymap_atcom(int scancode) | |
269 | { | |
270 | switch (scancode) { /* phone key: */ | |
271 | case 0x82: return KEY_NUMERIC_0; /* 0 */ | |
272 | case 0x11: return KEY_NUMERIC_1; /* 1 */ | |
273 | case 0x12: return KEY_NUMERIC_2; /* 2 */ | |
274 | case 0x14: return KEY_NUMERIC_3; /* 3 */ | |
275 | case 0x21: return KEY_NUMERIC_4; /* 4 */ | |
276 | case 0x22: return KEY_NUMERIC_5; /* 5 */ | |
277 | case 0x24: return KEY_NUMERIC_6; /* 6 */ | |
278 | case 0x41: return KEY_NUMERIC_7; /* 7 */ | |
279 | case 0x42: return KEY_NUMERIC_8; /* 8 */ | |
280 | case 0x44: return KEY_NUMERIC_9; /* 9 */ | |
281 | case 0x84: return KEY_NUMERIC_POUND; /* # */ | |
282 | case 0x81: return KEY_NUMERIC_STAR; /* * */ | |
283 | case 0x18: return KEY_ENTER; /* pickup */ | |
284 | case 0x28: return KEY_ESC; /* hangup */ | |
285 | case 0x48: return KEY_LEFT; /* left arrow */ | |
286 | case 0x88: return KEY_RIGHT; /* right arrow */ | |
287 | default: return special_keymap(scancode); | |
288 | } | |
289 | } | |
290 | ||
c04148f9 AH |
291 | static unsigned short (*keymap)(int) = keymap_kip1000; |
292 | ||
293 | /* | |
294 | * Completes a request by converting the data into events for the | |
295 | * input subsystem. | |
296 | */ | |
297 | static void report_key(struct cm109_dev *dev, int key) | |
298 | { | |
299 | struct input_dev *idev = dev->idev; | |
300 | ||
301 | if (dev->key_code >= 0) { | |
302 | /* old key up */ | |
303 | input_report_key(idev, dev->key_code, 0); | |
304 | } | |
305 | ||
306 | dev->key_code = key; | |
307 | if (key >= 0) { | |
308 | /* new valid key */ | |
309 | input_report_key(idev, key, 1); | |
310 | } | |
311 | ||
312 | input_sync(idev); | |
313 | } | |
314 | ||
315 | /****************************************************************************** | |
316 | * CM109 usb communication interface | |
317 | *****************************************************************************/ | |
318 | ||
319 | static void cm109_submit_buzz_toggle(struct cm109_dev *dev) | |
320 | { | |
321 | int error; | |
322 | ||
323 | if (dev->buzzer_state) | |
324 | dev->ctl_data->byte[HID_OR0] |= BUZZER_ON; | |
325 | else | |
326 | dev->ctl_data->byte[HID_OR0] &= ~BUZZER_ON; | |
327 | ||
328 | error = usb_submit_urb(dev->urb_ctl, GFP_ATOMIC); | |
329 | if (error) | |
330 | err("%s: usb_submit_urb (urb_ctl) failed %d", __func__, error); | |
331 | } | |
332 | ||
333 | /* | |
334 | * IRQ handler | |
335 | */ | |
336 | static void cm109_urb_irq_callback(struct urb *urb) | |
337 | { | |
338 | struct cm109_dev *dev = urb->context; | |
339 | const int status = urb->status; | |
340 | int error; | |
341 | ||
2d517cab | 342 | dev_dbg(&urb->dev->dev, "### URB IRQ: [0x%02x 0x%02x 0x%02x 0x%02x] keybit=0x%02x\n", |
c04148f9 AH |
343 | dev->irq_data->byte[0], |
344 | dev->irq_data->byte[1], | |
345 | dev->irq_data->byte[2], | |
346 | dev->irq_data->byte[3], | |
347 | dev->keybit); | |
c04148f9 AH |
348 | |
349 | if (status) { | |
350 | if (status == -ESHUTDOWN) | |
351 | return; | |
352 | err("%s: urb status %d", __func__, status); | |
353 | } | |
354 | ||
355 | /* Special keys */ | |
356 | if (dev->irq_data->byte[HID_IR0] & 0x0f) { | |
357 | const int code = (dev->irq_data->byte[HID_IR0] & 0x0f); | |
358 | report_key(dev, dev->keymap[0xff + code]); | |
359 | } | |
360 | ||
361 | /* Scan key column */ | |
362 | if (dev->keybit == 0xf) { | |
363 | ||
364 | /* Any changes ? */ | |
365 | if ((dev->gpi & 0xf0) == (dev->irq_data->byte[HID_IR1] & 0xf0)) | |
366 | goto out; | |
367 | ||
368 | dev->gpi = dev->irq_data->byte[HID_IR1] & 0xf0; | |
369 | dev->keybit = 0x1; | |
370 | } else { | |
371 | report_key(dev, dev->keymap[dev->irq_data->byte[HID_IR1]]); | |
372 | ||
373 | dev->keybit <<= 1; | |
374 | if (dev->keybit > 0x8) | |
375 | dev->keybit = 0xf; | |
376 | } | |
377 | ||
378 | out: | |
379 | ||
380 | spin_lock(&dev->ctl_submit_lock); | |
381 | ||
382 | dev->irq_urb_pending = 0; | |
383 | ||
384 | if (likely(!dev->shutdown)) { | |
385 | ||
386 | if (dev->buzzer_state) | |
387 | dev->ctl_data->byte[HID_OR0] |= BUZZER_ON; | |
388 | else | |
389 | dev->ctl_data->byte[HID_OR0] &= ~BUZZER_ON; | |
390 | ||
391 | dev->ctl_data->byte[HID_OR1] = dev->keybit; | |
392 | dev->ctl_data->byte[HID_OR2] = dev->keybit; | |
393 | ||
394 | dev->buzzer_pending = 0; | |
395 | dev->ctl_urb_pending = 1; | |
396 | ||
397 | error = usb_submit_urb(dev->urb_ctl, GFP_ATOMIC); | |
398 | if (error) | |
399 | err("%s: usb_submit_urb (urb_ctl) failed %d", | |
400 | __func__, error); | |
401 | } | |
402 | ||
403 | spin_unlock(&dev->ctl_submit_lock); | |
404 | } | |
405 | ||
406 | static void cm109_urb_ctl_callback(struct urb *urb) | |
407 | { | |
408 | struct cm109_dev *dev = urb->context; | |
409 | const int status = urb->status; | |
410 | int error; | |
411 | ||
2d517cab | 412 | dev_dbg(&urb->dev->dev, "### URB CTL: [0x%02x 0x%02x 0x%02x 0x%02x]\n", |
c04148f9 AH |
413 | dev->ctl_data->byte[0], |
414 | dev->ctl_data->byte[1], | |
415 | dev->ctl_data->byte[2], | |
416 | dev->ctl_data->byte[3]); | |
c04148f9 AH |
417 | |
418 | if (status) | |
419 | err("%s: urb status %d", __func__, status); | |
420 | ||
421 | spin_lock(&dev->ctl_submit_lock); | |
422 | ||
423 | dev->ctl_urb_pending = 0; | |
424 | ||
425 | if (likely(!dev->shutdown)) { | |
426 | ||
427 | if (dev->buzzer_pending) { | |
428 | dev->buzzer_pending = 0; | |
429 | dev->ctl_urb_pending = 1; | |
430 | cm109_submit_buzz_toggle(dev); | |
431 | } else if (likely(!dev->irq_urb_pending)) { | |
432 | /* ask for key data */ | |
433 | dev->irq_urb_pending = 1; | |
434 | error = usb_submit_urb(dev->urb_irq, GFP_ATOMIC); | |
435 | if (error) | |
436 | err("%s: usb_submit_urb (urb_irq) failed %d", | |
437 | __func__, error); | |
438 | } | |
439 | } | |
440 | ||
441 | spin_unlock(&dev->ctl_submit_lock); | |
442 | } | |
443 | ||
444 | static void cm109_toggle_buzzer_async(struct cm109_dev *dev) | |
445 | { | |
446 | unsigned long flags; | |
447 | ||
448 | spin_lock_irqsave(&dev->ctl_submit_lock, flags); | |
449 | ||
450 | if (dev->ctl_urb_pending) { | |
451 | /* URB completion will resubmit */ | |
452 | dev->buzzer_pending = 1; | |
453 | } else { | |
454 | dev->ctl_urb_pending = 1; | |
455 | cm109_submit_buzz_toggle(dev); | |
456 | } | |
457 | ||
458 | spin_unlock_irqrestore(&dev->ctl_submit_lock, flags); | |
459 | } | |
460 | ||
461 | static void cm109_toggle_buzzer_sync(struct cm109_dev *dev, int on) | |
462 | { | |
463 | int error; | |
464 | ||
465 | if (on) | |
466 | dev->ctl_data->byte[HID_OR0] |= BUZZER_ON; | |
467 | else | |
468 | dev->ctl_data->byte[HID_OR0] &= ~BUZZER_ON; | |
469 | ||
470 | error = usb_control_msg(dev->udev, | |
471 | usb_sndctrlpipe(dev->udev, 0), | |
472 | dev->ctl_req->bRequest, | |
473 | dev->ctl_req->bRequestType, | |
474 | le16_to_cpu(dev->ctl_req->wValue), | |
475 | le16_to_cpu(dev->ctl_req->wIndex), | |
476 | dev->ctl_data, | |
477 | USB_PKT_LEN, USB_CTRL_SET_TIMEOUT); | |
478 | if (error && error != EINTR) | |
479 | err("%s: usb_control_msg() failed %d", __func__, error); | |
480 | } | |
481 | ||
482 | static void cm109_stop_traffic(struct cm109_dev *dev) | |
483 | { | |
484 | dev->shutdown = 1; | |
485 | /* | |
486 | * Make sure other CPUs see this | |
487 | */ | |
488 | smp_wmb(); | |
489 | ||
490 | usb_kill_urb(dev->urb_ctl); | |
491 | usb_kill_urb(dev->urb_irq); | |
492 | ||
493 | cm109_toggle_buzzer_sync(dev, 0); | |
494 | ||
495 | dev->shutdown = 0; | |
496 | smp_wmb(); | |
497 | } | |
498 | ||
499 | static void cm109_restore_state(struct cm109_dev *dev) | |
500 | { | |
501 | if (dev->open) { | |
502 | /* | |
503 | * Restore buzzer state. | |
504 | * This will also kick regular URB submission | |
505 | */ | |
506 | cm109_toggle_buzzer_async(dev); | |
507 | } | |
508 | } | |
509 | ||
510 | /****************************************************************************** | |
511 | * input event interface | |
512 | *****************************************************************************/ | |
513 | ||
514 | static int cm109_input_open(struct input_dev *idev) | |
515 | { | |
516 | struct cm109_dev *dev = input_get_drvdata(idev); | |
517 | int error; | |
518 | ||
519 | error = usb_autopm_get_interface(dev->intf); | |
520 | if (error < 0) { | |
521 | err("%s - cannot autoresume, result %d", | |
522 | __func__, error); | |
523 | return error; | |
524 | } | |
525 | ||
526 | mutex_lock(&dev->pm_mutex); | |
527 | ||
528 | dev->buzzer_state = 0; | |
529 | dev->key_code = -1; /* no keys pressed */ | |
530 | dev->keybit = 0xf; | |
531 | ||
532 | /* issue INIT */ | |
533 | dev->ctl_data->byte[HID_OR0] = HID_OR_GPO_BUZ_SPDIF; | |
534 | dev->ctl_data->byte[HID_OR1] = dev->keybit; | |
535 | dev->ctl_data->byte[HID_OR2] = dev->keybit; | |
536 | dev->ctl_data->byte[HID_OR3] = 0x00; | |
537 | ||
538 | error = usb_submit_urb(dev->urb_ctl, GFP_KERNEL); | |
539 | if (error) | |
540 | err("%s: usb_submit_urb (urb_ctl) failed %d", __func__, error); | |
541 | else | |
542 | dev->open = 1; | |
543 | ||
544 | mutex_unlock(&dev->pm_mutex); | |
545 | ||
546 | if (error) | |
547 | usb_autopm_put_interface(dev->intf); | |
548 | ||
549 | return error; | |
550 | } | |
551 | ||
552 | static void cm109_input_close(struct input_dev *idev) | |
553 | { | |
554 | struct cm109_dev *dev = input_get_drvdata(idev); | |
555 | ||
556 | mutex_lock(&dev->pm_mutex); | |
557 | ||
558 | /* | |
559 | * Once we are here event delivery is stopped so we | |
560 | * don't need to worry about someone starting buzzer | |
561 | * again | |
562 | */ | |
563 | cm109_stop_traffic(dev); | |
564 | dev->open = 0; | |
565 | ||
566 | mutex_unlock(&dev->pm_mutex); | |
567 | ||
568 | usb_autopm_put_interface(dev->intf); | |
569 | } | |
570 | ||
571 | static int cm109_input_ev(struct input_dev *idev, unsigned int type, | |
572 | unsigned int code, int value) | |
573 | { | |
574 | struct cm109_dev *dev = input_get_drvdata(idev); | |
575 | ||
67d47641 | 576 | dev_dbg(&dev->udev->dev, |
2d517cab | 577 | "input_ev: type=%u code=%u value=%d\n", type, code, value); |
c04148f9 AH |
578 | |
579 | if (type != EV_SND) | |
580 | return -EINVAL; | |
581 | ||
582 | switch (code) { | |
583 | case SND_TONE: | |
584 | case SND_BELL: | |
585 | dev->buzzer_state = !!value; | |
586 | if (!dev->resetting) | |
587 | cm109_toggle_buzzer_async(dev); | |
588 | return 0; | |
589 | ||
590 | default: | |
591 | return -EINVAL; | |
592 | } | |
593 | } | |
594 | ||
595 | ||
596 | /****************************************************************************** | |
597 | * Linux interface and usb initialisation | |
598 | *****************************************************************************/ | |
599 | ||
600 | struct driver_info { | |
601 | char *name; | |
602 | }; | |
603 | ||
604 | static const struct driver_info info_cm109 = { | |
605 | .name = "CM109 USB driver", | |
606 | }; | |
607 | ||
608 | enum { | |
609 | VENDOR_ID = 0x0d8c, /* C-Media Electronics */ | |
610 | PRODUCT_ID_CM109 = 0x000e, /* CM109 defines range 0x0008 - 0x000f */ | |
611 | }; | |
612 | ||
613 | /* table of devices that work with this driver */ | |
614 | static const struct usb_device_id cm109_usb_table[] = { | |
615 | { | |
616 | .match_flags = USB_DEVICE_ID_MATCH_DEVICE | | |
617 | USB_DEVICE_ID_MATCH_INT_INFO, | |
618 | .idVendor = VENDOR_ID, | |
619 | .idProduct = PRODUCT_ID_CM109, | |
620 | .bInterfaceClass = USB_CLASS_HID, | |
621 | .bInterfaceSubClass = 0, | |
622 | .bInterfaceProtocol = 0, | |
623 | .driver_info = (kernel_ulong_t) &info_cm109 | |
624 | }, | |
625 | /* you can add more devices here with product ID 0x0008 - 0x000f */ | |
626 | { } | |
627 | }; | |
628 | ||
629 | static void cm109_usb_cleanup(struct cm109_dev *dev) | |
630 | { | |
0ede76fc | 631 | kfree(dev->ctl_req); |
c04148f9 | 632 | if (dev->ctl_data) |
997ea58e DM |
633 | usb_free_coherent(dev->udev, USB_PKT_LEN, |
634 | dev->ctl_data, dev->ctl_dma); | |
c04148f9 | 635 | if (dev->irq_data) |
997ea58e DM |
636 | usb_free_coherent(dev->udev, USB_PKT_LEN, |
637 | dev->irq_data, dev->irq_dma); | |
c04148f9 AH |
638 | |
639 | usb_free_urb(dev->urb_irq); /* parameter validation in core/urb */ | |
640 | usb_free_urb(dev->urb_ctl); /* parameter validation in core/urb */ | |
641 | kfree(dev); | |
642 | } | |
643 | ||
644 | static void cm109_usb_disconnect(struct usb_interface *interface) | |
645 | { | |
646 | struct cm109_dev *dev = usb_get_intfdata(interface); | |
647 | ||
648 | usb_set_intfdata(interface, NULL); | |
649 | input_unregister_device(dev->idev); | |
650 | cm109_usb_cleanup(dev); | |
651 | } | |
652 | ||
653 | static int cm109_usb_probe(struct usb_interface *intf, | |
654 | const struct usb_device_id *id) | |
655 | { | |
656 | struct usb_device *udev = interface_to_usbdev(intf); | |
657 | struct driver_info *nfo = (struct driver_info *)id->driver_info; | |
658 | struct usb_host_interface *interface; | |
659 | struct usb_endpoint_descriptor *endpoint; | |
660 | struct cm109_dev *dev; | |
661 | struct input_dev *input_dev = NULL; | |
662 | int ret, pipe, i; | |
663 | int error = -ENOMEM; | |
664 | ||
665 | interface = intf->cur_altsetting; | |
666 | endpoint = &interface->endpoint[0].desc; | |
667 | ||
668 | if (!usb_endpoint_is_int_in(endpoint)) | |
669 | return -ENODEV; | |
670 | ||
671 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); | |
672 | if (!dev) | |
673 | return -ENOMEM; | |
674 | ||
675 | spin_lock_init(&dev->ctl_submit_lock); | |
676 | mutex_init(&dev->pm_mutex); | |
677 | ||
678 | dev->udev = udev; | |
679 | dev->intf = intf; | |
680 | ||
681 | dev->idev = input_dev = input_allocate_device(); | |
682 | if (!input_dev) | |
683 | goto err_out; | |
684 | ||
685 | /* allocate usb buffers */ | |
997ea58e DM |
686 | dev->irq_data = usb_alloc_coherent(udev, USB_PKT_LEN, |
687 | GFP_KERNEL, &dev->irq_dma); | |
c04148f9 AH |
688 | if (!dev->irq_data) |
689 | goto err_out; | |
690 | ||
997ea58e DM |
691 | dev->ctl_data = usb_alloc_coherent(udev, USB_PKT_LEN, |
692 | GFP_KERNEL, &dev->ctl_dma); | |
c04148f9 AH |
693 | if (!dev->ctl_data) |
694 | goto err_out; | |
695 | ||
0ede76fc | 696 | dev->ctl_req = kmalloc(sizeof(*(dev->ctl_req)), GFP_KERNEL); |
c04148f9 AH |
697 | if (!dev->ctl_req) |
698 | goto err_out; | |
699 | ||
700 | /* allocate urb structures */ | |
701 | dev->urb_irq = usb_alloc_urb(0, GFP_KERNEL); | |
702 | if (!dev->urb_irq) | |
703 | goto err_out; | |
704 | ||
705 | dev->urb_ctl = usb_alloc_urb(0, GFP_KERNEL); | |
706 | if (!dev->urb_ctl) | |
707 | goto err_out; | |
708 | ||
709 | /* get a handle to the interrupt data pipe */ | |
710 | pipe = usb_rcvintpipe(udev, endpoint->bEndpointAddress); | |
711 | ret = usb_maxpacket(udev, pipe, usb_pipeout(pipe)); | |
712 | if (ret != USB_PKT_LEN) | |
713 | err("invalid payload size %d, expected %d", ret, USB_PKT_LEN); | |
714 | ||
715 | /* initialise irq urb */ | |
716 | usb_fill_int_urb(dev->urb_irq, udev, pipe, dev->irq_data, | |
717 | USB_PKT_LEN, | |
718 | cm109_urb_irq_callback, dev, endpoint->bInterval); | |
719 | dev->urb_irq->transfer_dma = dev->irq_dma; | |
720 | dev->urb_irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
721 | dev->urb_irq->dev = udev; | |
722 | ||
723 | /* initialise ctl urb */ | |
724 | dev->ctl_req->bRequestType = USB_TYPE_CLASS | USB_RECIP_INTERFACE | | |
725 | USB_DIR_OUT; | |
726 | dev->ctl_req->bRequest = USB_REQ_SET_CONFIGURATION; | |
727 | dev->ctl_req->wValue = cpu_to_le16(0x200); | |
728 | dev->ctl_req->wIndex = cpu_to_le16(interface->desc.bInterfaceNumber); | |
729 | dev->ctl_req->wLength = cpu_to_le16(USB_PKT_LEN); | |
730 | ||
731 | usb_fill_control_urb(dev->urb_ctl, udev, usb_sndctrlpipe(udev, 0), | |
732 | (void *)dev->ctl_req, dev->ctl_data, USB_PKT_LEN, | |
733 | cm109_urb_ctl_callback, dev); | |
c04148f9 | 734 | dev->urb_ctl->transfer_dma = dev->ctl_dma; |
0ede76fc | 735 | dev->urb_ctl->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; |
c04148f9 AH |
736 | dev->urb_ctl->dev = udev; |
737 | ||
738 | /* find out the physical bus location */ | |
739 | usb_make_path(udev, dev->phys, sizeof(dev->phys)); | |
740 | strlcat(dev->phys, "/input0", sizeof(dev->phys)); | |
741 | ||
742 | /* register settings for the input device */ | |
743 | input_dev->name = nfo->name; | |
744 | input_dev->phys = dev->phys; | |
745 | usb_to_input_id(udev, &input_dev->id); | |
746 | input_dev->dev.parent = &intf->dev; | |
747 | ||
748 | input_set_drvdata(input_dev, dev); | |
749 | input_dev->open = cm109_input_open; | |
750 | input_dev->close = cm109_input_close; | |
751 | input_dev->event = cm109_input_ev; | |
752 | ||
753 | input_dev->keycode = dev->keymap; | |
754 | input_dev->keycodesize = sizeof(unsigned char); | |
755 | input_dev->keycodemax = ARRAY_SIZE(dev->keymap); | |
756 | ||
757 | input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_SND); | |
758 | input_dev->sndbit[0] = BIT_MASK(SND_BELL) | BIT_MASK(SND_TONE); | |
759 | ||
760 | /* register available key events */ | |
761 | for (i = 0; i < KEYMAP_SIZE; i++) { | |
762 | unsigned short k = keymap(i); | |
763 | dev->keymap[i] = k; | |
764 | __set_bit(k, input_dev->keybit); | |
765 | } | |
766 | __clear_bit(KEY_RESERVED, input_dev->keybit); | |
767 | ||
768 | error = input_register_device(dev->idev); | |
769 | if (error) | |
770 | goto err_out; | |
771 | ||
772 | usb_set_intfdata(intf, dev); | |
773 | ||
774 | return 0; | |
775 | ||
776 | err_out: | |
777 | input_free_device(input_dev); | |
778 | cm109_usb_cleanup(dev); | |
779 | return error; | |
780 | } | |
781 | ||
782 | static int cm109_usb_suspend(struct usb_interface *intf, pm_message_t message) | |
783 | { | |
784 | struct cm109_dev *dev = usb_get_intfdata(intf); | |
785 | ||
2d517cab | 786 | dev_info(&intf->dev, "cm109: usb_suspend (event=%d)\n", message.event); |
c04148f9 AH |
787 | |
788 | mutex_lock(&dev->pm_mutex); | |
789 | cm109_stop_traffic(dev); | |
790 | mutex_unlock(&dev->pm_mutex); | |
791 | ||
792 | return 0; | |
793 | } | |
794 | ||
795 | static int cm109_usb_resume(struct usb_interface *intf) | |
796 | { | |
797 | struct cm109_dev *dev = usb_get_intfdata(intf); | |
798 | ||
2d517cab | 799 | dev_info(&intf->dev, "cm109: usb_resume\n"); |
c04148f9 AH |
800 | |
801 | mutex_lock(&dev->pm_mutex); | |
802 | cm109_restore_state(dev); | |
803 | mutex_unlock(&dev->pm_mutex); | |
804 | ||
805 | return 0; | |
806 | } | |
807 | ||
808 | static int cm109_usb_pre_reset(struct usb_interface *intf) | |
809 | { | |
810 | struct cm109_dev *dev = usb_get_intfdata(intf); | |
811 | ||
812 | mutex_lock(&dev->pm_mutex); | |
813 | ||
814 | /* | |
815 | * Make sure input events don't try to toggle buzzer | |
816 | * while we are resetting | |
817 | */ | |
818 | dev->resetting = 1; | |
819 | smp_wmb(); | |
820 | ||
821 | cm109_stop_traffic(dev); | |
822 | ||
823 | return 0; | |
824 | } | |
825 | ||
826 | static int cm109_usb_post_reset(struct usb_interface *intf) | |
827 | { | |
828 | struct cm109_dev *dev = usb_get_intfdata(intf); | |
829 | ||
830 | dev->resetting = 0; | |
831 | smp_wmb(); | |
832 | ||
833 | cm109_restore_state(dev); | |
834 | ||
835 | mutex_unlock(&dev->pm_mutex); | |
836 | ||
837 | return 0; | |
838 | } | |
839 | ||
840 | static struct usb_driver cm109_driver = { | |
841 | .name = "cm109", | |
842 | .probe = cm109_usb_probe, | |
843 | .disconnect = cm109_usb_disconnect, | |
844 | .suspend = cm109_usb_suspend, | |
845 | .resume = cm109_usb_resume, | |
846 | .reset_resume = cm109_usb_resume, | |
847 | .pre_reset = cm109_usb_pre_reset, | |
848 | .post_reset = cm109_usb_post_reset, | |
849 | .id_table = cm109_usb_table, | |
850 | .supports_autosuspend = 1, | |
851 | }; | |
852 | ||
853 | static int __init cm109_select_keymap(void) | |
854 | { | |
855 | /* Load the phone keymap */ | |
856 | if (!strcasecmp(phone, "kip1000")) { | |
857 | keymap = keymap_kip1000; | |
67d47641 | 858 | printk(KERN_INFO KBUILD_MODNAME ": " |
2d517cab | 859 | "Keymap for Komunikate KIP1000 phone loaded\n"); |
c04148f9 AH |
860 | } else if (!strcasecmp(phone, "gtalk")) { |
861 | keymap = keymap_gtalk; | |
67d47641 | 862 | printk(KERN_INFO KBUILD_MODNAME ": " |
2d517cab | 863 | "Keymap for Genius G-talk phone loaded\n"); |
c04148f9 AH |
864 | } else if (!strcasecmp(phone, "usbph01")) { |
865 | keymap = keymap_usbph01; | |
67d47641 | 866 | printk(KERN_INFO KBUILD_MODNAME ": " |
2d517cab | 867 | "Keymap for Allied-Telesis Corega USBPH01 phone loaded\n"); |
734f0bae DG |
868 | } else if (!strcasecmp(phone, "atcom")) { |
869 | keymap = keymap_atcom; | |
870 | printk(KERN_INFO KBUILD_MODNAME ": " | |
871 | "Keymap for ATCom AU-100 phone loaded\n"); | |
c04148f9 | 872 | } else { |
67d47641 | 873 | printk(KERN_ERR KBUILD_MODNAME ": " |
2d517cab | 874 | "Unsupported phone: %s\n", phone); |
c04148f9 AH |
875 | return -EINVAL; |
876 | } | |
877 | ||
878 | return 0; | |
879 | } | |
880 | ||
881 | static int __init cm109_init(void) | |
882 | { | |
883 | int err; | |
884 | ||
885 | err = cm109_select_keymap(); | |
886 | if (err) | |
887 | return err; | |
888 | ||
889 | err = usb_register(&cm109_driver); | |
890 | if (err) | |
891 | return err; | |
892 | ||
67d47641 | 893 | printk(KERN_INFO KBUILD_MODNAME ": " |
2d517cab | 894 | DRIVER_DESC ": " DRIVER_VERSION " (C) " DRIVER_AUTHOR "\n"); |
c04148f9 AH |
895 | |
896 | return 0; | |
897 | } | |
898 | ||
899 | static void __exit cm109_exit(void) | |
900 | { | |
901 | usb_deregister(&cm109_driver); | |
902 | } | |
903 | ||
904 | module_init(cm109_init); | |
905 | module_exit(cm109_exit); | |
906 | ||
907 | MODULE_DEVICE_TABLE(usb, cm109_usb_table); | |
908 | ||
909 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
910 | MODULE_DESCRIPTION(DRIVER_DESC); | |
911 | MODULE_LICENSE("GPL"); |