Merge branch 'release' of master.kernel.org:/pub/scm/linux/kernel/git/aegl/linux-2.6
[linux-2.6] / drivers / usb / input / yealink.c
1 /*
2  * drivers/usb/input/yealink.c
3  *
4  * Copyright (c) 2005 Henk Vergonet <Henk.Vergonet@gmail.com>
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; either version 2 of
9  * the License, or (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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19  */
20 /*
21  * Description:
22  *   Driver for the USB-P1K voip usb phone.
23  *   This device is produced by Yealink Network Technology Co Ltd
24  *   but may be branded under several names:
25  *      - Yealink usb-p1k
26  *      - Tiptel 115
27  *      - ...
28  *
29  * This driver is based on:
30  *   - the usbb2k-api   http://savannah.nongnu.org/projects/usbb2k-api/
31  *   - information from http://memeteau.free.fr/usbb2k
32  *   - the xpad-driver  drivers/usb/input/xpad.c
33  *
34  * Thanks to:
35  *   - Olivier Vandorpe, for providing the usbb2k-api.
36  *   - Martin Diehl, for spotting my memory allocation bug.
37  *
38  * History:
39  *   20050527 henk      First version, functional keyboard. Keyboard events
40  *                      will pop-up on the ../input/eventX bus.
41  *   20050531 henk      Added led, LCD, dialtone and sysfs interface.
42  *   20050610 henk      Cleanups, make it ready for public consumption.
43  *   20050630 henk      Cleanups, fixes in response to comments.
44  *   20050701 henk      sysfs write serialisation, fix potential unload races
45  *   20050801 henk      Added ringtone, restructure USB
46  *   20050816 henk      Merge 2.6.13-rc6
47  */
48
49 #include <linux/config.h>
50 #include <linux/kernel.h>
51 #include <linux/input.h>
52 #include <linux/init.h>
53 #include <linux/slab.h>
54 #include <linux/module.h>
55 #include <linux/rwsem.h>
56 #include <linux/usb.h>
57
58 #include "map_to_7segment.h"
59 #include "yealink.h"
60
61 #define DRIVER_VERSION "yld-20050816"
62 #define DRIVER_AUTHOR "Henk Vergonet"
63 #define DRIVER_DESC "Yealink phone driver"
64
65 #define YEALINK_POLLING_FREQUENCY       10      /* in [Hz] */
66
67 struct yld_status {
68         u8      lcd[24];
69         u8      led;
70         u8      dialtone;
71         u8      ringtone;
72         u8      keynum;
73 } __attribute__ ((packed));
74
75 /*
76  * Register the LCD segment and icon map
77  */
78 #define _LOC(k,l)       { .a = (k), .m = (l) }
79 #define _SEG(t, a, am, b, bm, c, cm, d, dm, e, em, f, fm, g, gm)        \
80         { .type = (t),                                                  \
81           .u = { .s = { _LOC(a, am), _LOC(b, bm), _LOC(c, cm),          \
82                         _LOC(d, dm), _LOC(e, em), _LOC(g, gm),          \
83                         _LOC(f, fm) } } }
84 #define _PIC(t, h, hm, n)                                               \
85         { .type = (t),                                                  \
86           .u = { .p = { .name = (n), .a = (h), .m = (hm) } } }
87
88 static const struct lcd_segment_map {
89         char    type;
90         union {
91                 struct pictogram_map {
92                         u8      a,m;
93                         char    name[10];
94                 }       p;
95                 struct segment_map {
96                         u8      a,m;
97                 } s[7];
98         } u;
99 } lcdMap[] = {
100 #include "yealink.h"
101 };
102
103 struct yealink_dev {
104         struct input_dev idev;          /* input device */
105         struct usb_device *udev;        /* usb device */
106
107         /* irq input channel */
108         struct yld_ctl_packet   *irq_data;
109         dma_addr_t              irq_dma;
110         struct urb              *urb_irq;
111
112         /* control output channel */
113         struct yld_ctl_packet   *ctl_data;
114         dma_addr_t              ctl_dma;
115         struct usb_ctrlrequest  *ctl_req;
116         dma_addr_t              ctl_req_dma;
117         struct urb              *urb_ctl;
118
119         char phys[64];                  /* physical device path */
120
121         u8 lcdMap[ARRAY_SIZE(lcdMap)];  /* state of LCD, LED ... */
122         int key_code;                   /* last reported key     */
123
124         int     stat_ix;
125         union {
126                 struct yld_status s;
127                 u8                b[sizeof(struct yld_status)];
128         } master, copy;
129 };
130
131
132 /*******************************************************************************
133  * Yealink lcd interface
134  ******************************************************************************/
135
136 /*
137  * Register a default 7 segment character set
138  */
139 static SEG7_DEFAULT_MAP(map_seg7);
140
141  /* Display a char,
142   * char '\9' and '\n' are placeholders and do not overwrite the original text.
143   * A space will always hide an icon.
144   */
145 static int setChar(struct yealink_dev *yld, int el, int chr)
146 {
147         int i, a, m, val;
148
149         if (el >= ARRAY_SIZE(lcdMap))
150                 return -EINVAL;
151
152         if (chr == '\t' || chr == '\n')
153             return 0;
154
155         yld->lcdMap[el] = chr;
156
157         if (lcdMap[el].type == '.') {
158                 a = lcdMap[el].u.p.a;
159                 m = lcdMap[el].u.p.m;
160                 if (chr != ' ')
161                         yld->master.b[a] |= m;
162                 else
163                         yld->master.b[a] &= ~m;
164                 return 0;
165         }
166
167         val = map_to_seg7(&map_seg7, chr);
168         for (i = 0; i < ARRAY_SIZE(lcdMap[0].u.s); i++) {
169                 m = lcdMap[el].u.s[i].m;
170
171                 if (m == 0)
172                         continue;
173
174                 a = lcdMap[el].u.s[i].a;
175                 if (val & 1)
176                         yld->master.b[a] |= m;
177                 else
178                         yld->master.b[a] &= ~m;
179                 val = val >> 1;
180         }
181         return 0;
182 };
183
184 /*******************************************************************************
185  * Yealink key interface
186  ******************************************************************************/
187
188 /* Map device buttons to internal key events.
189  *
190  * USB-P1K button layout:
191  *
192  *             up
193  *       IN           OUT
194  *            down
195  *
196  *     pickup   C    hangup
197  *       1      2      3
198  *       4      5      6
199  *       7      8      9
200  *       *      0      #
201  *
202  * The "up" and "down" keys, are symbolised by arrows on the button.
203  * The "pickup" and "hangup" keys are symbolised by a green and red phone
204  * on the button.
205  */
206 static int map_p1k_to_key(int scancode)
207 {
208         switch(scancode) {              /* phone key:   */
209         case 0x23: return KEY_LEFT;     /*   IN         */
210         case 0x33: return KEY_UP;       /*   up         */
211         case 0x04: return KEY_RIGHT;    /*   OUT        */
212         case 0x24: return KEY_DOWN;     /*   down       */
213         case 0x03: return KEY_ENTER;    /*   pickup     */
214         case 0x14: return KEY_BACKSPACE; /*  C          */
215         case 0x13: return KEY_ESC;      /*   hangup     */
216         case 0x00: return KEY_1;        /*   1          */
217         case 0x01: return KEY_2;        /*   2          */
218         case 0x02: return KEY_3;        /*   3          */
219         case 0x10: return KEY_4;        /*   4          */
220         case 0x11: return KEY_5;        /*   5          */
221         case 0x12: return KEY_6;        /*   6          */
222         case 0x20: return KEY_7;        /*   7          */
223         case 0x21: return KEY_8;        /*   8          */
224         case 0x22: return KEY_9;        /*   9          */
225         case 0x30: return KEY_KPASTERISK; /* *          */
226         case 0x31: return KEY_0;        /*   0          */
227         case 0x32: return KEY_LEFTSHIFT |
228                           KEY_3 << 8;   /*   #          */
229         }
230         return -EINVAL;
231 }
232
233 /* Completes a request by converting the data into events for the
234  * input subsystem.
235  *
236  * The key parameter can be cascaded: key2 << 8 | key1
237  */
238 static void report_key(struct yealink_dev *yld, int key, struct pt_regs *regs)
239 {
240         struct input_dev *idev = &yld->idev;
241
242         input_regs(idev, regs);
243         if (yld->key_code >= 0) {
244                 /* old key up */
245                 input_report_key(idev, yld->key_code & 0xff, 0);
246                 if (yld->key_code >> 8)
247                         input_report_key(idev, yld->key_code >> 8, 0);
248         }
249
250         yld->key_code = key;
251         if (key >= 0) {
252                 /* new valid key */
253                 input_report_key(idev, key & 0xff, 1);
254                 if (key >> 8)
255                         input_report_key(idev, key >> 8, 1);
256         }
257         input_sync(idev);
258 }
259
260 /*******************************************************************************
261  * Yealink usb communication interface
262  ******************************************************************************/
263
264 static int yealink_cmd(struct yealink_dev *yld, struct yld_ctl_packet *p)
265 {
266         u8      *buf = (u8 *)p;
267         int     i;
268         u8      sum = 0;
269
270         for(i=0; i<USB_PKT_LEN-1; i++)
271                 sum -= buf[i];
272         p->sum = sum;
273         return usb_control_msg(yld->udev,
274                         usb_sndctrlpipe(yld->udev, 0),
275                         USB_REQ_SET_CONFIGURATION,
276                         USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_OUT,
277                         0x200, 3,
278                         p, sizeof(*p),
279                         USB_CTRL_SET_TIMEOUT);
280 }
281
282 static u8 default_ringtone[] = {
283         0xEF,                   /* volume [0-255] */
284         0xFB, 0x1E, 0x00, 0x0C, /* 1250 [hz], 12/100 [s] */
285         0xFC, 0x18, 0x00, 0x0C, /* 1000 [hz], 12/100 [s] */
286         0xFB, 0x1E, 0x00, 0x0C,
287         0xFC, 0x18, 0x00, 0x0C,
288         0xFB, 0x1E, 0x00, 0x0C,
289         0xFC, 0x18, 0x00, 0x0C,
290         0xFB, 0x1E, 0x00, 0x0C,
291         0xFC, 0x18, 0x00, 0x0C,
292         0xFF, 0xFF, 0x01, 0x90, /* silent, 400/100 [s] */
293         0x00, 0x00              /* end of sequence */
294 };
295
296 static int yealink_set_ringtone(struct yealink_dev *yld, u8 *buf, size_t size)
297 {
298         struct yld_ctl_packet *p = yld->ctl_data;
299         int     ix, len;
300
301         if (size <= 0)
302                 return -EINVAL;
303
304         /* Set the ringtone volume */
305         memset(yld->ctl_data, 0, sizeof(*(yld->ctl_data)));
306         yld->ctl_data->cmd      = CMD_RING_VOLUME;
307         yld->ctl_data->size     = 1;
308         yld->ctl_data->data[0]  = buf[0];
309         yealink_cmd(yld, p);
310
311         buf++;
312         size--;
313
314         p->cmd = CMD_RING_NOTE;
315         ix = 0;
316         while (size != ix) {
317                 len = size - ix;
318                 if (len > sizeof(p->data))
319                         len = sizeof(p->data);
320                 p->size   = len;
321                 p->offset = cpu_to_be16(ix);
322                 memcpy(p->data, &buf[ix], len);
323                 yealink_cmd(yld, p);
324                 ix += len;
325         }
326         return 0;
327 }
328
329 /* keep stat_master & stat_copy in sync.
330  */
331 static int yealink_do_idle_tasks(struct yealink_dev *yld)
332 {
333         u8 val;
334         int i, ix, len;
335
336         ix = yld->stat_ix;
337
338         memset(yld->ctl_data, 0, sizeof(*(yld->ctl_data)));
339         yld->ctl_data->cmd  = CMD_KEYPRESS;
340         yld->ctl_data->size = 1;
341         yld->ctl_data->sum  = 0xff - CMD_KEYPRESS;
342
343         /* If state update pointer wraps do a KEYPRESS first. */
344         if (ix >= sizeof(yld->master)) {
345                 yld->stat_ix = 0;
346                 return 0;
347         }
348
349         /* find update candidates: copy != master */
350         do {
351                 val = yld->master.b[ix];
352                 if (val != yld->copy.b[ix])
353                         goto send_update;
354         } while (++ix < sizeof(yld->master));
355
356         /* nothing todo, wait a bit and poll for a KEYPRESS */
357         yld->stat_ix = 0;
358         /* TODO how can we wait abit. ??
359          * msleep_interruptible(1000 / YEALINK_POLLING_FREQUENCY);
360          */
361         return 0;
362
363 send_update:
364
365         /* Setup an appropriate update request */
366         yld->copy.b[ix] = val;
367         yld->ctl_data->data[0] = val;
368
369         switch(ix) {
370         case offsetof(struct yld_status, led):
371                 yld->ctl_data->cmd      = CMD_LED;
372                 yld->ctl_data->sum      = -1 - CMD_LED - val;
373                 break;
374         case offsetof(struct yld_status, dialtone):
375                 yld->ctl_data->cmd      = CMD_DIALTONE;
376                 yld->ctl_data->sum      = -1 - CMD_DIALTONE - val;
377                 break;
378         case offsetof(struct yld_status, ringtone):
379                 yld->ctl_data->cmd      = CMD_RINGTONE;
380                 yld->ctl_data->sum      = -1 - CMD_RINGTONE - val;
381                 break;
382         case offsetof(struct yld_status, keynum):
383                 val--;
384                 val &= 0x1f;
385                 yld->ctl_data->cmd      = CMD_SCANCODE;
386                 yld->ctl_data->offset   = cpu_to_be16(val);
387                 yld->ctl_data->data[0]  = 0;
388                 yld->ctl_data->sum      = -1 - CMD_SCANCODE - val;
389                 break;
390         default:
391                 len = sizeof(yld->master.s.lcd) - ix;
392                 if (len > sizeof(yld->ctl_data->data))
393                         len = sizeof(yld->ctl_data->data);
394
395                 /* Combine up to <len> consecutive LCD bytes in a singe request
396                  */
397                 yld->ctl_data->cmd      = CMD_LCD;
398                 yld->ctl_data->offset   = cpu_to_be16(ix);
399                 yld->ctl_data->size     = len;
400                 yld->ctl_data->sum      = -CMD_LCD - ix - val - len;
401                 for(i=1; i<len; i++) {
402                         ix++;
403                         val = yld->master.b[ix];
404                         yld->copy.b[ix]         = val;
405                         yld->ctl_data->data[i]  = val;
406                         yld->ctl_data->sum     -= val;
407                 }
408         }
409         yld->stat_ix = ix + 1;
410         return 1;
411 }
412
413 /* Decide on how to handle responses
414  *
415  * The state transition diagram is somethhing like:
416  *
417  *          syncState<--+
418  *               |      |
419  *               |    idle
420  *              \|/     |
421  * init --ok--> waitForKey --ok--> getKey
422  *  ^               ^                |
423  *  |               +-------ok-------+
424  * error,start
425  *
426  */
427 static void urb_irq_callback(struct urb *urb, struct pt_regs *regs)
428 {
429         struct yealink_dev *yld = urb->context;
430         int ret;
431
432         if (urb->status)
433                 err("%s - urb status %d", __FUNCTION__, urb->status);
434
435         switch (yld->irq_data->cmd) {
436         case CMD_KEYPRESS:
437
438                 yld->master.s.keynum = yld->irq_data->data[0];
439                 break;
440
441         case CMD_SCANCODE:
442                 dbg("get scancode %x", yld->irq_data->data[0]);
443
444                 report_key(yld, map_p1k_to_key(yld->irq_data->data[0]), regs);
445                 break;
446
447         default:
448                 err("unexpected response %x", yld->irq_data->cmd);
449         }
450
451         yealink_do_idle_tasks(yld);
452
453         ret = usb_submit_urb(yld->urb_ctl, GFP_ATOMIC);
454         if (ret)
455                 err("%s - usb_submit_urb failed %d", __FUNCTION__, ret);
456 }
457
458 static void urb_ctl_callback(struct urb *urb, struct pt_regs *regs)
459 {
460         struct yealink_dev *yld = urb->context;
461         int ret;
462
463         if (urb->status)
464                 err("%s - urb status %d", __FUNCTION__, urb->status);
465
466         switch (yld->ctl_data->cmd) {
467         case CMD_KEYPRESS:
468         case CMD_SCANCODE:
469                 /* ask for a response */
470                 ret = usb_submit_urb(yld->urb_irq, GFP_ATOMIC);
471                 break;
472         default:
473                 /* send new command */
474                 yealink_do_idle_tasks(yld);
475                 ret = usb_submit_urb(yld->urb_ctl, GFP_ATOMIC);
476         }
477
478         if (ret)
479                 err("%s - usb_submit_urb failed %d", __FUNCTION__, ret);
480 }
481
482 /*******************************************************************************
483  * input event interface
484  ******************************************************************************/
485
486 /* TODO should we issue a ringtone on a SND_BELL event?
487 static int input_ev(struct input_dev *dev, unsigned int type,
488                 unsigned int code, int value)
489 {
490
491         if (type != EV_SND)
492                 return -EINVAL;
493
494         switch (code) {
495         case SND_BELL:
496         case SND_TONE:
497                 break;
498         default:
499                 return -EINVAL;
500         }
501
502         return 0;
503 }
504 */
505
506 static int input_open(struct input_dev *dev)
507 {
508         struct yealink_dev *yld = dev->private;
509         int i, ret;
510
511         dbg("%s", __FUNCTION__);
512
513         /* force updates to device */
514         for (i = 0; i<sizeof(yld->master); i++)
515                 yld->copy.b[i] = ~yld->master.b[i];
516         yld->key_code = -1;     /* no keys pressed */
517
518         yealink_set_ringtone(yld, default_ringtone, sizeof(default_ringtone));
519
520         /* issue INIT */
521         memset(yld->ctl_data, 0, sizeof(*(yld->ctl_data)));
522         yld->ctl_data->cmd      = CMD_INIT;
523         yld->ctl_data->size     = 10;
524         yld->ctl_data->sum      = 0x100-CMD_INIT-10;
525         if ((ret = usb_submit_urb(yld->urb_ctl, GFP_KERNEL)) != 0) {
526                 dbg("%s - usb_submit_urb failed with result %d",
527                      __FUNCTION__, ret);
528                 return ret;
529         }
530         return 0;
531 }
532
533 static void input_close(struct input_dev *dev)
534 {
535         struct yealink_dev *yld = dev->private;
536
537         usb_kill_urb(yld->urb_ctl);
538         usb_kill_urb(yld->urb_irq);
539 }
540
541 /*******************************************************************************
542  * sysfs interface
543  ******************************************************************************/
544
545 static DECLARE_RWSEM(sysfs_rwsema);
546
547 /* Interface to the 7-segments translation table aka. char set.
548  */
549 static ssize_t show_map(struct device *dev, struct device_attribute *attr,
550                                 char *buf)
551 {
552         memcpy(buf, &map_seg7, sizeof(map_seg7));
553         return sizeof(map_seg7);
554 }
555
556 static ssize_t store_map(struct device *dev, struct device_attribute *attr,
557                                 const char *buf, size_t cnt)
558 {
559         if (cnt != sizeof(map_seg7))
560                 return -EINVAL;
561         memcpy(&map_seg7, buf, sizeof(map_seg7));
562         return sizeof(map_seg7);
563 }
564
565 /* Interface to the LCD.
566  */
567
568 /* Reading /sys/../lineX will return the format string with its settings:
569  *
570  * Example:
571  * cat ./line3
572  * 888888888888
573  * Linux Rocks!
574  */
575 static ssize_t show_line(struct device *dev, char *buf, int a, int b)
576 {
577         struct yealink_dev *yld;
578         int i;
579
580         down_read(&sysfs_rwsema);
581         yld = dev_get_drvdata(dev);
582         if (yld == NULL) {
583                 up_read(&sysfs_rwsema);
584                 return -ENODEV;
585         }
586
587         for (i = a; i < b; i++)
588                 *buf++ = lcdMap[i].type;
589         *buf++ = '\n';
590         for (i = a; i < b; i++)
591                 *buf++ = yld->lcdMap[i];
592         *buf++ = '\n';
593         *buf = 0;
594
595         up_read(&sysfs_rwsema);
596         return 3 + ((b - a) << 1);
597 }
598
599 static ssize_t show_line1(struct device *dev, struct device_attribute *attr,
600                         char *buf)
601 {
602         return show_line(dev, buf, LCD_LINE1_OFFSET, LCD_LINE2_OFFSET);
603 }
604
605 static ssize_t show_line2(struct device *dev, struct device_attribute *attr,
606                         char *buf)
607 {
608         return show_line(dev, buf, LCD_LINE2_OFFSET, LCD_LINE3_OFFSET);
609 }
610
611 static ssize_t show_line3(struct device *dev, struct device_attribute *attr,
612                         char *buf)
613 {
614         return show_line(dev, buf, LCD_LINE3_OFFSET, LCD_LINE4_OFFSET);
615 }
616
617 /* Writing to /sys/../lineX will set the coresponding LCD line.
618  * - Excess characters are ignored.
619  * - If less characters are written than allowed, the remaining digits are
620  *   unchanged.
621  * - The '\n' or '\t' char is a placeholder, it does not overwrite the
622  *   original content.
623  */
624 static ssize_t store_line(struct device *dev, const char *buf, size_t count,
625                 int el, size_t len)
626 {
627         struct yealink_dev *yld;
628         int i;
629
630         down_write(&sysfs_rwsema);
631         yld = dev_get_drvdata(dev);
632         if (yld == NULL) {
633                 up_write(&sysfs_rwsema);
634                 return -ENODEV;
635         }
636
637         if (len > count)
638                 len = count;
639         for (i = 0; i < len; i++)
640                 setChar(yld, el++, buf[i]);
641
642         up_write(&sysfs_rwsema);
643         return count;
644 }
645
646 static ssize_t store_line1(struct device *dev, struct device_attribute *attr,
647                                 const char *buf, size_t count)
648 {
649         return store_line(dev, buf, count, LCD_LINE1_OFFSET, LCD_LINE1_SIZE);
650 }
651
652 static ssize_t store_line2(struct device *dev, struct device_attribute *attr,
653                                 const char *buf, size_t count)
654 {
655         return store_line(dev, buf, count, LCD_LINE2_OFFSET, LCD_LINE2_SIZE);
656 }
657
658 static ssize_t store_line3(struct device *dev, struct device_attribute *attr,
659                                 const char *buf, size_t count)
660 {
661         return store_line(dev, buf, count, LCD_LINE3_OFFSET, LCD_LINE3_SIZE);
662 }
663
664 /* Interface to visible and audible "icons", these include:
665  * pictures on the LCD, the LED, and the dialtone signal.
666  */
667
668 /* Get a list of "switchable elements" with their current state. */
669 static ssize_t get_icons(struct device *dev, struct device_attribute *attr,
670                         char *buf)
671 {
672         struct yealink_dev *yld;
673         int i, ret = 1;
674
675         down_read(&sysfs_rwsema);
676         yld = dev_get_drvdata(dev);
677         if (yld == NULL) {
678                 up_read(&sysfs_rwsema);
679                 return -ENODEV;
680         }
681
682         for (i = 0; i < ARRAY_SIZE(lcdMap); i++) {
683                 if (lcdMap[i].type != '.')
684                         continue;
685                 ret += sprintf(&buf[ret], "%s %s\n",
686                                 yld->lcdMap[i] == ' ' ? "  " : "on",
687                                 lcdMap[i].u.p.name);
688         }
689         up_read(&sysfs_rwsema);
690         return ret;
691 }
692
693 /* Change the visibility of a particular element. */
694 static ssize_t set_icon(struct device *dev, const char *buf, size_t count,
695                         int chr)
696 {
697         struct yealink_dev *yld;
698         int i;
699
700         down_write(&sysfs_rwsema);
701         yld = dev_get_drvdata(dev);
702         if (yld == NULL) {
703                 up_write(&sysfs_rwsema);
704                 return -ENODEV;
705         }
706
707         for (i = 0; i < ARRAY_SIZE(lcdMap); i++) {
708                 if (lcdMap[i].type != '.')
709                         continue;
710                 if (strncmp(buf, lcdMap[i].u.p.name, count) == 0) {
711                         setChar(yld, i, chr);
712                         break;
713                 }
714         }
715
716         up_write(&sysfs_rwsema);
717         return count;
718 }
719
720 static ssize_t show_icon(struct device *dev, struct device_attribute *attr,
721                 const char *buf, size_t count)
722 {
723         return set_icon(dev, buf, count, buf[0]);
724 }
725
726 static ssize_t hide_icon(struct device *dev, struct device_attribute *attr,
727                 const char *buf, size_t count)
728 {
729         return set_icon(dev, buf, count, ' ');
730 }
731
732 /* Upload a ringtone to the device.
733  */
734
735 /* Stores raw ringtone data in the phone */
736 static ssize_t store_ringtone(struct device *dev,
737                 struct device_attribute *attr,
738                 const char *buf, size_t count)
739 {
740         struct yealink_dev *yld;
741
742         down_write(&sysfs_rwsema);
743         yld = dev_get_drvdata(dev);
744         if (yld == NULL) {
745                 up_write(&sysfs_rwsema);
746                 return -ENODEV;
747         }
748
749         /* TODO locking with async usb control interface??? */
750         yealink_set_ringtone(yld, (char *)buf, count);
751         up_write(&sysfs_rwsema);
752         return count;
753 }
754
755 #define _M444   S_IRUGO
756 #define _M664   S_IRUGO|S_IWUSR|S_IWGRP
757 #define _M220   S_IWUSR|S_IWGRP
758
759 static DEVICE_ATTR(map_seg7     , _M664, show_map       , store_map     );
760 static DEVICE_ATTR(line1        , _M664, show_line1     , store_line1   );
761 static DEVICE_ATTR(line2        , _M664, show_line2     , store_line2   );
762 static DEVICE_ATTR(line3        , _M664, show_line3     , store_line3   );
763 static DEVICE_ATTR(get_icons    , _M444, get_icons      , NULL          );
764 static DEVICE_ATTR(show_icon    , _M220, NULL           , show_icon     );
765 static DEVICE_ATTR(hide_icon    , _M220, NULL           , hide_icon     );
766 static DEVICE_ATTR(ringtone     , _M220, NULL           , store_ringtone);
767
768 static struct attribute *yld_attributes[] = {
769         &dev_attr_line1.attr,
770         &dev_attr_line2.attr,
771         &dev_attr_line3.attr,
772         &dev_attr_get_icons.attr,
773         &dev_attr_show_icon.attr,
774         &dev_attr_hide_icon.attr,
775         &dev_attr_map_seg7.attr,
776         &dev_attr_ringtone.attr,
777         NULL
778 };
779
780 static struct attribute_group yld_attr_group = {
781         .attrs = yld_attributes
782 };
783
784 /*******************************************************************************
785  * Linux interface and usb initialisation
786  ******************************************************************************/
787
788 static const struct yld_device {
789         u16 idVendor;
790         u16 idProduct;
791         char *name;
792 } yld_device[] = {
793         { 0x6993, 0xb001, "Yealink usb-p1k" },
794 };
795
796 static struct usb_device_id usb_table [] = {
797         { USB_INTERFACE_INFO(USB_CLASS_HID, 0, 0) },
798         { }
799 };
800
801 static int usb_cleanup(struct yealink_dev *yld, int err)
802 {
803         if (yld == NULL)
804                 return err;
805
806         if (yld->urb_irq) {
807                 usb_kill_urb(yld->urb_irq);
808                 usb_free_urb(yld->urb_irq);
809         }
810         if (yld->urb_ctl)
811                 usb_free_urb(yld->urb_ctl);
812         if (yld->idev.dev)
813                 input_unregister_device(&yld->idev);
814         if (yld->ctl_req)
815                 usb_buffer_free(yld->udev, sizeof(*(yld->ctl_req)),
816                                 yld->ctl_req, yld->ctl_req_dma);
817         if (yld->ctl_data)
818                 usb_buffer_free(yld->udev, USB_PKT_LEN,
819                                 yld->ctl_data, yld->ctl_dma);
820         if (yld->irq_data)
821                 usb_buffer_free(yld->udev, USB_PKT_LEN,
822                                 yld->irq_data, yld->irq_dma);
823         kfree(yld);
824         return err;
825 }
826
827 static void usb_disconnect(struct usb_interface *intf)
828 {
829         struct yealink_dev *yld;
830
831         down_write(&sysfs_rwsema);
832         yld = usb_get_intfdata(intf);
833         sysfs_remove_group(&intf->dev.kobj, &yld_attr_group);
834         usb_set_intfdata(intf, NULL);
835         up_write(&sysfs_rwsema);
836
837         usb_cleanup(yld, 0);
838 }
839
840 static int usb_match(struct usb_device *udev)
841 {
842         int i;
843         u16 idVendor = le16_to_cpu(udev->descriptor.idVendor);
844         u16 idProduct = le16_to_cpu(udev->descriptor.idProduct);
845
846         for (i = 0; i < ARRAY_SIZE(yld_device); i++) {
847                 if ((idVendor == yld_device[i].idVendor) &&
848                     (idProduct == yld_device[i].idProduct))
849                         return i;
850         }
851         return -ENODEV;
852 }
853
854 static int usb_probe(struct usb_interface *intf, const struct usb_device_id *id)
855 {
856         struct usb_device *udev = interface_to_usbdev (intf);
857         struct usb_host_interface *interface;
858         struct usb_endpoint_descriptor *endpoint;
859         struct yealink_dev *yld;
860         char path[64];
861         int ret, pipe, i;
862
863         i = usb_match(udev);
864         if (i < 0)
865                 return -ENODEV;
866
867         interface = intf->cur_altsetting;
868         endpoint = &interface->endpoint[0].desc;
869         if (!(endpoint->bEndpointAddress & 0x80))
870                 return -EIO;
871         if ((endpoint->bmAttributes & 3) != 3)
872                 return -EIO;
873
874         if ((yld = kmalloc(sizeof(struct yealink_dev), GFP_KERNEL)) == NULL)
875                 return -ENOMEM;
876
877         memset(yld, 0, sizeof(*yld));
878         yld->udev = udev;
879
880         /* allocate usb buffers */
881         yld->irq_data = usb_buffer_alloc(udev, USB_PKT_LEN,
882                                         SLAB_ATOMIC, &yld->irq_dma);
883         if (yld->irq_data == NULL)
884                 return usb_cleanup(yld, -ENOMEM);
885
886         yld->ctl_data = usb_buffer_alloc(udev, USB_PKT_LEN,
887                                         SLAB_ATOMIC, &yld->ctl_dma);
888         if (!yld->ctl_data)
889                 return usb_cleanup(yld, -ENOMEM);
890
891         yld->ctl_req = usb_buffer_alloc(udev, sizeof(*(yld->ctl_req)),
892                                         SLAB_ATOMIC, &yld->ctl_req_dma);
893         if (yld->ctl_req == NULL)
894                 return usb_cleanup(yld, -ENOMEM);
895
896         /* allocate urb structures */
897         yld->urb_irq = usb_alloc_urb(0, GFP_KERNEL);
898         if (yld->urb_irq == NULL)
899                 return usb_cleanup(yld, -ENOMEM);
900
901         yld->urb_ctl = usb_alloc_urb(0, GFP_KERNEL);
902         if (yld->urb_ctl == NULL)
903                 return usb_cleanup(yld, -ENOMEM);
904
905         /* get a handle to the interrupt data pipe */
906         pipe = usb_rcvintpipe(udev, endpoint->bEndpointAddress);
907         ret = usb_maxpacket(udev, pipe, usb_pipeout(pipe));
908         if (ret != USB_PKT_LEN)
909                 err("invalid payload size %d, expected %d", ret, USB_PKT_LEN);
910
911         /* initialise irq urb */
912         usb_fill_int_urb(yld->urb_irq, udev, pipe, yld->irq_data,
913                         USB_PKT_LEN,
914                         urb_irq_callback,
915                         yld, endpoint->bInterval);
916         yld->urb_irq->transfer_dma = yld->irq_dma;
917         yld->urb_irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
918         yld->urb_irq->dev = udev;
919
920         /* initialise ctl urb */
921         yld->ctl_req->bRequestType = USB_TYPE_CLASS | USB_RECIP_INTERFACE |
922                                       USB_DIR_OUT;
923         yld->ctl_req->bRequest  = USB_REQ_SET_CONFIGURATION;
924         yld->ctl_req->wValue    = cpu_to_le16(0x200);
925         yld->ctl_req->wIndex    = cpu_to_le16(interface->desc.bInterfaceNumber);
926         yld->ctl_req->wLength   = cpu_to_le16(USB_PKT_LEN);
927
928         usb_fill_control_urb(yld->urb_ctl, udev, usb_sndctrlpipe(udev, 0),
929                         (void *)yld->ctl_req, yld->ctl_data, USB_PKT_LEN,
930                         urb_ctl_callback, yld);
931         yld->urb_ctl->setup_dma = yld->ctl_req_dma;
932         yld->urb_ctl->transfer_dma      = yld->ctl_dma;
933         yld->urb_ctl->transfer_flags    |= URB_NO_SETUP_DMA_MAP |
934                                         URB_NO_TRANSFER_DMA_MAP;
935         yld->urb_ctl->dev = udev;
936
937         /* find out the physical bus location */
938         if (usb_make_path(udev, path, sizeof(path)) > 0)
939                 snprintf(yld->phys, sizeof(yld->phys)-1,  "%s/input0", path);
940
941         /* register settings for the input device */
942         init_input_dev(&yld->idev);
943         yld->idev.private       = yld;
944         yld->idev.id.bustype    = BUS_USB;
945         yld->idev.id.vendor     = le16_to_cpu(udev->descriptor.idVendor);
946         yld->idev.id.product    = le16_to_cpu(udev->descriptor.idProduct);
947         yld->idev.id.version    = le16_to_cpu(udev->descriptor.bcdDevice);
948         yld->idev.dev           = &intf->dev;
949         yld->idev.name          = yld_device[i].name;
950         yld->idev.phys          = yld->phys;
951         /* yld->idev.event              = input_ev;     TODO */
952         yld->idev.open          = input_open;
953         yld->idev.close         = input_close;
954
955         /* register available key events */
956         yld->idev.evbit[0] = BIT(EV_KEY);
957         for (i = 0; i < 256; i++) {
958                 int k = map_p1k_to_key(i);
959                 if (k >= 0) {
960                         set_bit(k & 0xff, yld->idev.keybit);
961                         if (k >> 8)
962                                 set_bit(k >> 8, yld->idev.keybit);
963                 }
964         }
965
966         printk(KERN_INFO "input: %s on %s\n", yld->idev.name, path);
967
968         input_register_device(&yld->idev);
969
970         usb_set_intfdata(intf, yld);
971
972         /* clear visible elements */
973         for (i=0; i<ARRAY_SIZE(lcdMap); i++)
974                 setChar(yld, i, ' ');
975
976         /* display driver version on LCD line 3 */
977         store_line3(&intf->dev, NULL,
978                         DRIVER_VERSION, sizeof(DRIVER_VERSION));
979
980         /* Register sysfs hooks (don't care about failure) */
981         sysfs_create_group(&intf->dev.kobj, &yld_attr_group);
982         return 0;
983 }
984
985 static struct usb_driver yealink_driver = {
986         .owner          = THIS_MODULE,
987         .name           = "yealink",
988         .probe          = usb_probe,
989         .disconnect     = usb_disconnect,
990         .id_table       = usb_table,
991 };
992
993 static int __init yealink_dev_init(void)
994 {
995         int ret = usb_register(&yealink_driver);
996         if (ret == 0)
997                 info(DRIVER_DESC ":" DRIVER_VERSION);
998         return ret;
999 }
1000
1001 static void __exit yealink_dev_exit(void)
1002 {
1003         usb_deregister(&yealink_driver);
1004 }
1005
1006 module_init(yealink_dev_init);
1007 module_exit(yealink_dev_exit);
1008
1009 MODULE_DEVICE_TABLE (usb, usb_table);
1010
1011 MODULE_AUTHOR(DRIVER_AUTHOR);
1012 MODULE_DESCRIPTION(DRIVER_DESC);
1013 MODULE_LICENSE("GPL");