11a59d1b8SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
204561c5aSIgnaz Forster /*
304561c5aSIgnaz Forster * Force feedback support for EMS Trio Linker Plus II
404561c5aSIgnaz Forster *
504561c5aSIgnaz Forster * Copyright (c) 2010 Ignaz Forster <ignaz.forster@gmx.de>
604561c5aSIgnaz Forster */
704561c5aSIgnaz Forster
804561c5aSIgnaz Forster /*
904561c5aSIgnaz Forster */
1004561c5aSIgnaz Forster
1104561c5aSIgnaz Forster
1204561c5aSIgnaz Forster #include <linux/hid.h>
1304561c5aSIgnaz Forster #include <linux/input.h>
148f86a2c3SPaul Gortmaker #include <linux/module.h>
1504561c5aSIgnaz Forster
1604561c5aSIgnaz Forster #include "hid-ids.h"
1704561c5aSIgnaz Forster
1804561c5aSIgnaz Forster struct emsff_device {
1904561c5aSIgnaz Forster struct hid_report *report;
2004561c5aSIgnaz Forster };
2104561c5aSIgnaz Forster
emsff_play(struct input_dev * dev,void * data,struct ff_effect * effect)2204561c5aSIgnaz Forster static int emsff_play(struct input_dev *dev, void *data,
2304561c5aSIgnaz Forster struct ff_effect *effect)
2404561c5aSIgnaz Forster {
2504561c5aSIgnaz Forster struct hid_device *hid = input_get_drvdata(dev);
2604561c5aSIgnaz Forster struct emsff_device *emsff = data;
2704561c5aSIgnaz Forster int weak, strong;
2804561c5aSIgnaz Forster
2904561c5aSIgnaz Forster weak = effect->u.rumble.weak_magnitude;
3004561c5aSIgnaz Forster strong = effect->u.rumble.strong_magnitude;
3104561c5aSIgnaz Forster
3204561c5aSIgnaz Forster dbg_hid("called with 0x%04x 0x%04x\n", strong, weak);
3304561c5aSIgnaz Forster
3404561c5aSIgnaz Forster weak = weak * 0xff / 0xffff;
3504561c5aSIgnaz Forster strong = strong * 0xff / 0xffff;
3604561c5aSIgnaz Forster
3704561c5aSIgnaz Forster emsff->report->field[0]->value[1] = weak;
3804561c5aSIgnaz Forster emsff->report->field[0]->value[2] = strong;
3904561c5aSIgnaz Forster
4004561c5aSIgnaz Forster dbg_hid("running with 0x%02x 0x%02x\n", strong, weak);
41d8814272SBenjamin Tissoires hid_hw_request(hid, emsff->report, HID_REQ_SET_REPORT);
4204561c5aSIgnaz Forster
4304561c5aSIgnaz Forster return 0;
4404561c5aSIgnaz Forster }
4504561c5aSIgnaz Forster
emsff_init(struct hid_device * hid)4604561c5aSIgnaz Forster static int emsff_init(struct hid_device *hid)
4704561c5aSIgnaz Forster {
4804561c5aSIgnaz Forster struct emsff_device *emsff;
4904561c5aSIgnaz Forster struct hid_report *report;
50d9d4b1e4SAlan Stern struct hid_input *hidinput;
5104561c5aSIgnaz Forster struct list_head *report_list =
5204561c5aSIgnaz Forster &hid->report_enum[HID_OUTPUT_REPORT].report_list;
53d9d4b1e4SAlan Stern struct input_dev *dev;
5404561c5aSIgnaz Forster int error;
5504561c5aSIgnaz Forster
56d9d4b1e4SAlan Stern if (list_empty(&hid->inputs)) {
57d9d4b1e4SAlan Stern hid_err(hid, "no inputs found\n");
58d9d4b1e4SAlan Stern return -ENODEV;
59d9d4b1e4SAlan Stern }
60d9d4b1e4SAlan Stern hidinput = list_first_entry(&hid->inputs, struct hid_input, list);
61d9d4b1e4SAlan Stern dev = hidinput->input;
62d9d4b1e4SAlan Stern
6304561c5aSIgnaz Forster if (list_empty(report_list)) {
644291ee30SJoe Perches hid_err(hid, "no output reports found\n");
6504561c5aSIgnaz Forster return -ENODEV;
6604561c5aSIgnaz Forster }
6704561c5aSIgnaz Forster
6804561c5aSIgnaz Forster report = list_first_entry(report_list, struct hid_report, list);
6904561c5aSIgnaz Forster if (report->maxfield < 1) {
704291ee30SJoe Perches hid_err(hid, "no fields in the report\n");
7104561c5aSIgnaz Forster return -ENODEV;
7204561c5aSIgnaz Forster }
7304561c5aSIgnaz Forster
7404561c5aSIgnaz Forster if (report->field[0]->report_count < 7) {
754291ee30SJoe Perches hid_err(hid, "not enough values in the field\n");
7604561c5aSIgnaz Forster return -ENODEV;
7704561c5aSIgnaz Forster }
7804561c5aSIgnaz Forster
7904561c5aSIgnaz Forster emsff = kzalloc(sizeof(struct emsff_device), GFP_KERNEL);
8004561c5aSIgnaz Forster if (!emsff)
8104561c5aSIgnaz Forster return -ENOMEM;
8204561c5aSIgnaz Forster
8304561c5aSIgnaz Forster set_bit(FF_RUMBLE, dev->ffbit);
8404561c5aSIgnaz Forster
8504561c5aSIgnaz Forster error = input_ff_create_memless(dev, emsff, emsff_play);
8604561c5aSIgnaz Forster if (error) {
8704561c5aSIgnaz Forster kfree(emsff);
8804561c5aSIgnaz Forster return error;
8904561c5aSIgnaz Forster }
9004561c5aSIgnaz Forster
9104561c5aSIgnaz Forster emsff->report = report;
9204561c5aSIgnaz Forster emsff->report->field[0]->value[0] = 0x01;
9304561c5aSIgnaz Forster emsff->report->field[0]->value[1] = 0x00;
9404561c5aSIgnaz Forster emsff->report->field[0]->value[2] = 0x00;
9504561c5aSIgnaz Forster emsff->report->field[0]->value[3] = 0x00;
9604561c5aSIgnaz Forster emsff->report->field[0]->value[4] = 0x00;
9704561c5aSIgnaz Forster emsff->report->field[0]->value[5] = 0x00;
9804561c5aSIgnaz Forster emsff->report->field[0]->value[6] = 0x00;
99d8814272SBenjamin Tissoires hid_hw_request(hid, emsff->report, HID_REQ_SET_REPORT);
10004561c5aSIgnaz Forster
1014291ee30SJoe Perches hid_info(hid, "force feedback for EMS based devices by Ignaz Forster <ignaz.forster@gmx.de>\n");
10204561c5aSIgnaz Forster
10304561c5aSIgnaz Forster return 0;
10404561c5aSIgnaz Forster }
10504561c5aSIgnaz Forster
ems_probe(struct hid_device * hdev,const struct hid_device_id * id)10604561c5aSIgnaz Forster static int ems_probe(struct hid_device *hdev, const struct hid_device_id *id)
10704561c5aSIgnaz Forster {
10804561c5aSIgnaz Forster int ret;
10904561c5aSIgnaz Forster
11004561c5aSIgnaz Forster ret = hid_parse(hdev);
11104561c5aSIgnaz Forster if (ret) {
1124291ee30SJoe Perches hid_err(hdev, "parse failed\n");
11304561c5aSIgnaz Forster goto err;
11404561c5aSIgnaz Forster }
11504561c5aSIgnaz Forster
11604561c5aSIgnaz Forster ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT & ~HID_CONNECT_FF);
11704561c5aSIgnaz Forster if (ret) {
1184291ee30SJoe Perches hid_err(hdev, "hw start failed\n");
11904561c5aSIgnaz Forster goto err;
12004561c5aSIgnaz Forster }
12104561c5aSIgnaz Forster
1222dcd9543SAxel Lin ret = emsff_init(hdev);
1232dcd9543SAxel Lin if (ret) {
1242dcd9543SAxel Lin dev_err(&hdev->dev, "force feedback init failed\n");
1252dcd9543SAxel Lin hid_hw_stop(hdev);
1262dcd9543SAxel Lin goto err;
1272dcd9543SAxel Lin }
12804561c5aSIgnaz Forster
12904561c5aSIgnaz Forster return 0;
13004561c5aSIgnaz Forster err:
13104561c5aSIgnaz Forster return ret;
13204561c5aSIgnaz Forster }
13304561c5aSIgnaz Forster
13404561c5aSIgnaz Forster static const struct hid_device_id ems_devices[] = {
13505ee2838SJiri Kosina { HID_USB_DEVICE(USB_VENDOR_ID_EMS, USB_DEVICE_ID_EMS_TRIO_LINKER_PLUS_II) },
13604561c5aSIgnaz Forster { }
13704561c5aSIgnaz Forster };
13804561c5aSIgnaz Forster MODULE_DEVICE_TABLE(hid, ems_devices);
13904561c5aSIgnaz Forster
14004561c5aSIgnaz Forster static struct hid_driver ems_driver = {
14104561c5aSIgnaz Forster .name = "hkems",
14204561c5aSIgnaz Forster .id_table = ems_devices,
14304561c5aSIgnaz Forster .probe = ems_probe,
14404561c5aSIgnaz Forster };
145f425458eSH Hartley Sweeten module_hid_driver(ems_driver);
14604561c5aSIgnaz Forster
14704561c5aSIgnaz Forster MODULE_LICENSE("GPL");
14804561c5aSIgnaz Forster
149