12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
252cd7785SJiri Kosina /*
352cd7785SJiri Kosina * Force feedback support for Betop based devices
452cd7785SJiri Kosina *
552cd7785SJiri Kosina * The devices are distributed under various names and the same USB device ID
652cd7785SJiri Kosina * can be used in both adapters and actual game controllers.
752cd7785SJiri Kosina *
852cd7785SJiri Kosina * 0x11c2:0x2208 "BTP2185 BFM mode Joystick"
952cd7785SJiri Kosina * - tested with BTP2185 BFM Mode.
1052cd7785SJiri Kosina *
1152cd7785SJiri Kosina * 0x11C0:0x5506 "BTP2185 PC mode Joystick"
1252cd7785SJiri Kosina * - tested with BTP2185 PC Mode.
1352cd7785SJiri Kosina *
1452cd7785SJiri Kosina * 0x8380:0x1850 "BTP2185 V2 PC mode USB Gamepad"
1552cd7785SJiri Kosina * - tested with BTP2185 PC Mode with another version.
1652cd7785SJiri Kosina *
1752cd7785SJiri Kosina * 0x20bc:0x5500 "BTP2185 V2 BFM mode Joystick"
1852cd7785SJiri Kosina * - tested with BTP2171s.
1952cd7785SJiri Kosina * Copyright (c) 2014 Huang Bo <huangbobupt@163.com>
2052cd7785SJiri Kosina */
2152cd7785SJiri Kosina
2252cd7785SJiri Kosina /*
2352cd7785SJiri Kosina */
2452cd7785SJiri Kosina
2552cd7785SJiri Kosina
2652cd7785SJiri Kosina #include <linux/input.h>
2752cd7785SJiri Kosina #include <linux/slab.h>
2852cd7785SJiri Kosina #include <linux/module.h>
2952cd7785SJiri Kosina #include <linux/hid.h>
3052cd7785SJiri Kosina
3152cd7785SJiri Kosina #include "hid-ids.h"
3252cd7785SJiri Kosina
3352cd7785SJiri Kosina struct betopff_device {
3452cd7785SJiri Kosina struct hid_report *report;
3552cd7785SJiri Kosina };
3652cd7785SJiri Kosina
hid_betopff_play(struct input_dev * dev,void * data,struct ff_effect * effect)3752cd7785SJiri Kosina static int hid_betopff_play(struct input_dev *dev, void *data,
3852cd7785SJiri Kosina struct ff_effect *effect)
3952cd7785SJiri Kosina {
4052cd7785SJiri Kosina struct hid_device *hid = input_get_drvdata(dev);
4152cd7785SJiri Kosina struct betopff_device *betopff = data;
4252cd7785SJiri Kosina __u16 left, right;
4352cd7785SJiri Kosina
4452cd7785SJiri Kosina left = effect->u.rumble.strong_magnitude;
4552cd7785SJiri Kosina right = effect->u.rumble.weak_magnitude;
4652cd7785SJiri Kosina
4752cd7785SJiri Kosina betopff->report->field[2]->value[0] = left / 256;
4852cd7785SJiri Kosina betopff->report->field[3]->value[0] = right / 256;
4952cd7785SJiri Kosina
5052cd7785SJiri Kosina hid_hw_request(hid, betopff->report, HID_REQ_SET_REPORT);
5152cd7785SJiri Kosina
5252cd7785SJiri Kosina return 0;
5352cd7785SJiri Kosina }
5452cd7785SJiri Kosina
betopff_init(struct hid_device * hid)5552cd7785SJiri Kosina static int betopff_init(struct hid_device *hid)
5652cd7785SJiri Kosina {
5752cd7785SJiri Kosina struct betopff_device *betopff;
5852cd7785SJiri Kosina struct hid_report *report;
591e4ce418SF.A.Sulaiman struct hid_input *hidinput;
6052cd7785SJiri Kosina struct list_head *report_list =
6152cd7785SJiri Kosina &hid->report_enum[HID_OUTPUT_REPORT].report_list;
621e4ce418SF.A.Sulaiman struct input_dev *dev;
6352cd7785SJiri Kosina int error;
6452cd7785SJiri Kosina int i, j;
6552cd7785SJiri Kosina
661e4ce418SF.A.Sulaiman if (list_empty(&hid->inputs)) {
671e4ce418SF.A.Sulaiman hid_err(hid, "no inputs found\n");
681e4ce418SF.A.Sulaiman return -ENODEV;
691e4ce418SF.A.Sulaiman }
701e4ce418SF.A.Sulaiman
711e4ce418SF.A.Sulaiman hidinput = list_first_entry(&hid->inputs, struct hid_input, list);
721e4ce418SF.A.Sulaiman dev = hidinput->input;
731e4ce418SF.A.Sulaiman
7452cd7785SJiri Kosina if (list_empty(report_list)) {
7552cd7785SJiri Kosina hid_err(hid, "no output reports found\n");
7652cd7785SJiri Kosina return -ENODEV;
7752cd7785SJiri Kosina }
7852cd7785SJiri Kosina
7952cd7785SJiri Kosina report = list_first_entry(report_list, struct hid_report, list);
8052cd7785SJiri Kosina /*
8152cd7785SJiri Kosina * Actually there are 4 fields for 4 Bytes as below:
8252cd7785SJiri Kosina * -----------------------------------------
8352cd7785SJiri Kosina * Byte0 Byte1 Byte2 Byte3
8452cd7785SJiri Kosina * 0x00 0x00 left_motor right_motor
8552cd7785SJiri Kosina * -----------------------------------------
8652cd7785SJiri Kosina * Do init them with default value.
8752cd7785SJiri Kosina */
88*3782c0d6SPietro Borrello if (report->maxfield < 4) {
89*3782c0d6SPietro Borrello hid_err(hid, "not enough fields in the report: %d\n",
90*3782c0d6SPietro Borrello report->maxfield);
91*3782c0d6SPietro Borrello return -ENODEV;
92*3782c0d6SPietro Borrello }
9352cd7785SJiri Kosina for (i = 0; i < report->maxfield; i++) {
94*3782c0d6SPietro Borrello if (report->field[i]->report_count < 1) {
95*3782c0d6SPietro Borrello hid_err(hid, "no values in the field\n");
96*3782c0d6SPietro Borrello return -ENODEV;
97*3782c0d6SPietro Borrello }
9852cd7785SJiri Kosina for (j = 0; j < report->field[i]->report_count; j++) {
9952cd7785SJiri Kosina report->field[i]->value[j] = 0x00;
10052cd7785SJiri Kosina }
10152cd7785SJiri Kosina }
10252cd7785SJiri Kosina
10352cd7785SJiri Kosina betopff = kzalloc(sizeof(*betopff), GFP_KERNEL);
10452cd7785SJiri Kosina if (!betopff)
10552cd7785SJiri Kosina return -ENOMEM;
10652cd7785SJiri Kosina
10752cd7785SJiri Kosina set_bit(FF_RUMBLE, dev->ffbit);
10852cd7785SJiri Kosina
10952cd7785SJiri Kosina error = input_ff_create_memless(dev, betopff, hid_betopff_play);
11052cd7785SJiri Kosina if (error) {
11152cd7785SJiri Kosina kfree(betopff);
11252cd7785SJiri Kosina return error;
11352cd7785SJiri Kosina }
11452cd7785SJiri Kosina
11552cd7785SJiri Kosina betopff->report = report;
11652cd7785SJiri Kosina hid_hw_request(hid, betopff->report, HID_REQ_SET_REPORT);
11752cd7785SJiri Kosina
11852cd7785SJiri Kosina hid_info(hid, "Force feedback for betop devices by huangbo <huangbobupt@163.com>\n");
11952cd7785SJiri Kosina
12052cd7785SJiri Kosina return 0;
12152cd7785SJiri Kosina }
12252cd7785SJiri Kosina
betop_probe(struct hid_device * hdev,const struct hid_device_id * id)12352cd7785SJiri Kosina static int betop_probe(struct hid_device *hdev, const struct hid_device_id *id)
12452cd7785SJiri Kosina {
12552cd7785SJiri Kosina int ret;
12652cd7785SJiri Kosina
12752cd7785SJiri Kosina if (id->driver_data)
12852cd7785SJiri Kosina hdev->quirks |= HID_QUIRK_MULTI_INPUT;
12952cd7785SJiri Kosina
13052cd7785SJiri Kosina ret = hid_parse(hdev);
13152cd7785SJiri Kosina if (ret) {
13252cd7785SJiri Kosina hid_err(hdev, "parse failed\n");
13352cd7785SJiri Kosina goto err;
13452cd7785SJiri Kosina }
13552cd7785SJiri Kosina
13652cd7785SJiri Kosina ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT & ~HID_CONNECT_FF);
13752cd7785SJiri Kosina if (ret) {
13852cd7785SJiri Kosina hid_err(hdev, "hw start failed\n");
13952cd7785SJiri Kosina goto err;
14052cd7785SJiri Kosina }
14152cd7785SJiri Kosina
14252cd7785SJiri Kosina betopff_init(hdev);
14352cd7785SJiri Kosina
14452cd7785SJiri Kosina return 0;
14552cd7785SJiri Kosina err:
14652cd7785SJiri Kosina return ret;
14752cd7785SJiri Kosina }
14852cd7785SJiri Kosina
14952cd7785SJiri Kosina static const struct hid_device_id betop_devices[] = {
15052cd7785SJiri Kosina { HID_USB_DEVICE(USB_VENDOR_ID_BETOP_2185BFM, 0x2208) },
15152cd7785SJiri Kosina { HID_USB_DEVICE(USB_VENDOR_ID_BETOP_2185PC, 0x5506) },
15252cd7785SJiri Kosina { HID_USB_DEVICE(USB_VENDOR_ID_BETOP_2185V2PC, 0x1850) },
15352cd7785SJiri Kosina { HID_USB_DEVICE(USB_VENDOR_ID_BETOP_2185V2BFM, 0x5500) },
15452cd7785SJiri Kosina { }
15552cd7785SJiri Kosina };
15652cd7785SJiri Kosina MODULE_DEVICE_TABLE(hid, betop_devices);
15752cd7785SJiri Kosina
15852cd7785SJiri Kosina static struct hid_driver betop_driver = {
15952cd7785SJiri Kosina .name = "betop",
16052cd7785SJiri Kosina .id_table = betop_devices,
16152cd7785SJiri Kosina .probe = betop_probe,
16252cd7785SJiri Kosina };
16352cd7785SJiri Kosina module_hid_driver(betop_driver);
16452cd7785SJiri Kosina
16552cd7785SJiri Kosina MODULE_LICENSE("GPL");
166