brintos

brintos / linux-shallow public Read only

0
0
Text · 4.2 KiB · fbe4e16 Raw
194 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Force feedback support for ACRUX game controllers4 *5 * From what I have gathered, these devices are mass produced in China6 * by several vendors. They often share the same design as the original7 * Xbox 360 controller.8 *9 * 1a34:0802 "ACRUX USB GAMEPAD 8116"10 *  - tested with an EXEQ EQ-PCU-02090 game controller.11 *12 * Copyright (c) 2010 Sergei Kolzun <x0r@dv-life.ru>13 */14 15/*16 */17 18#include <linux/input.h>19#include <linux/slab.h>20#include <linux/hid.h>21#include <linux/module.h>22 23#include "hid-ids.h"24 25#ifdef CONFIG_HID_ACRUX_FF26 27struct axff_device {28	struct hid_report *report;29};30 31static int axff_play(struct input_dev *dev, void *data, struct ff_effect *effect)32{33	struct hid_device *hid = input_get_drvdata(dev);34	struct axff_device *axff = data;35	struct hid_report *report = axff->report;36	int field_count = 0;37	int left, right;38	int i, j;39 40	left = effect->u.rumble.strong_magnitude;41	right = effect->u.rumble.weak_magnitude;42 43	dbg_hid("called with 0x%04x 0x%04x", left, right);44 45	left = left * 0xff / 0xffff;46	right = right * 0xff / 0xffff;47 48	for (i = 0; i < report->maxfield; i++) {49		for (j = 0; j < report->field[i]->report_count; j++) {50			report->field[i]->value[j] =51				field_count % 2 ? right : left;52			field_count++;53		}54	}55 56	dbg_hid("running with 0x%02x 0x%02x", left, right);57	hid_hw_request(hid, axff->report, HID_REQ_SET_REPORT);58 59	return 0;60}61 62static int axff_init(struct hid_device *hid)63{64	struct axff_device *axff;65	struct hid_report *report;66	struct hid_input *hidinput;67	struct list_head *report_list =&hid->report_enum[HID_OUTPUT_REPORT].report_list;68	struct input_dev *dev;69	int field_count = 0;70	int i, j;71	int error;72 73	if (list_empty(&hid->inputs)) {74		hid_err(hid, "no inputs found\n");75		return -ENODEV;76	}77	hidinput = list_first_entry(&hid->inputs, struct hid_input, list);78	dev = hidinput->input;79 80	if (list_empty(report_list)) {81		hid_err(hid, "no output reports found\n");82		return -ENODEV;83	}84 85	report = list_first_entry(report_list, struct hid_report, list);86	for (i = 0; i < report->maxfield; i++) {87		for (j = 0; j < report->field[i]->report_count; j++) {88			report->field[i]->value[j] = 0x00;89			field_count++;90		}91	}92 93	if (field_count < 4 && hid->product != 0xf705) {94		hid_err(hid, "not enough fields in the report: %d\n",95			field_count);96		return -ENODEV;97	}98 99	axff = kzalloc(sizeof(struct axff_device), GFP_KERNEL);100	if (!axff)101		return -ENOMEM;102 103	set_bit(FF_RUMBLE, dev->ffbit);104 105	error = input_ff_create_memless(dev, axff, axff_play);106	if (error)107		goto err_free_mem;108 109	axff->report = report;110	hid_hw_request(hid, axff->report, HID_REQ_SET_REPORT);111 112	hid_info(hid, "Force Feedback for ACRUX game controllers by Sergei Kolzun <x0r@dv-life.ru>\n");113 114	return 0;115 116err_free_mem:117	kfree(axff);118	return error;119}120#else121static inline int axff_init(struct hid_device *hid)122{123	return 0;124}125#endif126 127static int ax_probe(struct hid_device *hdev, const struct hid_device_id *id)128{129	int error;130 131	dev_dbg(&hdev->dev, "ACRUX HID hardware probe...\n");132 133	error = hid_parse(hdev);134	if (error) {135		hid_err(hdev, "parse failed\n");136		return error;137	}138 139	error = hid_hw_start(hdev, HID_CONNECT_DEFAULT & ~HID_CONNECT_FF);140	if (error) {141		hid_err(hdev, "hw start failed\n");142		return error;143	}144 145	error = axff_init(hdev);146	if (error) {147		/*148		 * Do not fail device initialization completely as device149		 * may still be partially operable, just warn.150		 */151		hid_warn(hdev,152			 "Failed to enable force feedback support, error: %d\n",153			 error);154	}155 156	/*157	 * We need to start polling device right away, otherwise158	 * it will go into a coma.159	 */160	error = hid_hw_open(hdev);161	if (error) {162		dev_err(&hdev->dev, "hw open failed\n");163		hid_hw_stop(hdev);164		return error;165	}166 167	return 0;168}169 170static void ax_remove(struct hid_device *hdev)171{172	hid_hw_close(hdev);173	hid_hw_stop(hdev);174}175 176static const struct hid_device_id ax_devices[] = {177	{ HID_USB_DEVICE(USB_VENDOR_ID_ACRUX, 0x0802), },178	{ HID_USB_DEVICE(USB_VENDOR_ID_ACRUX, 0xf705), },179	{ }180};181MODULE_DEVICE_TABLE(hid, ax_devices);182 183static struct hid_driver ax_driver = {184	.name		= "acrux",185	.id_table	= ax_devices,186	.probe		= ax_probe,187	.remove		= ax_remove,188};189module_hid_driver(ax_driver);190 191MODULE_AUTHOR("Sergei Kolzun");192MODULE_DESCRIPTION("Force feedback support for ACRUX game controllers");193MODULE_LICENSE("GPL");194