[PATCH] input-driver-yealink-P1K-usb-phone
authorHenk <Henk.Vergonet@gmail.com>
Tue, 16 Aug 2005 14:17:43 +0000 (16:17 +0200)
committerGreg Kroah-Hartman <gregkh@suse.de>
Thu, 8 Sep 2005 23:40:57 +0000 (16:40 -0700)
This patch aggregates all modifications in the -mm tree and adds
complete ringtone support.

The following features are supported:
  - keyboard          full support
  - LCD               full support
  - LED               full support
  - dialtone          full support
  - ringtone          full support
  - audio playback    via generic usb audio diver
  - audio record      via generic usb audio diver

For driver documentation see: Documentation/input/yealink.txt
For vendor documentation see: http://yealink.com

Signed-off-by: Henk <Henk.Vergonet@gmail.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
Documentation/input/yealink.txt [new file with mode: 0644]
MAINTAINERS
drivers/usb/input/Kconfig
drivers/usb/input/Makefile
drivers/usb/input/map_to_7segment.h [new file with mode: 0644]
drivers/usb/input/yealink.c [new file with mode: 0644]
drivers/usb/input/yealink.h [new file with mode: 0644]

diff --git a/Documentation/input/yealink.txt b/Documentation/input/yealink.txt
new file mode 100644 (file)
index 0000000..5665c32
--- /dev/null
@@ -0,0 +1,187 @@
+yealink - Linux driver for usb-p1k phones
+
+0. Status
+~~~~~~~~~
+
+The p1k is a relatively cheap usb 1.1 phone with:
+  - keyboard           full support
+  - LCD                        full support
+  - LED                        full support
+  - dialtone           full support
+  - ringtone           full support
+  - audio playback     via generic usb audio diver
+  - audio record       via generic usb audio diver
+
+
+1. Compilation (stand alone version)
+~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
+
+Currently only kernel 2.6.x.y versions are supported.
+In order to build the yealink.ko module do:
+
+  make
+
+If you encounter problems please check if in the MAKE_OPTS variable in
+the Makefile is pointing to the location where your kernel sources
+are located, default /usr/src/linux.
+
+
+
+2. keyboard features
+~~~~~~~~~~~~~~~~~~~~
+The current mapping in the kernel is provided by the map_p1k_to_key
+function:
+
+   Physical USB-P1K button layout      input events
+
+
+              up                            up
+        IN           OUT               left,   right
+             down                          down
+
+      pickup   C    hangup             enter, backspace, escape
+        1      2      3                        1, 2, 3
+        4      5      6                        4, 5, 6,
+        7      8      9                        7, 8, 9,
+        *      0      #                        *, 0, #,
+
+  The "up" and "down" keys, are symbolised by arrows on the button.
+  The "pickup" and "hangup" keys are symbolised by a green and red phone
+  on the button.
+
+
+3. LCD features
+~~~~~~~~~~~~~~~
+The LCD is divided and organised as a 3 line display:
+
+    |[]   [][]   [][]   [][]   in   |[][]
+    |[] M [][] D [][] : [][]   out  |[][]
+                              store
+
+    NEW REP         SU MO TU WE TH FR SA
+
+    [] [] [] [] [] [] [] [] [] [] [] []
+    [] [] [] [] [] [] [] [] [] [] [] []
+
+
+Line 1 Format (see below)      : 18.e8.M8.88...188
+       Icon names              :   M  D  :  IN OUT STORE
+Line 2  Format                 : .........
+       Icon name               : NEW REP SU MO TU WE TH FR SA
+Line 3  Format                 : 888888888888
+
+
+Format description:
+  From a user space perspective the world is seperated in "digits" and "icons".
+  A digit can have a character set, an icon can only be ON or OFF.
+
+  Format specifier
+    '8' :  Generic 7 segment digit with individual addressable segments
+
+    Reduced capabillity 7 segm digit, when segments are hard wired together.
+    '1' : 2 segments digit only able to produce a 1.
+    'e' : Most significant day of the month digit,
+          able to produce at least 1 2 3.
+    'M' : Most significant minute digit,
+          able to produce at least 0 1 2 3 4 5.
+
+    Icons or pictograms:
+    '.' : For example like AM, PM, SU, a 'dot' .. or other single segment
+         elements.
+
+
+4. Driver usage
+~~~~~~~~~~~~~~~
+For userland the following interfaces are available using the sysfs interface:
+  /sys/.../
+           line1       Read/Write, lcd line1
+           line2       Read/Write, lcd line2
+           line3       Read/Write, lcd line3
+
+          get_icons    Read, returns a set of available icons.
+          hide_icon    Write, hide the element by writing the icon name.
+          show_icon    Write, display the element by writing the icon name.
+
+          map_seg7     Read/Write, the 7 segments char set, common for all
+                       yealink phones. (see map_to_7segment.h)
+
+          ringtone     Write, upload binary representation of a ringtone,
+                       see yealink.c. status EXPERIMENTAL due to potential
+                       races between async. and sync usb calls.
+
+
+4.1 lineX
+~~~~~~~~~
+Reading /sys/../lineX will return the format string with its current value:
+
+  Example:
+  cat ./line3
+  888888888888
+  Linux Rocks!
+
+Writing to /sys/../lineX will set the coresponding LCD line.
+ - Excess characters are ignored.
+ - If less characters are written than allowed, the remaining digits are
+   unchanged.
+ - The tab '\t'and '\n' char does not overwrite the original content.
+ - Writing a space to an icon will always hide its content.
+
+  Example:
+  date +"%m.%e.%k:%M"  | sed 's/^0/ /' > ./line1
+
+  Will update the LCD with the current date & time.
+
+
+4.2 get_icons
+~~~~~~~~~~~~~
+Reading will return all available icon names and its current settings:
+
+  cat ./get_icons
+  on M
+  on D
+  on :
+     IN
+     OUT
+     STORE
+     NEW
+     REP
+     SU
+     MO
+     TU
+     WE
+     TH
+     FR
+     SA
+     LED
+     DIALTONE
+     RINGTONE
+
+
+4.3 show/hide icons
+~~~~~~~~~~~~~~~~~~~
+Writing to these files will update the state of the icon.
+Only one icon at a time can be updated.
+
+If an icon is also on a ./lineX the corresponding value is
+updated with the first letter of the icon.
+
+  Example - light up the store icon:
+  echo -n "STORE" > ./show_icon
+
+  cat ./line1
+  18.e8.M8.88...188
+               S
+
+  Example - sound the ringtone for 10 seconds:
+  echo -n RINGTONE > /sys/..../show_icon
+  sleep 10
+  echo -n RINGTONE > /sys/..../hide_icon
+
+
+5. Credits & Acknowledgments
+~~~~~~~~~~~~~~~~~~~~~~~~~~~~
+  - Olivier Vandorpe, for starting the usbb2k-api project doing much of
+       the reverse engineering.
+  - Martin Diehl, for pointing out how to handle USB memory allocation.
+  - Dmitry Torokhov, for the numerous code reviews and suggestions.
+
index 8e4e829210708b741327b1f3aeefd032bdd3dd6c..96ddac7c21bc918cdc1f21bba32cb119f7fac9b2 100644 (file)
@@ -116,6 +116,12 @@ M: ajk@iehk.rwth-aachen.de
 L:     linux-hams@vger.kernel.org
 S:     Maintained
 
+YEALINK PHONE DRIVER
+P:     Henk Vergonet
+M:     Henk.Vergonet@gmail.com
+L:     usbb2k-api-dev@nongnu.org
+S:     Maintained
+
 8139CP 10/100 FAST ETHERNET DRIVER
 P:     Jeff Garzik
 M:     jgarzik@pobox.com
index 298e4a25e3d38e5d2187d7087212bba2c7d88c63..482c4be521f55424a68efe4cc328e93cd595c1cd 100644 (file)
@@ -230,6 +230,20 @@ config USB_EGALAX
          To compile this driver as a module, choose M here: the
          module will be called touchkitusb.
 
+config USB_YEALINK
+       tristate "Yealink usb-p1k voip phone"
+       depends on USB && INPUT && EXPERIMENTAL
+       ---help---
+         Say Y here if you want to enable keyboard and LCD functions of the
+         Yealink usb-p1k usb phones. The audio part is enabled by the generic
+         usb sound driver, so you might want to enable that as well.
+
+         For information about how to use these additional functions, see
+         <file:Documentation/input/yealink.txt>.
+
+         To compile this driver as a module, choose M here: the module will be
+         called yealink.
+
 config USB_XPAD
        tristate "X-Box gamepad support"
        depends on USB && INPUT
index f1547be632d41f10f5a71f486f71ce917e90a943..43b2f999edfeb448bccb7bf5f73962b1e3ad66da 100644 (file)
@@ -39,4 +39,5 @@ obj-$(CONFIG_USB_EGALAX)      += touchkitusb.o
 obj-$(CONFIG_USB_POWERMATE)    += powermate.o
 obj-$(CONFIG_USB_WACOM)                += wacom.o
 obj-$(CONFIG_USB_ACECAD)       += acecad.o
+obj-$(CONFIG_USB_YEALINK)      += yealink.o
 obj-$(CONFIG_USB_XPAD)         += xpad.o
diff --git a/drivers/usb/input/map_to_7segment.h b/drivers/usb/input/map_to_7segment.h
new file mode 100644 (file)
index 0000000..52ff27f
--- /dev/null
@@ -0,0 +1,189 @@
+/*
+ * drivers/usb/input/map_to_7segment.h
+ *
+ * Copyright (c) 2005 Henk Vergonet <Henk.Vergonet@gmail.com>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#ifndef MAP_TO_7SEGMENT_H
+#define MAP_TO_7SEGMENT_H
+
+/* This file provides translation primitives and tables for the conversion
+ * of (ASCII) characters to a 7-segments notation.
+ *
+ * The 7 segment's wikipedia notation below is used as standard.
+ * See: http://en.wikipedia.org/wiki/Seven_segment_display
+ *
+ * Notation:   +-a-+
+ *             f   b
+ *             +-g-+
+ *             e   c
+ *             +-d-+
+ *
+ * Usage:
+ *
+ *   Register a map variable, and fill it with a character set:
+ *     static SEG7_DEFAULT_MAP(map_seg7);
+ *
+ *
+ *   Then use for conversion:
+ *     seg7 = map_to_seg7(&map_seg7, some_char);
+ *     ...
+ *
+ * In device drivers it is recommended, if required, to make the char map
+ * accessible via the sysfs interface using the following scheme:
+ *
+ * static ssize_t show_map(struct device *dev, char *buf) {
+ *     memcpy(buf, &map_seg7, sizeof(map_seg7));
+ *     return sizeof(map_seg7);
+ * }
+ * static ssize_t store_map(struct device *dev, const char *buf, size_t cnt) {
+ *     if(cnt != sizeof(map_seg7))
+ *             return -EINVAL;
+ *     memcpy(&map_seg7, buf, cnt);
+ *     return cnt;
+ * }
+ * static DEVICE_ATTR(map_seg7, PERMS_RW, show_map, store_map);
+ *
+ * History:
+ * 2005-05-31  RFC linux-kernel@vger.kernel.org
+ */
+#include <linux/errno.h>
+
+
+#define BIT_SEG7_A             0
+#define BIT_SEG7_B             1
+#define BIT_SEG7_C             2
+#define BIT_SEG7_D             3
+#define BIT_SEG7_E             4
+#define BIT_SEG7_F             5
+#define BIT_SEG7_G             6
+#define BIT_SEG7_RESERVED      7
+
+struct seg7_conversion_map {
+       unsigned char   table[128];
+};
+
+static inline int map_to_seg7(struct seg7_conversion_map *map, int c)
+{
+       return c & 0x7f ? map->table[c] : -EINVAL;
+}
+
+#define SEG7_CONVERSION_MAP(_name, _map)       \
+       struct seg7_conversion_map _name = { .table = { _map } }
+
+/*
+ * It is recommended to use a facility that allows user space to redefine
+ * custom character sets for LCD devices. Please use a sysfs interface
+ * as described above.
+ */
+#define MAP_TO_SEG7_SYSFS_FILE "map_seg7"
+
+/*******************************************************************************
+ * ASCII conversion table
+ ******************************************************************************/
+
+#define _SEG7(l,a,b,c,d,e,f,g) \
+      (        a<<BIT_SEG7_A | b<<BIT_SEG7_B | c<<BIT_SEG7_C | d<<BIT_SEG7_D | \
+       e<<BIT_SEG7_E | f<<BIT_SEG7_F | g<<BIT_SEG7_G )
+
+#define _MAP_0_32_ASCII_SEG7_NON_PRINTABLE     \
+       0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
+
+#define _MAP_33_47_ASCII_SEG7_SYMBOL           \
+ _SEG7('!',0,0,0,0,1,1,0), _SEG7('"',0,1,0,0,0,1,0), _SEG7('#',0,1,1,0,1,1,0),\
+ _SEG7('$',1,0,1,1,0,1,1), _SEG7('%',0,0,1,0,0,1,0), _SEG7('&',1,0,1,1,1,1,1),\
+ _SEG7('\'',0,0,0,0,0,1,0),_SEG7('(',1,0,0,1,1,1,0), _SEG7(')',1,1,1,1,0,0,0),\
+ _SEG7('*',0,1,1,0,1,1,1), _SEG7('+',0,1,1,0,0,0,1), _SEG7(',',0,0,0,0,1,0,0),\
+ _SEG7('-',0,0,0,0,0,0,1), _SEG7('.',0,0,0,0,1,0,0), _SEG7('/',0,1,0,0,1,0,1),
+
+#define _MAP_48_57_ASCII_SEG7_NUMERIC          \
+ _SEG7('0',1,1,1,1,1,1,0), _SEG7('1',0,1,1,0,0,0,0), _SEG7('2',1,1,0,1,1,0,1),\
+ _SEG7('3',1,1,1,1,0,0,1), _SEG7('4',0,1,1,0,0,1,1), _SEG7('5',1,0,1,1,0,1,1),\
+ _SEG7('6',1,0,1,1,1,1,1), _SEG7('7',1,1,1,0,0,0,0), _SEG7('8',1,1,1,1,1,1,1),\
+ _SEG7('9',1,1,1,1,0,1,1),
+
+#define _MAP_58_64_ASCII_SEG7_SYMBOL           \
+ _SEG7(':',0,0,0,1,0,0,1), _SEG7(';',0,0,0,1,0,0,1), _SEG7('<',1,0,0,0,0,1,1),\
+ _SEG7('=',0,0,0,1,0,0,1), _SEG7('>',1,1,0,0,0,0,1), _SEG7('?',1,1,1,0,0,1,0),\
+ _SEG7('@',1,1,0,1,1,1,1),
+
+#define _MAP_65_90_ASCII_SEG7_ALPHA_UPPR       \
+ _SEG7('A',1,1,1,0,1,1,1), _SEG7('B',1,1,1,1,1,1,1), _SEG7('C',1,0,0,1,1,1,0),\
+ _SEG7('D',1,1,1,1,1,1,0), _SEG7('E',1,0,0,1,1,1,1), _SEG7('F',1,0,0,0,1,1,1),\
+ _SEG7('G',1,1,1,1,0,1,1), _SEG7('H',0,1,1,0,1,1,1), _SEG7('I',0,1,1,0,0,0,0),\
+ _SEG7('J',0,1,1,1,0,0,0), _SEG7('K',0,1,1,0,1,1,1), _SEG7('L',0,0,0,1,1,1,0),\
+ _SEG7('M',1,1,1,0,1,1,0), _SEG7('N',1,1,1,0,1,1,0), _SEG7('O',1,1,1,1,1,1,0),\
+ _SEG7('P',1,1,0,0,1,1,1), _SEG7('Q',1,1,1,1,1,1,0), _SEG7('R',1,1,1,0,1,1,1),\
+ _SEG7('S',1,0,1,1,0,1,1), _SEG7('T',0,0,0,1,1,1,1), _SEG7('U',0,1,1,1,1,1,0),\
+ _SEG7('V',0,1,1,1,1,1,0), _SEG7('W',0,1,1,1,1,1,1), _SEG7('X',0,1,1,0,1,1,1),\
+ _SEG7('Y',0,1,1,0,0,1,1), _SEG7('Z',1,1,0,1,1,0,1),
+
+#define _MAP_91_96_ASCII_SEG7_SYMBOL           \
+ _SEG7('[',1,0,0,1,1,1,0), _SEG7('\\',0,0,1,0,0,1,1),_SEG7(']',1,1,1,1,0,0,0),\
+ _SEG7('^',1,1,0,0,0,1,0), _SEG7('_',0,0,0,1,0,0,0), _SEG7('`',0,1,0,0,0,0,0),
+
+#define _MAP_97_122_ASCII_SEG7_ALPHA_LOWER     \
+ _SEG7('A',1,1,1,0,1,1,1), _SEG7('b',0,0,1,1,1,1,1), _SEG7('c',0,0,0,1,1,0,1),\
+ _SEG7('d',0,1,1,1,1,0,1), _SEG7('E',1,0,0,1,1,1,1), _SEG7('F',1,0,0,0,1,1,1),\
+ _SEG7('G',1,1,1,1,0,1,1), _SEG7('h',0,0,1,0,1,1,1), _SEG7('i',0,0,1,0,0,0,0),\
+ _SEG7('j',0,0,1,1,0,0,0), _SEG7('k',0,0,1,0,1,1,1), _SEG7('L',0,0,0,1,1,1,0),\
+ _SEG7('M',1,1,1,0,1,1,0), _SEG7('n',0,0,1,0,1,0,1), _SEG7('o',0,0,1,1,1,0,1),\
+ _SEG7('P',1,1,0,0,1,1,1), _SEG7('q',1,1,1,0,0,1,1), _SEG7('r',0,0,0,0,1,0,1),\
+ _SEG7('S',1,0,1,1,0,1,1), _SEG7('T',0,0,0,1,1,1,1), _SEG7('u',0,0,1,1,1,0,0),\
+ _SEG7('v',0,0,1,1,1,0,0), _SEG7('W',0,1,1,1,1,1,1), _SEG7('X',0,1,1,0,1,1,1),\
+ _SEG7('y',0,1,1,1,0,1,1), _SEG7('Z',1,1,0,1,1,0,1),
+
+#define _MAP_123_126_ASCII_SEG7_SYMBOL         \
+ _SEG7('{',1,0,0,1,1,1,0), _SEG7('|',0,0,0,0,1,1,0), _SEG7('}',1,1,1,1,0,0,0),\
+ _SEG7('~',1,0,0,0,0,0,0),
+
+/* Maps */
+
+/* This set tries to map as close as possible to the visible characteristics
+ * of the ASCII symbol, lowercase and uppercase letters may differ in
+ * presentation on the display.
+ */
+#define MAP_ASCII7SEG_ALPHANUM                 \
+       _MAP_0_32_ASCII_SEG7_NON_PRINTABLE      \
+       _MAP_33_47_ASCII_SEG7_SYMBOL            \
+       _MAP_48_57_ASCII_SEG7_NUMERIC           \
+       _MAP_58_64_ASCII_SEG7_SYMBOL            \
+       _MAP_65_90_ASCII_SEG7_ALPHA_UPPR        \
+       _MAP_91_96_ASCII_SEG7_SYMBOL            \
+       _MAP_97_122_ASCII_SEG7_ALPHA_LOWER      \
+       _MAP_123_126_ASCII_SEG7_SYMBOL
+
+/* This set tries to map as close as possible to the symbolic characteristics
+ * of the ASCII character for maximum discrimination.
+ * For now this means all alpha chars are in lower case representations.
+ * (This for example facilitates the use of hex numbers with uppercase input.)
+ */
+#define MAP_ASCII7SEG_ALPHANUM_LC                      \
+       _MAP_0_32_ASCII_SEG7_NON_PRINTABLE      \
+       _MAP_33_47_ASCII_SEG7_SYMBOL            \
+       _MAP_48_57_ASCII_SEG7_NUMERIC           \
+       _MAP_58_64_ASCII_SEG7_SYMBOL            \
+       _MAP_97_122_ASCII_SEG7_ALPHA_LOWER      \
+       _MAP_91_96_ASCII_SEG7_SYMBOL            \
+       _MAP_97_122_ASCII_SEG7_ALPHA_LOWER      \
+       _MAP_123_126_ASCII_SEG7_SYMBOL
+
+#define SEG7_DEFAULT_MAP(_name)                \
+       SEG7_CONVERSION_MAP(_name,MAP_ASCII7SEG_ALPHANUM)
+
+#endif /* MAP_TO_7SEGMENT_H */
+
diff --git a/drivers/usb/input/yealink.c b/drivers/usb/input/yealink.c
new file mode 100644 (file)
index 0000000..0748281
--- /dev/null
@@ -0,0 +1,1010 @@
+/*
+ * drivers/usb/input/yealink.c
+ *
+ * Copyright (c) 2005 Henk Vergonet <Henk.Vergonet@gmail.com>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+/*
+ * Description:
+ *   Driver for the USB-P1K voip usb phone.
+ *   This device is produced by Yealink Network Technology Co Ltd
+ *   but may be branded under several names:
+ *     - Yealink usb-p1k
+ *     - Tiptel 115
+ *     - ...
+ *
+ * This driver is based on:
+ *   - the usbb2k-api  http://savannah.nongnu.org/projects/usbb2k-api/
+ *   - information from        http://memeteau.free.fr/usbb2k
+ *   - the xpad-driver drivers/usb/input/xpad.c
+ *
+ * Thanks to:
+ *   - Olivier Vandorpe, for providing the usbb2k-api.
+ *   - Martin Diehl, for spotting my memory allocation bug.
+ *
+ * History:
+ *   20050527 henk     First version, functional keyboard. Keyboard events
+ *                     will pop-up on the ../input/eventX bus.
+ *   20050531 henk     Added led, LCD, dialtone and sysfs interface.
+ *   20050610 henk     Cleanups, make it ready for public consumption.
+ *   20050630 henk     Cleanups, fixes in response to comments.
+ *   20050701 henk     sysfs write serialisation, fix potential unload races
+ *   20050801 henk     Added ringtone, restructure USB
+ *   20050816 henk     Merge 2.6.13-rc6
+ */
+
+#include <linux/config.h>
+#include <linux/kernel.h>
+#include <linux/input.h>
+#include <linux/init.h>
+#include <linux/slab.h>
+#include <linux/module.h>
+#include <linux/rwsem.h>
+#include <linux/usb.h>
+
+#include "map_to_7segment.h"
+#include "yealink.h"
+
+#define DRIVER_VERSION "yld-20050816"
+#define DRIVER_AUTHOR "Henk Vergonet"
+#define DRIVER_DESC "Yealink phone driver"
+
+#define YEALINK_POLLING_FREQUENCY      10      /* in [Hz] */
+
+struct yld_status {
+       u8      lcd[24];
+       u8      led;
+       u8      dialtone;
+       u8      ringtone;
+       u8      keynum;
+} __attribute__ ((packed));
+
+/*
+ * Register the LCD segment and icon map
+ */
+#define _LOC(k,l)      { .a = (k), .m = (l) }
+#define _SEG(t, a, am, b, bm, c, cm, d, dm, e, em, f, fm, g, gm)       \
+       { .type = (t),                                                  \
+         .u = { .s = { _LOC(a, am), _LOC(b, bm), _LOC(c, cm),          \
+                       _LOC(d, dm), _LOC(e, em), _LOC(g, gm),          \
+                       _LOC(f, fm) } } }
+#define _PIC(t, h, hm, n)                                              \
+       { .type = (t),                                                  \
+         .u = { .p = { .name = (n), .a = (h), .m = (hm) } } }
+
+static const struct lcd_segment_map {
+       char    type;
+       union {
+               struct pictogram_map {
+                       u8      a,m;
+                       char    name[10];
+               }       p;
+               struct segment_map {
+                       u8      a,m;
+               } s[7];
+       } u;
+} lcdMap[] = {
+#include "yealink.h"
+};
+
+struct yealink_dev {
+       struct input_dev idev;          /* input device */
+       struct usb_device *udev;        /* usb device */
+
+       /* irq input channel */
+       struct yld_ctl_packet   *irq_data;
+       dma_addr_t              irq_dma;
+       struct urb              *urb_irq;
+
+       /* control output channel */
+       struct yld_ctl_packet   *ctl_data;
+       dma_addr_t              ctl_dma;
+       struct usb_ctrlrequest  *ctl_req;
+       dma_addr_t              ctl_req_dma;
+       struct urb              *urb_ctl;
+
+       char phys[64];                  /* physical device path */
+
+       u8 lcdMap[ARRAY_SIZE(lcdMap)];  /* state of LCD, LED ... */
+       int key_code;                   /* last reported key     */
+
+       int     stat_ix;
+       union {
+               struct yld_status s;
+               u8                b[sizeof(struct yld_status)];
+       } master, copy;
+};
+
+
+/*******************************************************************************
+ * Yealink lcd interface
+ ******************************************************************************/
+
+/*
+ * Register a default 7 segment character set
+ */
+static SEG7_DEFAULT_MAP(map_seg7);
+
+ /* Display a char,
+  * char '\9' and '\n' are placeholders and do not overwrite the original text.
+  * A space will always hide an icon.
+  */
+static int setChar(struct yealink_dev *yld, int el, int chr)
+{
+       int i, a, m, val;
+
+       if (el >= ARRAY_SIZE(lcdMap))
+               return -EINVAL;
+
+       if (chr == '\t' || chr == '\n')
+           return 0;
+
+       yld->lcdMap[el] = chr;
+
+       if (lcdMap[el].type == '.') {
+               a = lcdMap[el].u.p.a;
+               m = lcdMap[el].u.p.m;
+               if (chr != ' ')
+                       yld->master.b[a] |= m;
+               else
+                       yld->master.b[a] &= ~m;
+               return 0;
+       }
+
+       val = map_to_seg7(&map_seg7, chr);
+       for (i = 0; i < ARRAY_SIZE(lcdMap[0].u.s); i++) {
+               m = lcdMap[el].u.s[i].m;
+
+               if (m == 0)
+                       continue;
+
+               a = lcdMap[el].u.s[i].a;
+               if (val & 1)
+                       yld->master.b[a] |= m;
+               else
+                       yld->master.b[a] &= ~m;
+               val = val >> 1;
+       }
+       return 0;
+};
+
+/*******************************************************************************
+ * Yealink key interface
+ ******************************************************************************/
+
+/* Map device buttons to internal key events.
+ *
+ * USB-P1K button layout:
+ *
+ *             up
+ *       IN           OUT
+ *            down
+ *
+ *     pickup   C    hangup
+ *       1      2      3
+ *       4      5      6
+ *       7      8      9
+ *       *      0      #
+ *
+ * The "up" and "down" keys, are symbolised by arrows on the button.
+ * The "pickup" and "hangup" keys are symbolised by a green and red phone
+ * on the button.
+ */
+static int map_p1k_to_key(int scancode)
+{
+       switch(scancode) {              /* phone key:   */
+       case 0x23: return KEY_LEFT;     /*   IN         */
+       case 0x33: return KEY_UP;       /*   up         */
+       case 0x04: return KEY_RIGHT;    /*   OUT        */
+       case 0x24: return KEY_DOWN;     /*   down       */
+       case 0x03: return KEY_ENTER;    /*   pickup     */
+       case 0x14: return KEY_BACKSPACE; /*  C          */
+       case 0x13: return KEY_ESC;      /*   hangup     */
+       case 0x00: return KEY_1;        /*   1          */
+       case 0x01: return KEY_2;        /*   2          */
+       case 0x02: return KEY_3;        /*   3          */
+       case 0x10: return KEY_4;        /*   4          */
+       case 0x11: return KEY_5;        /*   5          */
+       case 0x12: return KEY_6;        /*   6          */
+       case 0x20: return KEY_7;        /*   7          */
+       case 0x21: return KEY_8;        /*   8          */
+       case 0x22: return KEY_9;        /*   9          */
+       case 0x30: return KEY_KPASTERISK; /* *          */
+       case 0x31: return KEY_0;        /*   0          */
+       case 0x32: return KEY_LEFTSHIFT |
+                         KEY_3 << 8;   /*   #          */
+       }
+       return -EINVAL;
+}
+
+/* Completes a request by converting the data into events for the
+ * input subsystem.
+ *
+ * The key parameter can be cascaded: key2 << 8 | key1
+ */
+static void report_key(struct yealink_dev *yld, int key, struct pt_regs *regs)
+{
+       struct input_dev *idev = &yld->idev;
+
+       input_regs(idev, regs);
+       if (yld->key_code >= 0) {
+               /* old key up */
+               input_report_key(idev, yld->key_code & 0xff, 0);
+               if (yld->key_code >> 8)
+                       input_report_key(idev, yld->key_code >> 8, 0);
+       }
+
+       yld->key_code = key;
+       if (key >= 0) {
+               /* new valid key */
+               input_report_key(idev, key & 0xff, 1);
+               if (key >> 8)
+                       input_report_key(idev, key >> 8, 1);
+       }
+       input_sync(idev);
+}
+
+/*******************************************************************************
+ * Yealink usb communication interface
+ ******************************************************************************/
+
+static int yealink_cmd(struct yealink_dev *yld, struct yld_ctl_packet *p)
+{
+       u8      *buf = (u8 *)p;
+       int     i;
+       u8      sum = 0;
+
+       for(i=0; i<USB_PKT_LEN-1; i++)
+               sum -= buf[i];
+       p->sum = sum;
+       return usb_control_msg(yld->udev,
+                       usb_sndctrlpipe(yld->udev, 0),
+                       USB_REQ_SET_CONFIGURATION,
+                       USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_OUT,
+                       0x200, 3,
+                       p, sizeof(*p),
+                       USB_CTRL_SET_TIMEOUT);
+}
+
+static u8 default_ringtone[] = {
+       0xEF,                   /* volume [0-255] */
+       0xFB, 0x1E, 0x00, 0x0C, /* 1250 [hz], 12/100 [s] */
+       0xFC, 0x18, 0x00, 0x0C, /* 1000 [hz], 12/100 [s] */
+       0xFB, 0x1E, 0x00, 0x0C,
+       0xFC, 0x18, 0x00, 0x0C,
+       0xFB, 0x1E, 0x00, 0x0C,
+       0xFC, 0x18, 0x00, 0x0C,
+       0xFB, 0x1E, 0x00, 0x0C,
+       0xFC, 0x18, 0x00, 0x0C,
+       0xFF, 0xFF, 0x01, 0x90, /* silent, 400/100 [s] */
+       0x00, 0x00              /* end of sequence */
+};
+
+static int yealink_set_ringtone(struct yealink_dev *yld, u8 *buf, size_t size)
+{
+       struct yld_ctl_packet *p = yld->ctl_data;
+       int     ix, len;
+
+       if (size <= 0)
+               return -EINVAL;
+
+       /* Set the ringtone volume */
+       memset(yld->ctl_data, 0, sizeof(*(yld->ctl_data)));
+       yld->ctl_data->cmd      = CMD_RING_VOLUME;
+       yld->ctl_data->size     = 1;
+       yld->ctl_data->data[0]  = buf[0];
+       yealink_cmd(yld, p);
+
+       buf++;
+       size--;
+
+       p->cmd = CMD_RING_NOTE;
+       ix = 0;
+       while (size != ix) {
+               len = size - ix;
+               if (len > sizeof(p->data))
+                       len = sizeof(p->data);
+               p->size   = len;
+               p->offset = htons(ix);
+               memcpy(p->data, &buf[ix], len);
+               yealink_cmd(yld, p);
+               ix += len;
+       }
+       return 0;
+}
+
+/* keep stat_master & stat_copy in sync.
+ */
+static int yealink_do_idle_tasks(struct yealink_dev *yld)
+{
+       u8 val;
+       int i, ix, len;
+
+       ix = yld->stat_ix;
+
+       memset(yld->ctl_data, 0, sizeof(*(yld->ctl_data)));
+       yld->ctl_data->cmd  = CMD_KEYPRESS;
+       yld->ctl_data->size = 1;
+       yld->ctl_data->sum  = 0xff - CMD_KEYPRESS;
+
+       /* If state update pointer wraps do a KEYPRESS first. */
+       if (ix >= sizeof(yld->master)) {
+               yld->stat_ix = 0;
+               return 0;
+       }
+
+       /* find update candidates: copy != master */
+       do {
+               val = yld->master.b[ix];
+               if (val != yld->copy.b[ix])
+                       goto send_update;
+       } while (++ix < sizeof(yld->master));
+
+       /* nothing todo, wait a bit and poll for a KEYPRESS */
+       yld->stat_ix = 0;
+       /* TODO how can we wait abit. ??
+        * msleep_interruptible(1000 / YEALINK_POLLING_FREQUENCY);
+        */
+       return 0;
+
+send_update:
+
+       /* Setup an appropriate update request */
+       yld->copy.b[ix] = val;
+       yld->ctl_data->data[0] = val;
+
+       switch(ix) {
+       case offsetof(struct yld_status, led):
+               yld->ctl_data->cmd      = CMD_LED;
+               yld->ctl_data->sum      = -1 - CMD_LED - val;
+               break;
+       case offsetof(struct yld_status, dialtone):
+               yld->ctl_data->cmd      = CMD_DIALTONE;
+               yld->ctl_data->sum      = -1 - CMD_DIALTONE - val;
+               break;
+       case offsetof(struct yld_status, ringtone):
+               yld->ctl_data->cmd      = CMD_RINGTONE;
+               yld->ctl_data->sum      = -1 - CMD_RINGTONE - val;
+               break;
+       case offsetof(struct yld_status, keynum):
+               val--;
+               val &= 0x1f;
+               yld->ctl_data->cmd      = CMD_SCANCODE;
+               yld->ctl_data->offset   = htons(val);
+               yld->ctl_data->data[0]  = 0;
+               yld->ctl_data->sum      = -1 - CMD_SCANCODE - val;
+               break;
+       default:
+               len = sizeof(yld->master.s.lcd) - ix;
+               if (len > sizeof(yld->ctl_data->data))
+                       len = sizeof(yld->ctl_data->data);
+
+               /* Combine up to <len> consecutive LCD bytes in a singe request
+                */
+               yld->ctl_data->cmd      = CMD_LCD;
+               yld->ctl_data->offset   = htons(ix);
+               yld->ctl_data->size     = len;
+               yld->ctl_data->sum      = -CMD_LCD - ix - val - len;
+               for(i=1; i<len; i++) {
+                       ix++;
+                       val = yld->master.b[ix];
+                       yld->copy.b[ix]         = val;
+                       yld->ctl_data->data[i]  = val;
+                       yld->ctl_data->sum     -= val;
+               }
+       }
+       yld->stat_ix = ix + 1;
+       return 1;
+}
+
+/* Decide on how to handle responses
+ *
+ * The state transition diagram is somethhing like:
+ *
+ *          syncState<--+
+ *               |      |
+ *               |    idle
+ *              \|/     |
+ * init --ok--> waitForKey --ok--> getKey
+ *  ^               ^                |
+ *  |               +-------ok-------+
+ * error,start
+ *
+ */
+static void urb_irq_callback(struct urb *urb, struct pt_regs *regs)
+{
+       struct yealink_dev *yld = urb->context;
+       int ret;
+
+       if (urb->status)
+               err("%s - urb status %d", __FUNCTION__, urb->status);
+
+       switch (yld->irq_data->cmd) {
+       case CMD_KEYPRESS:
+
+               yld->master.s.keynum = yld->irq_data->data[0];
+               break;
+
+       case CMD_SCANCODE:
+               dbg("get scancode %x", yld->irq_data->data[0]);
+
+               report_key(yld, map_p1k_to_key(yld->irq_data->data[0]), regs);
+               break;
+
+       default:
+               err("unexpected response %x", yld->irq_data->cmd);
+       }
+
+       yealink_do_idle_tasks(yld);
+
+       ret = usb_submit_urb(yld->urb_ctl, GFP_ATOMIC);
+       if (ret)
+               err("%s - usb_submit_urb failed %d", __FUNCTION__, ret);
+}
+
+static void urb_ctl_callback(struct urb *urb, struct pt_regs *regs)
+{
+       struct yealink_dev *yld = urb->context;
+       int ret;
+
+       if (urb->status)
+               err("%s - urb status %d", __FUNCTION__, urb->status);
+
+       switch (yld->ctl_data->cmd) {
+       case CMD_KEYPRESS:
+       case CMD_SCANCODE:
+               /* ask for a response */
+               ret = usb_submit_urb(yld->urb_irq, GFP_ATOMIC);
+               break;
+       default:
+               /* send new command */
+               yealink_do_idle_tasks(yld);
+               ret = usb_submit_urb(yld->urb_ctl, GFP_ATOMIC);
+       }
+
+       if (ret)
+               err("%s - usb_submit_urb failed %d", __FUNCTION__, ret);
+}
+
+/*******************************************************************************
+ * input event interface
+ ******************************************************************************/
+
+/* TODO should we issue a ringtone on a SND_BELL event?
+static int input_ev(struct input_dev *dev, unsigned int type,
+               unsigned int code, int value)
+{
+
+       if (type != EV_SND)
+               return -EINVAL;
+
+       switch (code) {
+       case SND_BELL:
+       case SND_TONE:
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       return 0;
+}
+*/
+
+static int input_open(struct input_dev *dev)
+{
+       struct yealink_dev *yld = dev->private;
+       int i, ret;
+
+       dbg("%s", __FUNCTION__);
+
+       /* force updates to device */
+       for (i = 0; i<sizeof(yld->master); i++)
+               yld->copy.b[i] = ~yld->master.b[i];
+       yld->key_code = -1;     /* no keys pressed */
+
+        yealink_set_ringtone(yld, default_ringtone, sizeof(default_ringtone));
+
+       /* issue INIT */
+       memset(yld->ctl_data, 0, sizeof(*(yld->ctl_data)));
+       yld->ctl_data->cmd      = CMD_INIT;
+       yld->ctl_data->size     = 10;
+       yld->ctl_data->sum      = 0x100-CMD_INIT-10;
+       if ((ret = usb_submit_urb(yld->urb_ctl, GFP_KERNEL)) != 0) {
+               dbg("%s - usb_submit_urb failed with result %d",
+                    __FUNCTION__, ret);
+               return ret;
+       }
+       return 0;
+}
+
+static void input_close(struct input_dev *dev)
+{
+       struct yealink_dev *yld = dev->private;
+
+       usb_kill_urb(yld->urb_ctl);
+       usb_kill_urb(yld->urb_irq);
+}
+
+/*******************************************************************************
+ * sysfs interface
+ ******************************************************************************/
+
+static DECLARE_RWSEM(sysfs_rwsema);
+
+/* Interface to the 7-segments translation table aka. char set.
+ */
+static ssize_t show_map(struct device *dev, struct device_attribute *attr,
+                               char *buf)
+{
+       memcpy(buf, &map_seg7, sizeof(map_seg7));
+       return sizeof(map_seg7);
+}
+
+static ssize_t store_map(struct device *dev, struct device_attribute *attr,
+                               const char *buf, size_t cnt)
+{
+       if (cnt != sizeof(map_seg7))
+               return -EINVAL;
+       memcpy(&map_seg7, buf, sizeof(map_seg7));
+       return sizeof(map_seg7);
+}
+
+/* Interface to the LCD.
+ */
+
+/* Reading /sys/../lineX will return the format string with its settings:
+ *
+ * Example:
+ * cat ./line3
+ * 888888888888
+ * Linux Rocks!
+ */
+static ssize_t show_line(struct device *dev, char *buf, int a, int b)
+{
+       struct yealink_dev *yld;
+       int i;
+
+       down_read(&sysfs_rwsema);
+       yld = dev_get_drvdata(dev);
+       if (yld == NULL) {
+               up_read(&sysfs_rwsema);
+               return -ENODEV;
+       }
+
+       for (i = a; i < b; i++)
+               *buf++ = lcdMap[i].type;
+       *buf++ = '\n';
+       for (i = a; i < b; i++)
+               *buf++ = yld->lcdMap[i];
+       *buf++ = '\n';
+       *buf = 0;
+
+       up_read(&sysfs_rwsema);
+       return 3 + ((b - a) << 1);
+}
+
+static ssize_t show_line1(struct device *dev, struct device_attribute *attr,
+                       char *buf)
+{
+       return show_line(dev, buf, LCD_LINE1_OFFSET, LCD_LINE2_OFFSET);
+}
+
+static ssize_t show_line2(struct device *dev, struct device_attribute *attr,
+                       char *buf)
+{
+       return show_line(dev, buf, LCD_LINE2_OFFSET, LCD_LINE3_OFFSET);
+}
+
+static ssize_t show_line3(struct device *dev, struct device_attribute *attr,
+                       char *buf)
+{
+       return show_line(dev, buf, LCD_LINE3_OFFSET, LCD_LINE4_OFFSET);
+}
+
+/* Writing to /sys/../lineX will set the coresponding LCD line.
+ * - Excess characters are ignored.
+ * - If less characters are written than allowed, the remaining digits are
+ *   unchanged.
+ * - The '\n' or '\t' char is a placeholder, it does not overwrite the
+ *   original content.
+ */
+static ssize_t store_line(struct device *dev, const char *buf, size_t count,
+               int el, size_t len)
+{
+       struct yealink_dev *yld;
+       int i;
+
+       down_write(&sysfs_rwsema);
+       yld = dev_get_drvdata(dev);
+       if (yld == NULL) {
+               up_write(&sysfs_rwsema);
+               return -ENODEV;
+       }
+
+       if (len > count)
+               len = count;
+       for (i = 0; i < len; i++)
+               setChar(yld, el++, buf[i]);
+
+       up_write(&sysfs_rwsema);
+       return count;
+}
+
+static ssize_t store_line1(struct device *dev, struct device_attribute *attr,
+                               const char *buf, size_t count)
+{
+       return store_line(dev, buf, count, LCD_LINE1_OFFSET, LCD_LINE1_SIZE);
+}
+
+static ssize_t store_line2(struct device *dev, struct device_attribute *attr,
+                               const char *buf, size_t count)
+{
+       return store_line(dev, buf, count, LCD_LINE2_OFFSET, LCD_LINE2_SIZE);
+}
+
+static ssize_t store_line3(struct device *dev, struct device_attribute *attr,
+                               const char *buf, size_t count)
+{
+       return store_line(dev, buf, count, LCD_LINE3_OFFSET, LCD_LINE3_SIZE);
+}
+
+/* Interface to visible and audible "icons", these include:
+ * pictures on the LCD, the LED, and the dialtone signal.
+ */
+
+/* Get a list of "switchable elements" with their current state. */
+static ssize_t get_icons(struct device *dev, struct device_attribute *attr,
+                       char *buf)
+{
+       struct yealink_dev *yld;
+       int i, ret = 1;
+
+       down_read(&sysfs_rwsema);
+       yld = dev_get_drvdata(dev);
+       if (yld == NULL) {
+               up_read(&sysfs_rwsema);
+               return -ENODEV;
+       }
+
+       for (i = 0; i < ARRAY_SIZE(lcdMap); i++) {
+               if (lcdMap[i].type != '.')
+                       continue;
+               ret += sprintf(&buf[ret], "%s %s\n",
+                               yld->lcdMap[i] == ' ' ? "  " : "on",
+                               lcdMap[i].u.p.name);
+       }
+       up_read(&sysfs_rwsema);
+       return ret;
+}
+
+/* Change the visibility of a particular element. */
+static ssize_t set_icon(struct device *dev, const char *buf, size_t count,
+                       int chr)
+{
+       struct yealink_dev *yld;
+       int i;
+
+       down_write(&sysfs_rwsema);
+       yld = dev_get_drvdata(dev);
+       if (yld == NULL) {
+               up_write(&sysfs_rwsema);
+               return -ENODEV;
+       }
+
+       for (i = 0; i < ARRAY_SIZE(lcdMap); i++) {
+               if (lcdMap[i].type != '.')
+                       continue;
+               if (strncmp(buf, lcdMap[i].u.p.name, count) == 0) {
+                       setChar(yld, i, chr);
+                       break;
+               }
+       }
+
+       up_write(&sysfs_rwsema);
+       return count;
+}
+
+static ssize_t show_icon(struct device *dev, struct device_attribute *attr,
+               const char *buf, size_t count)
+{
+       return set_icon(dev, buf, count, buf[0]);
+}
+
+static ssize_t hide_icon(struct device *dev, struct device_attribute *attr,
+               const char *buf, size_t count)
+{
+       return set_icon(dev, buf, count, ' ');
+}
+
+/* Upload a ringtone to the device.
+ */
+
+/* Stores raw ringtone data in the phone */
+static ssize_t store_ringtone(struct device *dev,
+               struct device_attribute *attr,
+               const char *buf, size_t count)
+{
+       struct yealink_dev *yld;
+
+       down_write(&sysfs_rwsema);
+       yld = dev_get_drvdata(dev);
+       if (yld == NULL) {
+               up_write(&sysfs_rwsema);
+               return -ENODEV;
+       }
+
+       /* TODO locking with async usb control interface??? */
+       yealink_set_ringtone(yld, (char *)buf, count);
+       up_write(&sysfs_rwsema);
+       return count;
+}
+
+#define _M444  S_IRUGO
+#define _M664  S_IRUGO|S_IWUSR|S_IWGRP
+#define _M220  S_IWUSR|S_IWGRP
+
+static DEVICE_ATTR(map_seg7    , _M664, show_map       , store_map     );
+static DEVICE_ATTR(line1       , _M664, show_line1     , store_line1   );
+static DEVICE_ATTR(line2       , _M664, show_line2     , store_line2   );
+static DEVICE_ATTR(line3       , _M664, show_line3     , store_line3   );
+static DEVICE_ATTR(get_icons   , _M444, get_icons      , NULL          );
+static DEVICE_ATTR(show_icon   , _M220, NULL           , show_icon     );
+static DEVICE_ATTR(hide_icon   , _M220, NULL           , hide_icon     );
+static DEVICE_ATTR(ringtone    , _M220, NULL           , store_ringtone);
+
+static struct attribute *yld_attributes[] = {
+       &dev_attr_line1.attr,
+       &dev_attr_line2.attr,
+       &dev_attr_line3.attr,
+       &dev_attr_get_icons.attr,
+       &dev_attr_show_icon.attr,
+       &dev_attr_hide_icon.attr,
+       &dev_attr_map_seg7.attr,
+       &dev_attr_ringtone.attr,
+       NULL
+};
+
+static struct attribute_group yld_attr_group = {
+       .attrs = yld_attributes
+};
+
+/*******************************************************************************
+ * Linux interface and usb initialisation
+ ******************************************************************************/
+
+static const struct yld_device {
+       u16 idVendor;
+       u16 idProduct;
+       char *name;
+} yld_device[] = {
+       { 0x6993, 0xb001, "Yealink usb-p1k" },
+};
+
+static struct usb_device_id usb_table [] = {
+       { USB_INTERFACE_INFO(USB_CLASS_HID, 0, 0) },
+       { }
+};
+
+static int usb_cleanup(struct yealink_dev *yld, int err)
+{
+       if (yld == NULL)
+               return err;
+
+        if (yld->urb_irq) {
+               usb_kill_urb(yld->urb_irq);
+               usb_free_urb(yld->urb_irq);
+       }
+        if (yld->urb_ctl)
+               usb_free_urb(yld->urb_ctl);
+        if (yld->idev.dev)
+               input_unregister_device(&yld->idev);
+       if (yld->ctl_req)
+               usb_buffer_free(yld->udev, sizeof(*(yld->ctl_req)),
+                               yld->ctl_req, yld->ctl_req_dma);
+       if (yld->ctl_data)
+               usb_buffer_free(yld->udev, USB_PKT_LEN,
+                               yld->ctl_data, yld->ctl_dma);
+       if (yld->irq_data)
+               usb_buffer_free(yld->udev, USB_PKT_LEN,
+                               yld->irq_data, yld->irq_dma);
+       kfree(yld);
+       return err;
+}
+
+static void usb_disconnect(struct usb_interface *intf)
+{
+       struct yealink_dev *yld;
+
+       down_write(&sysfs_rwsema);
+       yld = usb_get_intfdata(intf);
+       sysfs_remove_group(&intf->dev.kobj, &yld_attr_group);
+       usb_set_intfdata(intf, NULL);
+       up_write(&sysfs_rwsema);
+
+       usb_cleanup(yld, 0);
+}
+
+static int usb_match(struct usb_device *udev)
+{
+       int i;
+       for (i = 0; i < ARRAY_SIZE(yld_device); i++) {
+               if ((udev->descriptor.idVendor == yld_device[i].idVendor) &&
+                   (udev->descriptor.idProduct == yld_device[i].idProduct))
+                       return i;
+       }
+       return -ENODEV;
+}
+
+static int usb_probe(struct usb_interface *intf, const struct usb_device_id *id)
+{
+       struct usb_device *udev = interface_to_usbdev (intf);
+       struct usb_host_interface *interface;
+       struct usb_endpoint_descriptor *endpoint;
+       struct yealink_dev *yld;
+       char path[64];
+       int ret, pipe, i;
+
+       i = usb_match(udev);
+       if (i < 0)
+               return -ENODEV;
+
+       interface = intf->cur_altsetting;
+       endpoint = &interface->endpoint[0].desc;
+       if (!(endpoint->bEndpointAddress & 0x80))
+               return -EIO;
+       if ((endpoint->bmAttributes & 3) != 3)
+               return -EIO;
+
+       if ((yld = kmalloc(sizeof(struct yealink_dev), GFP_KERNEL)) == NULL)
+               return -ENOMEM;
+
+       memset(yld, 0, sizeof(*yld));
+       yld->udev = udev;
+
+       /* allocate usb buffers */
+       yld->irq_data = usb_buffer_alloc(udev, USB_PKT_LEN,
+                                       SLAB_ATOMIC, &yld->irq_dma);
+       if (yld->irq_data == NULL)
+               return usb_cleanup(yld, -ENOMEM);
+
+       yld->ctl_data = usb_buffer_alloc(udev, USB_PKT_LEN,
+                                       SLAB_ATOMIC, &yld->ctl_dma);
+       if (!yld->ctl_data)
+               return usb_cleanup(yld, -ENOMEM);
+
+       yld->ctl_req = usb_buffer_alloc(udev, sizeof(*(yld->ctl_req)),
+                                       SLAB_ATOMIC, &yld->ctl_req_dma);
+       if (yld->ctl_req == NULL)
+               return usb_cleanup(yld, -ENOMEM);
+
+       /* allocate urb structures */
+       yld->urb_irq = usb_alloc_urb(0, GFP_KERNEL);
+        if (yld->urb_irq == NULL)
+               return usb_cleanup(yld, -ENOMEM);
+
+       yld->urb_ctl = usb_alloc_urb(0, GFP_KERNEL);
+        if (yld->urb_ctl == NULL)
+               return usb_cleanup(yld, -ENOMEM);
+
+       /* get a handle to the interrupt data pipe */
+       pipe = usb_rcvintpipe(udev, endpoint->bEndpointAddress);
+       ret = usb_maxpacket(udev, pipe, usb_pipeout(pipe));
+       if (ret != USB_PKT_LEN)
+               err("invalid payload size %d, expected %d", ret, USB_PKT_LEN);
+
+       /* initialise irq urb */
+       usb_fill_int_urb(yld->urb_irq, udev, pipe, yld->irq_data,
+                       USB_PKT_LEN,
+                       urb_irq_callback,
+                       yld, endpoint->bInterval);
+       yld->urb_irq->transfer_dma = yld->irq_dma;
+       yld->urb_irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
+       yld->urb_irq->dev = udev;
+
+       /* initialise ctl urb */
+       yld->ctl_req->bRequestType = USB_TYPE_CLASS | USB_RECIP_INTERFACE |
+                                     USB_DIR_OUT;
+       yld->ctl_req->bRequest  = USB_REQ_SET_CONFIGURATION;
+       yld->ctl_req->wValue    = cpu_to_le16(0x200);
+       yld->ctl_req->wIndex    = cpu_to_le16(interface->desc.bInterfaceNumber);
+       yld->ctl_req->wLength   = cpu_to_le16(USB_PKT_LEN);
+
+       usb_fill_control_urb(yld->urb_ctl, udev, usb_sndctrlpipe(udev, 0),
+                       (void *)yld->ctl_req, yld->ctl_data, USB_PKT_LEN,
+                       urb_ctl_callback, yld);
+       yld->urb_ctl->setup_dma = yld->ctl_req_dma;
+       yld->urb_ctl->transfer_dma      = yld->ctl_dma;
+       yld->urb_ctl->transfer_flags    |= URB_NO_SETUP_DMA_MAP |
+                                       URB_NO_TRANSFER_DMA_MAP;
+       yld->urb_ctl->dev = udev;
+
+       /* find out the physical bus location */
+       if (usb_make_path(udev, path, sizeof(path)) > 0)
+               snprintf(yld->phys, sizeof(yld->phys)-1,  "%s/input0", path);
+
+       /* register settings for the input device */
+       init_input_dev(&yld->idev);
+       yld->idev.private       = yld;
+       yld->idev.id.bustype    = BUS_USB;
+       yld->idev.id.vendor     = le16_to_cpu(udev->descriptor.idVendor);
+       yld->idev.id.product    = le16_to_cpu(udev->descriptor.idProduct);
+       yld->idev.id.version    = le16_to_cpu(udev->descriptor.bcdDevice);
+       yld->idev.dev           = &intf->dev;
+       yld->idev.name          = yld_device[i].name;
+       yld->idev.phys          = yld->phys;
+       /* yld->idev.event              = input_ev;     TODO */
+       yld->idev.open          = input_open;
+       yld->idev.close         = input_close;
+
+       /* register available key events */
+       yld->idev.evbit[0] = BIT(EV_KEY);
+       for (i = 0; i < 256; i++) {
+               int k = map_p1k_to_key(i);
+               if (k >= 0) {
+                       set_bit(k & 0xff, yld->idev.keybit);
+                       if (k >> 8)
+                               set_bit(k >> 8, yld->idev.keybit);
+               }
+       }
+
+       printk(KERN_INFO "input: %s on %s\n", yld->idev.name, path);
+
+       input_register_device(&yld->idev);
+
+       usb_set_intfdata(intf, yld);
+
+       /* clear visible elements */
+       for (i=0; i<ARRAY_SIZE(lcdMap); i++)
+               setChar(yld, i, ' ');
+
+       /* display driver version on LCD line 3 */
+       store_line3(&intf->dev, NULL,
+                       DRIVER_VERSION, sizeof(DRIVER_VERSION));
+
+       /* Register sysfs hooks (don't care about failure) */
+       sysfs_create_group(&intf->dev.kobj, &yld_attr_group);
+       return 0;
+}
+
+static struct usb_driver yealink_driver = {
+       .owner          = THIS_MODULE,
+       .name           = "yealink",
+       .probe          = usb_probe,
+       .disconnect     = usb_disconnect,
+       .id_table       = usb_table,
+};
+
+static int __init yealink_dev_init(void)
+{
+       int ret = usb_register(&yealink_driver);
+       if (ret == 0)
+               info(DRIVER_DESC ":" DRIVER_VERSION);
+       return ret;
+}
+
+static void __exit yealink_dev_exit(void)
+{
+       usb_deregister(&yealink_driver);
+}
+
+module_init(yealink_dev_init);
+module_exit(yealink_dev_exit);
+
+MODULE_DEVICE_TABLE (usb, usb_table);
+
+MODULE_AUTHOR(DRIVER_AUTHOR);
+MODULE_DESCRIPTION(DRIVER_DESC);
+MODULE_LICENSE("GPL");
diff --git a/drivers/usb/input/yealink.h b/drivers/usb/input/yealink.h
new file mode 100644 (file)
index 0000000..48af0be
--- /dev/null
@@ -0,0 +1,220 @@
+/*
+ * drivers/usb/input/yealink.h
+ *
+ * Copyright (c) 2005 Henk Vergonet <Henk.Vergonet@gmail.com>
+ *
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+#ifndef INPUT_YEALINK_H
+#define INPUT_YEALINK_H
+
+/* Using the control channel on interface 3 various aspects of the phone
+ * can be controlled like LCD, LED, dialtone and the ringtone.
+ */
+
+struct yld_ctl_packet {
+       u8      cmd;            /* command code, see below */
+       u8      size;           /* 1-11, size of used data bytes. */
+       u16     offset;         /* internal packet offset */
+       u8      data[11];
+       s8      sum;            /* negative sum of 15 preceding bytes */
+} __attribute__ ((packed));
+
+#define USB_PKT_LEN    sizeof(struct yld_ctl_packet)
+
+/* The following yld_ctl_packet's are available: */
+
+/* Init registers
+ *
+ * cmd         0x8e
+ * size                10
+ * offset      0
+ * data                0,0,0,0....
+ */
+#define CMD_INIT               0x8e
+
+/* Request key scan
+ *
+ * cmd         0x80
+ * size                1
+ * offset      0
+ * data[0]     on return returns the key number, if it changes there's a new
+ *             key pressed.
+ */
+#define CMD_KEYPRESS           0x80
+
+/* Request scancode
+ *
+ * cmd         0x81
+ * size                1
+ * offset      key number [0-1f]
+ * data[0]     on return returns the scancode
+ */
+#define CMD_SCANCODE           0x81
+
+/* Set LCD
+ *
+ * cmd         0x04
+ * size                1-11
+ * offset      0-23
+ * data                segment bits
+ */
+#define CMD_LCD                        0x04
+
+/* Set led
+ *
+ * cmd         0x05
+ * size                1
+ * offset      0
+ * data[0]     0 OFF / 1 ON
+ */
+#define CMD_LED                        0x05
+
+/* Set ringtone volume
+ *
+ * cmd         0x11
+ * size                1
+ * offset      0
+ * data[0]     0-0xff  volume
+ */
+#define CMD_RING_VOLUME                0x11
+
+/* Set ringtone notes
+ *
+ * cmd         0x02
+ * size                1-11
+ * offset      0->
+ * data                binary representation LE16(-freq), LE16(duration) ....
+ */
+#define CMD_RING_NOTE          0x02
+
+/* Sound ringtone via the speaker on the back
+ *
+ * cmd         0x03
+ * size                1
+ * offset      0
+ * data[0]     0 OFF / 0x24 ON
+ */
+#define CMD_RINGTONE           0x03
+
+/* Sound dial tone via the ear speaker
+ *
+ * cmd         0x09
+ * size                1
+ * offset      0
+ * data[0]     0 OFF / 1 ON
+ */
+#define CMD_DIALTONE           0x09
+
+#endif /* INPUT_YEALINK_H */
+
+
+#if defined(_SEG) && defined(_PIC)
+/* This table maps the LCD segments onto individual bit positions in the
+ * yld_status struct.
+ */
+
+/* LCD, each segment must be driven seperately.
+ *
+ * Layout:
+ *
+ *   |[]   [][]   [][]   [][]   in   |[][]
+ *   |[] M [][] D [][] : [][]   out  |[][]
+ *                             store
+ *
+ *    NEW REP         SU MO TU WE TH FR SA
+ *
+ *    [] [] [] [] [] [] [] [] [] [] [] []
+ *    [] [] [] [] [] [] [] [] [] [] [] []
+ */
+
+/* Line 1
+ *     Format          : 18.e8.M8.88...188
+ *     Icon names      : M D : IN OUT STORE
+ */
+#define LCD_LINE1_OFFSET       0
+#define LCD_LINE1_SIZE         17
+
+/* Note: first g then f =>                            !      !      */
+/* _SEG(    type    a      b      c      d      e      g      f   )  */
+       _SEG('1',  0,0 , 22,2 , 22,2 ,  0,0 ,  0,0 ,  0,0 ,  0,0        ),
+       _SEG('8', 20,1 , 20,2 , 20,4 , 20,8 , 21,4 , 21,2 , 21,1        ),
+       _PIC('.', 22,1 , "M"                                            ),
+       _SEG('e', 18,1 , 18,2 , 18,4 , 18,1 , 19,2 , 18,1 , 19,1        ),
+       _SEG('8', 16,1 , 16,2 , 16,4 , 16,8 , 17,4 , 17,2 , 17,1        ),
+       _PIC('.', 15,8 , "D"                                            ),
+       _SEG('M', 14,1 , 14,2 , 14,4 , 14,1 , 15,4 , 15,2 , 15,1        ),
+       _SEG('8', 12,1 , 12,2 , 12,4 , 12,8 , 13,4 , 13,2 , 13,1        ),
+       _PIC('.', 11,8 , ":"                                            ),
+       _SEG('8', 10,1 , 10,2 , 10,4 , 10,8 , 11,4 , 11,2 , 11,1        ),
+       _SEG('8',  8,1 ,  8,2 ,  8,4 ,  8,8 ,  9,4 ,  9,2 ,  9,1        ),
+       _PIC('.',  7,1 , "IN"                                           ),
+       _PIC('.',  7,2 , "OUT"                                          ),
+       _PIC('.',  7,4 , "STORE"                                        ),
+       _SEG('1',  0,0 ,  5,1 ,  5,1 ,  0,0 ,  0,0 ,  0,0 ,  0,0        ),
+       _SEG('8',  4,1 ,  4,2 ,  4,4 ,  4,8 ,  5,8 ,  5,4 ,  5,2        ),
+       _SEG('8',  2,1 ,  2,2 ,  2,4 ,  2,8 ,  3,4 ,  3,2 ,  3,1        ),
+
+/* Line 2
+ *     Format          : .........
+ *     Pict. name      : NEW REP SU MO TU WE TH FR SA
+ */
+#define LCD_LINE2_OFFSET       LCD_LINE1_OFFSET + LCD_LINE1_SIZE
+#define LCD_LINE2_SIZE         9
+
+       _PIC('.', 23,2 , "NEW"  ),
+       _PIC('.', 23,4 , "REP"  ),
+       _PIC('.',  1,8 , "SU"   ),
+       _PIC('.',  1,4 , "MO"   ),
+       _PIC('.',  1,2 , "TU"   ),
+       _PIC('.',  1,1 , "WE"   ),
+       _PIC('.',  0,1 , "TH"   ),
+       _PIC('.',  0,2 , "FR"   ),
+       _PIC('.',  0,4 , "SA"   ),
+
+/* Line 3
+ *     Format          : 888888888888
+ */
+#define LCD_LINE3_OFFSET       LCD_LINE2_OFFSET + LCD_LINE2_SIZE
+#define LCD_LINE3_SIZE         12
+
+       _SEG('8', 22,16, 22,32, 22,64, 22,128, 23,128, 23,64, 23,32  ),
+       _SEG('8', 20,16, 20,32, 20,64, 20,128, 21,128, 21,64, 21,32  ),
+       _SEG('8', 18,16, 18,32, 18,64, 18,128, 19,128, 19,64, 19,32  ),
+       _SEG('8', 16,16, 16,32, 16,64, 16,128, 17,128, 17,64, 17,32  ),
+       _SEG('8', 14,16, 14,32, 14,64, 14,128, 15,128, 15,64, 15,32  ),
+       _SEG('8', 12,16, 12,32, 12,64, 12,128, 13,128, 13,64, 13,32  ),
+       _SEG('8', 10,16, 10,32, 10,64, 10,128, 11,128, 11,64, 11,32  ),
+       _SEG('8',  8,16,  8,32,  8,64,  8,128,  9,128,  9,64,  9,32  ),
+       _SEG('8',  6,16,  6,32,  6,64,  6,128,  7,128,  7,64,  7,32  ),
+       _SEG('8',  4,16,  4,32,  4,64,  4,128,  5,128,  5,64,  5,32  ),
+       _SEG('8',  2,16,  2,32,  2,64,  2,128,  3,128,  3,64,  3,32  ),
+       _SEG('8',  0,16,  0,32,  0,64,  0,128,  1,128,  1,64,  1,32  ),
+
+/* Line 4
+ *
+ * The LED, DIALTONE and RINGTONE are implemented as icons and use the same
+ * sysfs interface.
+ */
+#define LCD_LINE4_OFFSET       LCD_LINE3_OFFSET + LCD_LINE3_SIZE
+
+       _PIC('.', offsetof(struct yld_status, led)      , 0x01, "LED" ),
+       _PIC('.', offsetof(struct yld_status, dialtone) , 0x01, "DIALTONE" ),
+       _PIC('.', offsetof(struct yld_status, ringtone) , 0x24, "RINGTONE" ),
+
+#undef _SEG
+#undef _PIC
+#endif /* _SEG && _PIC */