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