brintos

brintos / linux-shallow public Read only

0
0
Text · 6.6 KiB · 528d7f3 Raw
247 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * HID driver for CMedia CM6533 audio jack controls4 * and HS100B mute buttons5 *6 * Copyright (C) 2015 Ben Chen <ben_chen@bizlinktech.com>7 * Copyright (C) 2021 Thomas Weißschuh <linux@weissschuh.net>8 */9 10#include <linux/device.h>11#include <linux/hid.h>12#include <linux/module.h>13#include "hid-ids.h"14 15MODULE_AUTHOR("Ben Chen");16MODULE_AUTHOR("Thomas Weißschuh");17MODULE_DESCRIPTION("CM6533 HID jack controls and HS100B mute button");18MODULE_LICENSE("GPL");19 20#define CM6533_JD_TYPE_COUNT      121#define CM6533_JD_RAWEV_LEN	 1622#define CM6533_JD_SFX_OFFSET	  823 24#define HS100B_RDESC_ORIG_SIZE   6025 26/* Fixed report descriptor of HS-100B audio chip27 * Bit 4 is an abolute Microphone mute usage instead of being unassigned.28 */29static const __u8 hs100b_rdesc_fixed[] = {30	0x05, 0x0C,         /*  Usage Page (Consumer),          */31	0x09, 0x01,         /*  Usage (Consumer Control),       */32	0xA1, 0x01,         /*  Collection (Application),       */33	0x15, 0x00,         /*      Logical Minimum (0),        */34	0x25, 0x01,         /*      Logical Maximum (1),        */35	0x09, 0xE9,         /*      Usage (Volume Inc),         */36	0x09, 0xEA,         /*      Usage (Volume Dec),         */37	0x75, 0x01,         /*      Report Size (1),            */38	0x95, 0x02,         /*      Report Count (2),           */39	0x81, 0x02,         /*      Input (Variable),           */40	0x09, 0xE2,         /*      Usage (Mute),               */41	0x95, 0x01,         /*      Report Count (1),           */42	0x81, 0x06,         /*      Input (Variable, Relative), */43	0x05, 0x0B,         /*      Usage Page (Telephony),     */44	0x09, 0x2F,         /*      Usage (2Fh),                */45	0x81, 0x02,         /*      Input (Variable),           */46	0x09, 0x20,         /*      Usage (20h),                */47	0x81, 0x06,         /*      Input (Variable, Relative), */48	0x05, 0x0C,         /*      Usage Page (Consumer),      */49	0x09, 0x00,         /*      Usage (00h),                */50	0x95, 0x03,         /*      Report Count (3),           */51	0x81, 0x02,         /*      Input (Variable),           */52	0x26, 0xFF, 0x00,   /*      Logical Maximum (255),      */53	0x09, 0x00,         /*      Usage (00h),                */54	0x75, 0x08,         /*      Report Size (8),            */55	0x95, 0x03,         /*      Report Count (3),           */56	0x81, 0x02,         /*      Input (Variable),           */57	0x09, 0x00,         /*      Usage (00h),                */58	0x95, 0x04,         /*      Report Count (4),           */59	0x91, 0x02,         /*      Output (Variable),          */60	0xC0                /*  End Collection                  */61};62 63/*64*65*CM6533 audio jack HID raw events:66*67*Plug in:68*01000600 002083xx 080008c0 1000000069*about 3 seconds later...70*01000a00 002083xx 08000380 1000000071*01000600 002083xx 08000380 1000000072*73*Plug out:74*01000400 002083xx 080008c0 x000000075*/76 77static const u8 ji_sfx[] = { 0x08, 0x00, 0x08, 0xc0 };78static const u8 ji_in[]  = { 0x01, 0x00, 0x06, 0x00 };79static const u8 ji_out[] = { 0x01, 0x00, 0x04, 0x00 };80 81static int jack_switch_types[CM6533_JD_TYPE_COUNT] = {82	SW_HEADPHONE_INSERT,83};84 85struct cmhid {86	struct input_dev *input_dev;87	struct hid_device *hid;88	unsigned short switch_map[CM6533_JD_TYPE_COUNT];89};90 91static void hp_ev(struct hid_device *hid, struct cmhid *cm, int value)92{93	input_report_switch(cm->input_dev, SW_HEADPHONE_INSERT, value);94	input_sync(cm->input_dev);95}96 97static int cmhid_raw_event(struct hid_device *hid, struct hid_report *report,98	 u8 *data, int len)99{100	struct cmhid *cm = hid_get_drvdata(hid);101 102	if (len != CM6533_JD_RAWEV_LEN)103		goto out;104	if (memcmp(data+CM6533_JD_SFX_OFFSET, ji_sfx, sizeof(ji_sfx)))105		goto out;106 107	if (!memcmp(data, ji_out, sizeof(ji_out))) {108		hp_ev(hid, cm, 0);109		goto out;110	}111	if (!memcmp(data, ji_in, sizeof(ji_in))) {112		hp_ev(hid, cm, 1);113		goto out;114	}115 116out:117	return 0;118}119 120static int cmhid_input_configured(struct hid_device *hid,121		struct hid_input *hidinput)122{123	struct input_dev *input_dev = hidinput->input;124	struct cmhid *cm = hid_get_drvdata(hid);125	int i;126 127	cm->input_dev = input_dev;128	memcpy(cm->switch_map, jack_switch_types, sizeof(cm->switch_map));129	input_dev->evbit[0] = BIT(EV_SW);130	for (i = 0; i < CM6533_JD_TYPE_COUNT; i++)131		input_set_capability(cm->input_dev,132				EV_SW, jack_switch_types[i]);133	return 0;134}135 136static int cmhid_input_mapping(struct hid_device *hid,137		struct hid_input *hi, struct hid_field *field,138		struct hid_usage *usage, unsigned long **bit, int *max)139{140	return -1;141}142 143static int cmhid_probe(struct hid_device *hid, const struct hid_device_id *id)144{145	int ret;146	struct cmhid *cm;147 148	cm = kzalloc(sizeof(struct cmhid), GFP_KERNEL);149	if (!cm) {150		ret = -ENOMEM;151		goto allocfail;152	}153 154	cm->hid = hid;155 156	hid->quirks |= HID_QUIRK_HIDINPUT_FORCE;157	hid_set_drvdata(hid, cm);158 159	ret = hid_parse(hid);160	if (ret) {161		hid_err(hid, "parse failed\n");162		goto fail;163	}164 165	ret = hid_hw_start(hid, HID_CONNECT_DEFAULT | HID_CONNECT_HIDDEV_FORCE);166	if (ret) {167		hid_err(hid, "hw start failed\n");168		goto fail;169	}170 171	return 0;172fail:173	kfree(cm);174allocfail:175	return ret;176}177 178static void cmhid_remove(struct hid_device *hid)179{180	struct cmhid *cm = hid_get_drvdata(hid);181 182	hid_hw_stop(hid);183	kfree(cm);184}185 186static const struct hid_device_id cmhid_devices[] = {187	{ HID_USB_DEVICE(USB_VENDOR_ID_CMEDIA, USB_DEVICE_ID_CM6533) },188	{ }189};190MODULE_DEVICE_TABLE(hid, cmhid_devices);191 192static struct hid_driver cmhid_driver = {193	.name = "cm6533_jd",194	.id_table = cmhid_devices,195	.raw_event = cmhid_raw_event,196	.input_configured = cmhid_input_configured,197	.probe = cmhid_probe,198	.remove = cmhid_remove,199	.input_mapping = cmhid_input_mapping,200};201 202static const __u8 *cmhid_hs100b_report_fixup(struct hid_device *hid, __u8 *rdesc,203				       unsigned int *rsize)204{205	if (*rsize == HS100B_RDESC_ORIG_SIZE) {206		hid_info(hid, "Fixing CMedia HS-100B report descriptor\n");207		*rsize = sizeof(hs100b_rdesc_fixed);208		return hs100b_rdesc_fixed;209	}210	return rdesc;211}212 213static const struct hid_device_id cmhid_hs100b_devices[] = {214	{ HID_USB_DEVICE(USB_VENDOR_ID_CMEDIA, USB_DEVICE_ID_CMEDIA_HS100B) },215	{ }216};217MODULE_DEVICE_TABLE(hid, cmhid_hs100b_devices);218 219static struct hid_driver cmhid_hs100b_driver = {220	.name = "cmedia_hs100b",221	.id_table = cmhid_hs100b_devices,222	.report_fixup = cmhid_hs100b_report_fixup,223};224 225static int cmedia_init(void)226{227	int ret;228 229	ret = hid_register_driver(&cmhid_driver);230	if (ret)231		return ret;232 233	ret = hid_register_driver(&cmhid_hs100b_driver);234	if (ret)235		hid_unregister_driver(&cmhid_driver);236 237	return ret;238}239module_init(cmedia_init);240 241static void cmedia_exit(void)242{243		hid_unregister_driver(&cmhid_driver);244		hid_unregister_driver(&cmhid_hs100b_driver);245}246module_exit(cmedia_exit);247