1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * HID driver for CMedia CM6533 audio jack controls
4 *
5 * Copyright (C) 2015 Ben Chen <ben_chen@bizlinktech.com>
6 */
7
8 #include <linux/device.h>
9 #include <linux/hid.h>
10 #include <linux/module.h>
11 #include "hid-ids.h"
12
13 MODULE_AUTHOR("Ben Chen");
14 MODULE_DESCRIPTION("CM6533 HID jack controls");
15 MODULE_LICENSE("GPL");
16
17 #define CM6533_JD_TYPE_COUNT 1
18 #define CM6533_JD_RAWEV_LEN 16
19 #define CM6533_JD_SFX_OFFSET 8
20
21 /*
22 *
23 *CM6533 audio jack HID raw events:
24 *
25 *Plug in:
26 *01000600 002083xx 080008c0 10000000
27 *about 3 seconds later...
28 *01000a00 002083xx 08000380 10000000
29 *01000600 002083xx 08000380 10000000
30 *
31 *Plug out:
32 *01000400 002083xx 080008c0 x0000000
33 */
34
35 static const u8 ji_sfx[] = { 0x08, 0x00, 0x08, 0xc0 };
36 static const u8 ji_in[] = { 0x01, 0x00, 0x06, 0x00 };
37 static const u8 ji_out[] = { 0x01, 0x00, 0x04, 0x00 };
38
39 static int jack_switch_types[CM6533_JD_TYPE_COUNT] = {
40 SW_HEADPHONE_INSERT,
41 };
42
43 struct cmhid {
44 struct input_dev *input_dev;
45 struct hid_device *hid;
46 unsigned short switch_map[CM6533_JD_TYPE_COUNT];
47 };
48
hp_ev(struct hid_device * hid,struct cmhid * cm,int value)49 static void hp_ev(struct hid_device *hid, struct cmhid *cm, int value)
50 {
51 input_report_switch(cm->input_dev, SW_HEADPHONE_INSERT, value);
52 input_sync(cm->input_dev);
53 }
54
cmhid_raw_event(struct hid_device * hid,struct hid_report * report,u8 * data,int len)55 static int cmhid_raw_event(struct hid_device *hid, struct hid_report *report,
56 u8 *data, int len)
57 {
58 struct cmhid *cm = hid_get_drvdata(hid);
59
60 if (len != CM6533_JD_RAWEV_LEN)
61 goto out;
62 if (memcmp(data+CM6533_JD_SFX_OFFSET, ji_sfx, sizeof(ji_sfx)))
63 goto out;
64
65 if (!memcmp(data, ji_out, sizeof(ji_out))) {
66 hp_ev(hid, cm, 0);
67 goto out;
68 }
69 if (!memcmp(data, ji_in, sizeof(ji_in))) {
70 hp_ev(hid, cm, 1);
71 goto out;
72 }
73
74 out:
75 return 0;
76 }
77
cmhid_input_configured(struct hid_device * hid,struct hid_input * hidinput)78 static int cmhid_input_configured(struct hid_device *hid,
79 struct hid_input *hidinput)
80 {
81 struct input_dev *input_dev = hidinput->input;
82 struct cmhid *cm = hid_get_drvdata(hid);
83 int i;
84
85 cm->input_dev = input_dev;
86 memcpy(cm->switch_map, jack_switch_types, sizeof(cm->switch_map));
87 input_dev->evbit[0] = BIT(EV_SW);
88 for (i = 0; i < CM6533_JD_TYPE_COUNT; i++)
89 input_set_capability(cm->input_dev,
90 EV_SW, jack_switch_types[i]);
91 return 0;
92 }
93
cmhid_input_mapping(struct hid_device * hid,struct hid_input * hi,struct hid_field * field,struct hid_usage * usage,unsigned long ** bit,int * max)94 static int cmhid_input_mapping(struct hid_device *hid,
95 struct hid_input *hi, struct hid_field *field,
96 struct hid_usage *usage, unsigned long **bit, int *max)
97 {
98 return -1;
99 }
100
cmhid_probe(struct hid_device * hid,const struct hid_device_id * id)101 static int cmhid_probe(struct hid_device *hid, const struct hid_device_id *id)
102 {
103 int ret;
104 struct cmhid *cm;
105
106 cm = kzalloc(sizeof(struct cmhid), GFP_KERNEL);
107 if (!cm) {
108 ret = -ENOMEM;
109 goto allocfail;
110 }
111
112 cm->hid = hid;
113
114 hid->quirks |= HID_QUIRK_HIDINPUT_FORCE;
115 hid_set_drvdata(hid, cm);
116
117 ret = hid_parse(hid);
118 if (ret) {
119 hid_err(hid, "parse failed\n");
120 goto fail;
121 }
122
123 ret = hid_hw_start(hid, HID_CONNECT_DEFAULT | HID_CONNECT_HIDDEV_FORCE);
124 if (ret) {
125 hid_err(hid, "hw start failed\n");
126 goto fail;
127 }
128
129 return 0;
130 fail:
131 kfree(cm);
132 allocfail:
133 return ret;
134 }
135
cmhid_remove(struct hid_device * hid)136 static void cmhid_remove(struct hid_device *hid)
137 {
138 struct cmhid *cm = hid_get_drvdata(hid);
139
140 hid_hw_stop(hid);
141 kfree(cm);
142 }
143
144 static const struct hid_device_id cmhid_devices[] = {
145 { HID_USB_DEVICE(USB_VENDOR_ID_CMEDIA, USB_DEVICE_ID_CM6533) },
146 { }
147 };
148 MODULE_DEVICE_TABLE(hid, cmhid_devices);
149
150 static struct hid_driver cmhid_driver = {
151 .name = "cm6533_jd",
152 .id_table = cmhid_devices,
153 .raw_event = cmhid_raw_event,
154 .input_configured = cmhid_input_configured,
155 .probe = cmhid_probe,
156 .remove = cmhid_remove,
157 .input_mapping = cmhid_input_mapping,
158 };
159 module_hid_driver(cmhid_driver);
160
161