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 | ||
c90a0f08 FE |
79 | /* up to 256 normal keys, up to 15 special key combinations */ |
80 | KEYMAP_SIZE = 256 + 15, | |
c04148f9 AH |
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) { | |
c90a0f08 | 142 | case RECORD_MUTE: return KEY_MICMUTE; |
c04148f9 AH |
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 | ||
c90a0f08 FE |
315 | /* |
316 | * Converts data of special key presses (volume, mute) into events | |
317 | * for the input subsystem, sends press-n-release for mute keys. | |
318 | */ | |
319 | static void cm109_report_special(struct cm109_dev *dev) | |
320 | { | |
321 | static const u8 autorelease = RECORD_MUTE | PLAYBACK_MUTE; | |
322 | struct input_dev *idev = dev->idev; | |
323 | u8 data = dev->irq_data->byte[HID_IR0]; | |
324 | unsigned short keycode; | |
325 | int i; | |
326 | ||
327 | for (i = 0; i < 4; i++) { | |
328 | keycode = dev->keymap[0xff + BIT(i)]; | |
329 | if (keycode == KEY_RESERVED) | |
330 | continue; | |
331 | ||
332 | input_report_key(idev, keycode, data & BIT(i)); | |
333 | if (data & autorelease & BIT(i)) { | |
334 | input_sync(idev); | |
335 | input_report_key(idev, keycode, 0); | |
336 | } | |
337 | } | |
338 | input_sync(idev); | |
339 | } | |
340 | ||
c04148f9 AH |
341 | /****************************************************************************** |
342 | * CM109 usb communication interface | |
343 | *****************************************************************************/ | |
344 | ||
345 | static void cm109_submit_buzz_toggle(struct cm109_dev *dev) | |
346 | { | |
347 | int error; | |
348 | ||
349 | if (dev->buzzer_state) | |
350 | dev->ctl_data->byte[HID_OR0] |= BUZZER_ON; | |
351 | else | |
352 | dev->ctl_data->byte[HID_OR0] &= ~BUZZER_ON; | |
353 | ||
354 | error = usb_submit_urb(dev->urb_ctl, GFP_ATOMIC); | |
355 | if (error) | |
ab242a73 | 356 | dev_err(&dev->intf->dev, |
3f37d8e8 GKH |
357 | "%s: usb_submit_urb (urb_ctl) failed %d\n", |
358 | __func__, error); | |
c04148f9 AH |
359 | } |
360 | ||
361 | /* | |
362 | * IRQ handler | |
363 | */ | |
364 | static void cm109_urb_irq_callback(struct urb *urb) | |
365 | { | |
366 | struct cm109_dev *dev = urb->context; | |
367 | const int status = urb->status; | |
368 | int error; | |
d144cf42 | 369 | unsigned long flags; |
c04148f9 | 370 | |
ab242a73 | 371 | dev_dbg(&dev->intf->dev, "### URB IRQ: [0x%02x 0x%02x 0x%02x 0x%02x] keybit=0x%02x\n", |
c04148f9 AH |
372 | dev->irq_data->byte[0], |
373 | dev->irq_data->byte[1], | |
374 | dev->irq_data->byte[2], | |
375 | dev->irq_data->byte[3], | |
376 | dev->keybit); | |
c04148f9 AH |
377 | |
378 | if (status) { | |
379 | if (status == -ESHUTDOWN) | |
380 | return; | |
0a6ad06c TG |
381 | dev_err_ratelimited(&dev->intf->dev, "%s: urb status %d\n", |
382 | __func__, status); | |
383 | goto out; | |
c04148f9 AH |
384 | } |
385 | ||
386 | /* Special keys */ | |
c90a0f08 | 387 | cm109_report_special(dev); |
c04148f9 AH |
388 | |
389 | /* Scan key column */ | |
390 | if (dev->keybit == 0xf) { | |
391 | ||
392 | /* Any changes ? */ | |
393 | if ((dev->gpi & 0xf0) == (dev->irq_data->byte[HID_IR1] & 0xf0)) | |
394 | goto out; | |
395 | ||
396 | dev->gpi = dev->irq_data->byte[HID_IR1] & 0xf0; | |
397 | dev->keybit = 0x1; | |
398 | } else { | |
399 | report_key(dev, dev->keymap[dev->irq_data->byte[HID_IR1]]); | |
400 | ||
401 | dev->keybit <<= 1; | |
402 | if (dev->keybit > 0x8) | |
403 | dev->keybit = 0xf; | |
404 | } | |
405 | ||
406 | out: | |
407 | ||
d144cf42 | 408 | spin_lock_irqsave(&dev->ctl_submit_lock, flags); |
c04148f9 AH |
409 | |
410 | dev->irq_urb_pending = 0; | |
411 | ||
412 | if (likely(!dev->shutdown)) { | |
413 | ||
414 | if (dev->buzzer_state) | |
415 | dev->ctl_data->byte[HID_OR0] |= BUZZER_ON; | |
416 | else | |
417 | dev->ctl_data->byte[HID_OR0] &= ~BUZZER_ON; | |
418 | ||
419 | dev->ctl_data->byte[HID_OR1] = dev->keybit; | |
420 | dev->ctl_data->byte[HID_OR2] = dev->keybit; | |
421 | ||
422 | dev->buzzer_pending = 0; | |
423 | dev->ctl_urb_pending = 1; | |
424 | ||
425 | error = usb_submit_urb(dev->urb_ctl, GFP_ATOMIC); | |
426 | if (error) | |
ab242a73 | 427 | dev_err(&dev->intf->dev, |
3f37d8e8 | 428 | "%s: usb_submit_urb (urb_ctl) failed %d\n", |
c04148f9 AH |
429 | __func__, error); |
430 | } | |
431 | ||
d144cf42 | 432 | spin_unlock_irqrestore(&dev->ctl_submit_lock, flags); |
c04148f9 AH |
433 | } |
434 | ||
435 | static void cm109_urb_ctl_callback(struct urb *urb) | |
436 | { | |
437 | struct cm109_dev *dev = urb->context; | |
438 | const int status = urb->status; | |
439 | int error; | |
d144cf42 | 440 | unsigned long flags; |
c04148f9 | 441 | |
ab242a73 | 442 | dev_dbg(&dev->intf->dev, "### URB CTL: [0x%02x 0x%02x 0x%02x 0x%02x]\n", |
c04148f9 AH |
443 | dev->ctl_data->byte[0], |
444 | dev->ctl_data->byte[1], | |
445 | dev->ctl_data->byte[2], | |
446 | dev->ctl_data->byte[3]); | |
c04148f9 | 447 | |
0a6ad06c TG |
448 | if (status) { |
449 | if (status == -ESHUTDOWN) | |
450 | return; | |
451 | dev_err_ratelimited(&dev->intf->dev, "%s: urb status %d\n", | |
452 | __func__, status); | |
453 | } | |
c04148f9 | 454 | |
d144cf42 | 455 | spin_lock_irqsave(&dev->ctl_submit_lock, flags); |
c04148f9 AH |
456 | |
457 | dev->ctl_urb_pending = 0; | |
458 | ||
459 | if (likely(!dev->shutdown)) { | |
460 | ||
0a6ad06c | 461 | if (dev->buzzer_pending || status) { |
c04148f9 AH |
462 | dev->buzzer_pending = 0; |
463 | dev->ctl_urb_pending = 1; | |
464 | cm109_submit_buzz_toggle(dev); | |
465 | } else if (likely(!dev->irq_urb_pending)) { | |
466 | /* ask for key data */ | |
467 | dev->irq_urb_pending = 1; | |
468 | error = usb_submit_urb(dev->urb_irq, GFP_ATOMIC); | |
469 | if (error) | |
ab242a73 | 470 | dev_err(&dev->intf->dev, |
3f37d8e8 | 471 | "%s: usb_submit_urb (urb_irq) failed %d\n", |
c04148f9 AH |
472 | __func__, error); |
473 | } | |
474 | } | |
475 | ||
d144cf42 | 476 | spin_unlock_irqrestore(&dev->ctl_submit_lock, flags); |
c04148f9 AH |
477 | } |
478 | ||
479 | static void cm109_toggle_buzzer_async(struct cm109_dev *dev) | |
480 | { | |
481 | unsigned long flags; | |
482 | ||
483 | spin_lock_irqsave(&dev->ctl_submit_lock, flags); | |
484 | ||
485 | if (dev->ctl_urb_pending) { | |
486 | /* URB completion will resubmit */ | |
487 | dev->buzzer_pending = 1; | |
488 | } else { | |
489 | dev->ctl_urb_pending = 1; | |
490 | cm109_submit_buzz_toggle(dev); | |
491 | } | |
492 | ||
493 | spin_unlock_irqrestore(&dev->ctl_submit_lock, flags); | |
494 | } | |
495 | ||
496 | static void cm109_toggle_buzzer_sync(struct cm109_dev *dev, int on) | |
497 | { | |
498 | int error; | |
499 | ||
500 | if (on) | |
501 | dev->ctl_data->byte[HID_OR0] |= BUZZER_ON; | |
502 | else | |
503 | dev->ctl_data->byte[HID_OR0] &= ~BUZZER_ON; | |
504 | ||
505 | error = usb_control_msg(dev->udev, | |
506 | usb_sndctrlpipe(dev->udev, 0), | |
507 | dev->ctl_req->bRequest, | |
508 | dev->ctl_req->bRequestType, | |
509 | le16_to_cpu(dev->ctl_req->wValue), | |
510 | le16_to_cpu(dev->ctl_req->wIndex), | |
511 | dev->ctl_data, | |
512 | USB_PKT_LEN, USB_CTRL_SET_TIMEOUT); | |
7b727acc | 513 | if (error < 0 && error != -EINTR) |
ab242a73 | 514 | dev_err(&dev->intf->dev, "%s: usb_control_msg() failed %d\n", |
3f37d8e8 | 515 | __func__, error); |
c04148f9 AH |
516 | } |
517 | ||
518 | static void cm109_stop_traffic(struct cm109_dev *dev) | |
519 | { | |
520 | dev->shutdown = 1; | |
521 | /* | |
522 | * Make sure other CPUs see this | |
523 | */ | |
524 | smp_wmb(); | |
525 | ||
526 | usb_kill_urb(dev->urb_ctl); | |
527 | usb_kill_urb(dev->urb_irq); | |
528 | ||
529 | cm109_toggle_buzzer_sync(dev, 0); | |
530 | ||
531 | dev->shutdown = 0; | |
532 | smp_wmb(); | |
533 | } | |
534 | ||
535 | static void cm109_restore_state(struct cm109_dev *dev) | |
536 | { | |
537 | if (dev->open) { | |
538 | /* | |
539 | * Restore buzzer state. | |
540 | * This will also kick regular URB submission | |
541 | */ | |
542 | cm109_toggle_buzzer_async(dev); | |
543 | } | |
544 | } | |
545 | ||
546 | /****************************************************************************** | |
547 | * input event interface | |
548 | *****************************************************************************/ | |
549 | ||
550 | static int cm109_input_open(struct input_dev *idev) | |
551 | { | |
552 | struct cm109_dev *dev = input_get_drvdata(idev); | |
553 | int error; | |
554 | ||
555 | error = usb_autopm_get_interface(dev->intf); | |
556 | if (error < 0) { | |
3f37d8e8 GKH |
557 | dev_err(&idev->dev, "%s - cannot autoresume, result %d\n", |
558 | __func__, error); | |
c04148f9 AH |
559 | return error; |
560 | } | |
561 | ||
562 | mutex_lock(&dev->pm_mutex); | |
563 | ||
564 | dev->buzzer_state = 0; | |
565 | dev->key_code = -1; /* no keys pressed */ | |
566 | dev->keybit = 0xf; | |
567 | ||
568 | /* issue INIT */ | |
569 | dev->ctl_data->byte[HID_OR0] = HID_OR_GPO_BUZ_SPDIF; | |
570 | dev->ctl_data->byte[HID_OR1] = dev->keybit; | |
571 | dev->ctl_data->byte[HID_OR2] = dev->keybit; | |
572 | dev->ctl_data->byte[HID_OR3] = 0x00; | |
573 | ||
574 | error = usb_submit_urb(dev->urb_ctl, GFP_KERNEL); | |
575 | if (error) | |
ab242a73 | 576 | dev_err(&dev->intf->dev, "%s: usb_submit_urb (urb_ctl) failed %d\n", |
3f37d8e8 | 577 | __func__, error); |
c04148f9 AH |
578 | else |
579 | dev->open = 1; | |
580 | ||
581 | mutex_unlock(&dev->pm_mutex); | |
582 | ||
583 | if (error) | |
584 | usb_autopm_put_interface(dev->intf); | |
585 | ||
586 | return error; | |
587 | } | |
588 | ||
589 | static void cm109_input_close(struct input_dev *idev) | |
590 | { | |
591 | struct cm109_dev *dev = input_get_drvdata(idev); | |
592 | ||
593 | mutex_lock(&dev->pm_mutex); | |
594 | ||
595 | /* | |
596 | * Once we are here event delivery is stopped so we | |
597 | * don't need to worry about someone starting buzzer | |
598 | * again | |
599 | */ | |
600 | cm109_stop_traffic(dev); | |
601 | dev->open = 0; | |
602 | ||
603 | mutex_unlock(&dev->pm_mutex); | |
604 | ||
605 | usb_autopm_put_interface(dev->intf); | |
606 | } | |
607 | ||
608 | static int cm109_input_ev(struct input_dev *idev, unsigned int type, | |
609 | unsigned int code, int value) | |
610 | { | |
611 | struct cm109_dev *dev = input_get_drvdata(idev); | |
612 | ||
ab242a73 | 613 | dev_dbg(&dev->intf->dev, |
2d517cab | 614 | "input_ev: type=%u code=%u value=%d\n", type, code, value); |
c04148f9 AH |
615 | |
616 | if (type != EV_SND) | |
617 | return -EINVAL; | |
618 | ||
619 | switch (code) { | |
620 | case SND_TONE: | |
621 | case SND_BELL: | |
622 | dev->buzzer_state = !!value; | |
623 | if (!dev->resetting) | |
624 | cm109_toggle_buzzer_async(dev); | |
625 | return 0; | |
626 | ||
627 | default: | |
628 | return -EINVAL; | |
629 | } | |
630 | } | |
631 | ||
632 | ||
633 | /****************************************************************************** | |
634 | * Linux interface and usb initialisation | |
635 | *****************************************************************************/ | |
636 | ||
637 | struct driver_info { | |
638 | char *name; | |
639 | }; | |
640 | ||
641 | static const struct driver_info info_cm109 = { | |
642 | .name = "CM109 USB driver", | |
643 | }; | |
644 | ||
645 | enum { | |
646 | VENDOR_ID = 0x0d8c, /* C-Media Electronics */ | |
647 | PRODUCT_ID_CM109 = 0x000e, /* CM109 defines range 0x0008 - 0x000f */ | |
648 | }; | |
649 | ||
650 | /* table of devices that work with this driver */ | |
651 | static const struct usb_device_id cm109_usb_table[] = { | |
652 | { | |
653 | .match_flags = USB_DEVICE_ID_MATCH_DEVICE | | |
654 | USB_DEVICE_ID_MATCH_INT_INFO, | |
655 | .idVendor = VENDOR_ID, | |
656 | .idProduct = PRODUCT_ID_CM109, | |
657 | .bInterfaceClass = USB_CLASS_HID, | |
658 | .bInterfaceSubClass = 0, | |
659 | .bInterfaceProtocol = 0, | |
660 | .driver_info = (kernel_ulong_t) &info_cm109 | |
661 | }, | |
662 | /* you can add more devices here with product ID 0x0008 - 0x000f */ | |
663 | { } | |
664 | }; | |
665 | ||
666 | static void cm109_usb_cleanup(struct cm109_dev *dev) | |
667 | { | |
0ede76fc | 668 | kfree(dev->ctl_req); |
c04148f9 | 669 | if (dev->ctl_data) |
997ea58e DM |
670 | usb_free_coherent(dev->udev, USB_PKT_LEN, |
671 | dev->ctl_data, dev->ctl_dma); | |
c04148f9 | 672 | if (dev->irq_data) |
997ea58e DM |
673 | usb_free_coherent(dev->udev, USB_PKT_LEN, |
674 | dev->irq_data, dev->irq_dma); | |
c04148f9 AH |
675 | |
676 | usb_free_urb(dev->urb_irq); /* parameter validation in core/urb */ | |
677 | usb_free_urb(dev->urb_ctl); /* parameter validation in core/urb */ | |
678 | kfree(dev); | |
679 | } | |
680 | ||
681 | static void cm109_usb_disconnect(struct usb_interface *interface) | |
682 | { | |
683 | struct cm109_dev *dev = usb_get_intfdata(interface); | |
684 | ||
685 | usb_set_intfdata(interface, NULL); | |
686 | input_unregister_device(dev->idev); | |
687 | cm109_usb_cleanup(dev); | |
688 | } | |
689 | ||
690 | static int cm109_usb_probe(struct usb_interface *intf, | |
691 | const struct usb_device_id *id) | |
692 | { | |
693 | struct usb_device *udev = interface_to_usbdev(intf); | |
694 | struct driver_info *nfo = (struct driver_info *)id->driver_info; | |
695 | struct usb_host_interface *interface; | |
696 | struct usb_endpoint_descriptor *endpoint; | |
697 | struct cm109_dev *dev; | |
698 | struct input_dev *input_dev = NULL; | |
699 | int ret, pipe, i; | |
700 | int error = -ENOMEM; | |
701 | ||
702 | interface = intf->cur_altsetting; | |
703 | endpoint = &interface->endpoint[0].desc; | |
704 | ||
705 | if (!usb_endpoint_is_int_in(endpoint)) | |
706 | return -ENODEV; | |
707 | ||
708 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); | |
709 | if (!dev) | |
710 | return -ENOMEM; | |
711 | ||
712 | spin_lock_init(&dev->ctl_submit_lock); | |
713 | mutex_init(&dev->pm_mutex); | |
714 | ||
715 | dev->udev = udev; | |
716 | dev->intf = intf; | |
717 | ||
718 | dev->idev = input_dev = input_allocate_device(); | |
719 | if (!input_dev) | |
720 | goto err_out; | |
721 | ||
722 | /* allocate usb buffers */ | |
997ea58e DM |
723 | dev->irq_data = usb_alloc_coherent(udev, USB_PKT_LEN, |
724 | GFP_KERNEL, &dev->irq_dma); | |
c04148f9 AH |
725 | if (!dev->irq_data) |
726 | goto err_out; | |
727 | ||
997ea58e DM |
728 | dev->ctl_data = usb_alloc_coherent(udev, USB_PKT_LEN, |
729 | GFP_KERNEL, &dev->ctl_dma); | |
c04148f9 AH |
730 | if (!dev->ctl_data) |
731 | goto err_out; | |
732 | ||
0ede76fc | 733 | dev->ctl_req = kmalloc(sizeof(*(dev->ctl_req)), GFP_KERNEL); |
c04148f9 AH |
734 | if (!dev->ctl_req) |
735 | goto err_out; | |
736 | ||
737 | /* allocate urb structures */ | |
738 | dev->urb_irq = usb_alloc_urb(0, GFP_KERNEL); | |
739 | if (!dev->urb_irq) | |
740 | goto err_out; | |
741 | ||
742 | dev->urb_ctl = usb_alloc_urb(0, GFP_KERNEL); | |
743 | if (!dev->urb_ctl) | |
744 | goto err_out; | |
745 | ||
746 | /* get a handle to the interrupt data pipe */ | |
747 | pipe = usb_rcvintpipe(udev, endpoint->bEndpointAddress); | |
748 | ret = usb_maxpacket(udev, pipe, usb_pipeout(pipe)); | |
749 | if (ret != USB_PKT_LEN) | |
3f37d8e8 GKH |
750 | dev_err(&intf->dev, "invalid payload size %d, expected %d\n", |
751 | ret, USB_PKT_LEN); | |
c04148f9 AH |
752 | |
753 | /* initialise irq urb */ | |
754 | usb_fill_int_urb(dev->urb_irq, udev, pipe, dev->irq_data, | |
755 | USB_PKT_LEN, | |
756 | cm109_urb_irq_callback, dev, endpoint->bInterval); | |
757 | dev->urb_irq->transfer_dma = dev->irq_dma; | |
758 | dev->urb_irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
759 | dev->urb_irq->dev = udev; | |
760 | ||
761 | /* initialise ctl urb */ | |
762 | dev->ctl_req->bRequestType = USB_TYPE_CLASS | USB_RECIP_INTERFACE | | |
763 | USB_DIR_OUT; | |
764 | dev->ctl_req->bRequest = USB_REQ_SET_CONFIGURATION; | |
765 | dev->ctl_req->wValue = cpu_to_le16(0x200); | |
766 | dev->ctl_req->wIndex = cpu_to_le16(interface->desc.bInterfaceNumber); | |
767 | dev->ctl_req->wLength = cpu_to_le16(USB_PKT_LEN); | |
768 | ||
769 | usb_fill_control_urb(dev->urb_ctl, udev, usb_sndctrlpipe(udev, 0), | |
770 | (void *)dev->ctl_req, dev->ctl_data, USB_PKT_LEN, | |
771 | cm109_urb_ctl_callback, dev); | |
c04148f9 | 772 | dev->urb_ctl->transfer_dma = dev->ctl_dma; |
0ede76fc | 773 | dev->urb_ctl->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; |
c04148f9 AH |
774 | dev->urb_ctl->dev = udev; |
775 | ||
776 | /* find out the physical bus location */ | |
777 | usb_make_path(udev, dev->phys, sizeof(dev->phys)); | |
778 | strlcat(dev->phys, "/input0", sizeof(dev->phys)); | |
779 | ||
780 | /* register settings for the input device */ | |
781 | input_dev->name = nfo->name; | |
782 | input_dev->phys = dev->phys; | |
783 | usb_to_input_id(udev, &input_dev->id); | |
784 | input_dev->dev.parent = &intf->dev; | |
785 | ||
786 | input_set_drvdata(input_dev, dev); | |
787 | input_dev->open = cm109_input_open; | |
788 | input_dev->close = cm109_input_close; | |
789 | input_dev->event = cm109_input_ev; | |
790 | ||
791 | input_dev->keycode = dev->keymap; | |
792 | input_dev->keycodesize = sizeof(unsigned char); | |
793 | input_dev->keycodemax = ARRAY_SIZE(dev->keymap); | |
794 | ||
795 | input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_SND); | |
796 | input_dev->sndbit[0] = BIT_MASK(SND_BELL) | BIT_MASK(SND_TONE); | |
797 | ||
798 | /* register available key events */ | |
799 | for (i = 0; i < KEYMAP_SIZE; i++) { | |
800 | unsigned short k = keymap(i); | |
801 | dev->keymap[i] = k; | |
802 | __set_bit(k, input_dev->keybit); | |
803 | } | |
804 | __clear_bit(KEY_RESERVED, input_dev->keybit); | |
805 | ||
806 | error = input_register_device(dev->idev); | |
807 | if (error) | |
808 | goto err_out; | |
809 | ||
810 | usb_set_intfdata(intf, dev); | |
811 | ||
812 | return 0; | |
813 | ||
814 | err_out: | |
815 | input_free_device(input_dev); | |
816 | cm109_usb_cleanup(dev); | |
817 | return error; | |
818 | } | |
819 | ||
820 | static int cm109_usb_suspend(struct usb_interface *intf, pm_message_t message) | |
821 | { | |
822 | struct cm109_dev *dev = usb_get_intfdata(intf); | |
823 | ||
2d517cab | 824 | dev_info(&intf->dev, "cm109: usb_suspend (event=%d)\n", message.event); |
c04148f9 AH |
825 | |
826 | mutex_lock(&dev->pm_mutex); | |
827 | cm109_stop_traffic(dev); | |
828 | mutex_unlock(&dev->pm_mutex); | |
829 | ||
830 | return 0; | |
831 | } | |
832 | ||
833 | static int cm109_usb_resume(struct usb_interface *intf) | |
834 | { | |
835 | struct cm109_dev *dev = usb_get_intfdata(intf); | |
836 | ||
2d517cab | 837 | dev_info(&intf->dev, "cm109: usb_resume\n"); |
c04148f9 AH |
838 | |
839 | mutex_lock(&dev->pm_mutex); | |
840 | cm109_restore_state(dev); | |
841 | mutex_unlock(&dev->pm_mutex); | |
842 | ||
843 | return 0; | |
844 | } | |
845 | ||
846 | static int cm109_usb_pre_reset(struct usb_interface *intf) | |
847 | { | |
848 | struct cm109_dev *dev = usb_get_intfdata(intf); | |
849 | ||
850 | mutex_lock(&dev->pm_mutex); | |
851 | ||
852 | /* | |
853 | * Make sure input events don't try to toggle buzzer | |
854 | * while we are resetting | |
855 | */ | |
856 | dev->resetting = 1; | |
857 | smp_wmb(); | |
858 | ||
859 | cm109_stop_traffic(dev); | |
860 | ||
861 | return 0; | |
862 | } | |
863 | ||
864 | static int cm109_usb_post_reset(struct usb_interface *intf) | |
865 | { | |
866 | struct cm109_dev *dev = usb_get_intfdata(intf); | |
867 | ||
868 | dev->resetting = 0; | |
869 | smp_wmb(); | |
870 | ||
871 | cm109_restore_state(dev); | |
872 | ||
873 | mutex_unlock(&dev->pm_mutex); | |
874 | ||
875 | return 0; | |
876 | } | |
877 | ||
878 | static struct usb_driver cm109_driver = { | |
879 | .name = "cm109", | |
880 | .probe = cm109_usb_probe, | |
881 | .disconnect = cm109_usb_disconnect, | |
882 | .suspend = cm109_usb_suspend, | |
883 | .resume = cm109_usb_resume, | |
884 | .reset_resume = cm109_usb_resume, | |
885 | .pre_reset = cm109_usb_pre_reset, | |
886 | .post_reset = cm109_usb_post_reset, | |
887 | .id_table = cm109_usb_table, | |
888 | .supports_autosuspend = 1, | |
889 | }; | |
890 | ||
891 | static int __init cm109_select_keymap(void) | |
892 | { | |
893 | /* Load the phone keymap */ | |
894 | if (!strcasecmp(phone, "kip1000")) { | |
895 | keymap = keymap_kip1000; | |
67d47641 | 896 | printk(KERN_INFO KBUILD_MODNAME ": " |
2d517cab | 897 | "Keymap for Komunikate KIP1000 phone loaded\n"); |
c04148f9 AH |
898 | } else if (!strcasecmp(phone, "gtalk")) { |
899 | keymap = keymap_gtalk; | |
67d47641 | 900 | printk(KERN_INFO KBUILD_MODNAME ": " |
2d517cab | 901 | "Keymap for Genius G-talk phone loaded\n"); |
c04148f9 AH |
902 | } else if (!strcasecmp(phone, "usbph01")) { |
903 | keymap = keymap_usbph01; | |
67d47641 | 904 | printk(KERN_INFO KBUILD_MODNAME ": " |
2d517cab | 905 | "Keymap for Allied-Telesis Corega USBPH01 phone loaded\n"); |
734f0bae DG |
906 | } else if (!strcasecmp(phone, "atcom")) { |
907 | keymap = keymap_atcom; | |
908 | printk(KERN_INFO KBUILD_MODNAME ": " | |
909 | "Keymap for ATCom AU-100 phone loaded\n"); | |
c04148f9 | 910 | } else { |
67d47641 | 911 | printk(KERN_ERR KBUILD_MODNAME ": " |
2d517cab | 912 | "Unsupported phone: %s\n", phone); |
c04148f9 AH |
913 | return -EINVAL; |
914 | } | |
915 | ||
916 | return 0; | |
917 | } | |
918 | ||
919 | static int __init cm109_init(void) | |
920 | { | |
921 | int err; | |
922 | ||
923 | err = cm109_select_keymap(); | |
924 | if (err) | |
925 | return err; | |
926 | ||
927 | err = usb_register(&cm109_driver); | |
928 | if (err) | |
929 | return err; | |
930 | ||
67d47641 | 931 | printk(KERN_INFO KBUILD_MODNAME ": " |
2d517cab | 932 | DRIVER_DESC ": " DRIVER_VERSION " (C) " DRIVER_AUTHOR "\n"); |
c04148f9 AH |
933 | |
934 | return 0; | |
935 | } | |
936 | ||
937 | static void __exit cm109_exit(void) | |
938 | { | |
939 | usb_deregister(&cm109_driver); | |
940 | } | |
941 | ||
942 | module_init(cm109_init); | |
943 | module_exit(cm109_exit); | |
944 | ||
945 | MODULE_DEVICE_TABLE(usb, cm109_usb_table); | |
946 | ||
947 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
948 | MODULE_DESCRIPTION(DRIVER_DESC); | |
949 | MODULE_LICENSE("GPL"); |