xref: /openbmc/linux/drivers/hid/hid-pxrc.c (revision acc3e346)
1*acc3e346SMarcus Folkesson // SPDX-License-Identifier: GPL-2.0-or-later
2*acc3e346SMarcus Folkesson /*
3*acc3e346SMarcus Folkesson  * HID driver for PhoenixRC 8-axis flight controller
4*acc3e346SMarcus Folkesson  *
5*acc3e346SMarcus Folkesson  * Copyright (C) 2022 Marcus Folkesson <marcus.folkesson@gmail.com>
6*acc3e346SMarcus Folkesson  */
7*acc3e346SMarcus Folkesson 
8*acc3e346SMarcus Folkesson #include <linux/device.h>
9*acc3e346SMarcus Folkesson #include <linux/hid.h>
10*acc3e346SMarcus Folkesson #include <linux/module.h>
11*acc3e346SMarcus Folkesson 
12*acc3e346SMarcus Folkesson #include "hid-ids.h"
13*acc3e346SMarcus Folkesson 
14*acc3e346SMarcus Folkesson struct pxrc_priv {
15*acc3e346SMarcus Folkesson 	u8 slider;
16*acc3e346SMarcus Folkesson 	u8 dial;
17*acc3e346SMarcus Folkesson 	bool alternate;
18*acc3e346SMarcus Folkesson };
19*acc3e346SMarcus Folkesson 
20*acc3e346SMarcus Folkesson static __u8 pxrc_rdesc_fixed[] = {
21*acc3e346SMarcus Folkesson 	0x05, 0x01,        // Usage Page (Generic Desktop Ctrls)
22*acc3e346SMarcus Folkesson 	0x09, 0x04,        // Usage (Joystick)
23*acc3e346SMarcus Folkesson 	0xA1, 0x01,        // Collection (Application)
24*acc3e346SMarcus Folkesson 	0x09, 0x01,        //   Usage (Pointer)
25*acc3e346SMarcus Folkesson 	0xA1, 0x00,        //   Collection (Physical)
26*acc3e346SMarcus Folkesson 	0x09, 0x30,        //     Usage (X)
27*acc3e346SMarcus Folkesson 	0x09, 0x36,        //     Usage (Slider)
28*acc3e346SMarcus Folkesson 	0x09, 0x31,        //     Usage (Y)
29*acc3e346SMarcus Folkesson 	0x09, 0x32,        //     Usage (Z)
30*acc3e346SMarcus Folkesson 	0x09, 0x33,        //     Usage (Rx)
31*acc3e346SMarcus Folkesson 	0x09, 0x34,        //     Usage (Ry)
32*acc3e346SMarcus Folkesson 	0x09, 0x35,        //     Usage (Rz)
33*acc3e346SMarcus Folkesson 	0x09, 0x37,        //     Usage (Dial)
34*acc3e346SMarcus Folkesson 	0x15, 0x00,        //     Logical Minimum (0)
35*acc3e346SMarcus Folkesson 	0x26, 0xFF, 0x00,  //     Logical Maximum (255)
36*acc3e346SMarcus Folkesson 	0x35, 0x00,        //     Physical Minimum (0)
37*acc3e346SMarcus Folkesson 	0x46, 0xFF, 0x00,  //     Physical Maximum (255)
38*acc3e346SMarcus Folkesson 	0x75, 0x08,        //     Report Size (8)
39*acc3e346SMarcus Folkesson 	0x95, 0x08,        //     Report Count (8)
40*acc3e346SMarcus Folkesson 	0x81, 0x02,        //     Input (Data,Var,Abs,No Wrap,Linear,Preferred State,No Null Position)
41*acc3e346SMarcus Folkesson 	0xC0,              //   End Collection
42*acc3e346SMarcus Folkesson 	0xC0,              // End Collection
43*acc3e346SMarcus Folkesson };
44*acc3e346SMarcus Folkesson 
pxrc_report_fixup(struct hid_device * hdev,__u8 * rdesc,unsigned int * rsize)45*acc3e346SMarcus Folkesson static __u8 *pxrc_report_fixup(struct hid_device *hdev, __u8 *rdesc,
46*acc3e346SMarcus Folkesson 				unsigned int *rsize)
47*acc3e346SMarcus Folkesson {
48*acc3e346SMarcus Folkesson 	hid_info(hdev, "fixing up PXRC report descriptor\n");
49*acc3e346SMarcus Folkesson 	*rsize = sizeof(pxrc_rdesc_fixed);
50*acc3e346SMarcus Folkesson 	return pxrc_rdesc_fixed;
51*acc3e346SMarcus Folkesson }
52*acc3e346SMarcus Folkesson 
pxrc_raw_event(struct hid_device * hdev,struct hid_report * report,u8 * data,int size)53*acc3e346SMarcus Folkesson static int pxrc_raw_event(struct hid_device *hdev, struct hid_report *report,
54*acc3e346SMarcus Folkesson 	 u8 *data, int size)
55*acc3e346SMarcus Folkesson {
56*acc3e346SMarcus Folkesson 	struct pxrc_priv *priv = hid_get_drvdata(hdev);
57*acc3e346SMarcus Folkesson 
58*acc3e346SMarcus Folkesson 	if (priv->alternate)
59*acc3e346SMarcus Folkesson 		priv->slider = data[7];
60*acc3e346SMarcus Folkesson 	else
61*acc3e346SMarcus Folkesson 		priv->dial = data[7];
62*acc3e346SMarcus Folkesson 
63*acc3e346SMarcus Folkesson 	data[1] = priv->slider;
64*acc3e346SMarcus Folkesson 	data[7] = priv->dial;
65*acc3e346SMarcus Folkesson 
66*acc3e346SMarcus Folkesson 	priv->alternate = !priv->alternate;
67*acc3e346SMarcus Folkesson 	return 0;
68*acc3e346SMarcus Folkesson }
69*acc3e346SMarcus Folkesson 
pxrc_probe(struct hid_device * hdev,const struct hid_device_id * id)70*acc3e346SMarcus Folkesson static int pxrc_probe(struct hid_device *hdev, const struct hid_device_id *id)
71*acc3e346SMarcus Folkesson {
72*acc3e346SMarcus Folkesson 	int ret;
73*acc3e346SMarcus Folkesson 	struct pxrc_priv *priv;
74*acc3e346SMarcus Folkesson 
75*acc3e346SMarcus Folkesson 	priv = devm_kzalloc(&hdev->dev, sizeof(*priv), GFP_KERNEL);
76*acc3e346SMarcus Folkesson 	if (!priv)
77*acc3e346SMarcus Folkesson 		return -ENOMEM;
78*acc3e346SMarcus Folkesson 	hid_set_drvdata(hdev, priv);
79*acc3e346SMarcus Folkesson 
80*acc3e346SMarcus Folkesson 	ret = hid_parse(hdev);
81*acc3e346SMarcus Folkesson 	if (ret) {
82*acc3e346SMarcus Folkesson 		hid_err(hdev, "parse failed\n");
83*acc3e346SMarcus Folkesson 		return ret;
84*acc3e346SMarcus Folkesson 	}
85*acc3e346SMarcus Folkesson 
86*acc3e346SMarcus Folkesson 	ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT);
87*acc3e346SMarcus Folkesson 	if (ret) {
88*acc3e346SMarcus Folkesson 		hid_err(hdev, "hw start failed\n");
89*acc3e346SMarcus Folkesson 		return ret;
90*acc3e346SMarcus Folkesson 	}
91*acc3e346SMarcus Folkesson 
92*acc3e346SMarcus Folkesson 	return 0;
93*acc3e346SMarcus Folkesson }
94*acc3e346SMarcus Folkesson 
95*acc3e346SMarcus Folkesson static const struct hid_device_id pxrc_devices[] = {
96*acc3e346SMarcus Folkesson 	{ HID_USB_DEVICE(USB_VENDOR_ID_MULTIPLE_1781, USB_DEVICE_ID_PHOENIXRC) },
97*acc3e346SMarcus Folkesson 	{ /* sentinel */ }
98*acc3e346SMarcus Folkesson };
99*acc3e346SMarcus Folkesson MODULE_DEVICE_TABLE(hid, pxrc_devices);
100*acc3e346SMarcus Folkesson 
101*acc3e346SMarcus Folkesson static struct hid_driver pxrc_driver = {
102*acc3e346SMarcus Folkesson 	.name = "hid-pxrc",
103*acc3e346SMarcus Folkesson 	.id_table = pxrc_devices,
104*acc3e346SMarcus Folkesson 	.report_fixup = pxrc_report_fixup,
105*acc3e346SMarcus Folkesson 	.probe = pxrc_probe,
106*acc3e346SMarcus Folkesson 	.raw_event = pxrc_raw_event,
107*acc3e346SMarcus Folkesson };
108*acc3e346SMarcus Folkesson module_hid_driver(pxrc_driver);
109*acc3e346SMarcus Folkesson 
110*acc3e346SMarcus Folkesson MODULE_AUTHOR("Marcus Folkesson <marcus.folkesson@gmail.com>");
111*acc3e346SMarcus Folkesson MODULE_DESCRIPTION("HID driver for PXRC 8-axis flight controller");
112*acc3e346SMarcus Folkesson MODULE_LICENSE("GPL");
113