Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

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