[linux-2.6-block.git] / drivers / hid / hid-cmedia.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * HID driver for CMedia CM6533 audio jack controls
 *
 * Copyright (C) 2015 Ben Chen <ben_chen@bizlinktech.com>
 */

#include <linux/device.h>
#include <linux/hid.h>
#include <linux/module.h>
#include "hid-ids.h"

MODULE_AUTHOR("Ben Chen");
MODULE_DESCRIPTION("CM6533 HID jack controls");
MODULE_LICENSE("GPL");

#define CM6533_JD_TYPE_COUNT      1
#define CM6533_JD_RAWEV_LEN	 16
#define CM6533_JD_SFX_OFFSET	  8

/*
*
*CM6533 audio jack HID raw events:
*
*Plug in:
*01000600 002083xx 080008c0 10000000
*about 3 seconds later...
*01000a00 002083xx 08000380 10000000
*01000600 002083xx 08000380 10000000
*
*Plug out:
*01000400 002083xx 080008c0 x0000000
*/

static const u8 ji_sfx[] = { 0x08, 0x00, 0x08, 0xc0 };
static const u8 ji_in[]  = { 0x01, 0x00, 0x06, 0x00 };
static const u8 ji_out[] = { 0x01, 0x00, 0x04, 0x00 };

static int jack_switch_types[CM6533_JD_TYPE_COUNT] = {
	SW_HEADPHONE_INSERT,
};

struct cmhid {
	struct input_dev *input_dev;
	struct hid_device *hid;
	unsigned short switch_map[CM6533_JD_TYPE_COUNT];
};

static void hp_ev(struct hid_device *hid, struct cmhid *cm, int value)
{
	input_report_switch(cm->input_dev, SW_HEADPHONE_INSERT, value);
	input_sync(cm->input_dev);
}

static int cmhid_raw_event(struct hid_device *hid, struct hid_report *report,
	 u8 *data, int len)
{
	struct cmhid *cm = hid_get_drvdata(hid);

	if (len != CM6533_JD_RAWEV_LEN)
		goto out;
	if (memcmp(data+CM6533_JD_SFX_OFFSET, ji_sfx, sizeof(ji_sfx)))
		goto out;

	if (!memcmp(data, ji_out, sizeof(ji_out))) {
		hp_ev(hid, cm, 0);
		goto out;
	}
	if (!memcmp(data, ji_in, sizeof(ji_in))) {
		hp_ev(hid, cm, 1);
		goto out;
	}

out:
	return 0;
}

static int cmhid_input_configured(struct hid_device *hid,
		struct hid_input *hidinput)
{
	struct input_dev *input_dev = hidinput->input;
	struct cmhid *cm = hid_get_drvdata(hid);
	int i;

	cm->input_dev = input_dev;
	memcpy(cm->switch_map, jack_switch_types, sizeof(cm->switch_map));
	input_dev->evbit[0] = BIT(EV_SW);
	for (i = 0; i < CM6533_JD_TYPE_COUNT; i++)
		input_set_capability(cm->input_dev,
				EV_SW, jack_switch_types[i]);
	return 0;
}

static int cmhid_input_mapping(struct hid_device *hid,
		struct hid_input *hi, struct hid_field *field,
		struct hid_usage *usage, unsigned long **bit, int *max)
{
	return -1;
}

static int cmhid_probe(struct hid_device *hid, const struct hid_device_id *id)
{
	int ret;
	struct cmhid *cm;

	cm = kzalloc(sizeof(struct cmhid), GFP_KERNEL);
	if (!cm) {
		ret = -ENOMEM;
		goto allocfail;
	}

	cm->hid = hid;

	hid->quirks |= HID_QUIRK_HIDINPUT_FORCE;
	hid_set_drvdata(hid, cm);

	ret = hid_parse(hid);
	if (ret) {
		hid_err(hid, "parse failed\n");
		goto fail;
	}

	ret = hid_hw_start(hid, HID_CONNECT_DEFAULT | HID_CONNECT_HIDDEV_FORCE);
	if (ret) {
		hid_err(hid, "hw start failed\n");
		goto fail;
	}

	return 0;
fail:
	kfree(cm);
allocfail:
	return ret;
}

static void cmhid_remove(struct hid_device *hid)
{
	struct cmhid *cm = hid_get_drvdata(hid);

	hid_hw_stop(hid);
	kfree(cm);
}

static const struct hid_device_id cmhid_devices[] = {
	{ HID_USB_DEVICE(USB_VENDOR_ID_CMEDIA, USB_DEVICE_ID_CM6533) },
	{ }
};
MODULE_DEVICE_TABLE(hid, cmhid_devices);

static struct hid_driver cmhid_driver = {
	.name = "cm6533_jd",
	.id_table = cmhid_devices,
	.raw_event = cmhid_raw_event,
	.input_configured = cmhid_input_configured,
	.probe = cmhid_probe,
	.remove = cmhid_remove,
	.input_mapping = cmhid_input_mapping,
};
module_hid_driver(cmhid_driver);
Commit	Line	Data
9c92ab61	1	// SPDX-License-Identifier: GPL-2.0-only
ad8ddc57 BC	2	/*
	3	* HID driver for CMedia CM6533 audio jack controls
	4	*
	5	* Copyright (C) 2015 Ben Chen <ben_chen@bizlinktech.com>
ad8ddc57 BC	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
	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
	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
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
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
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
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