HID: Add new force feedback driver for Mayflash game controller adapters (f8690450) · Commits · 戴 / test

drivers/hid/Kconfig

+8 −0

Original line number	Diff line number	Diff line
		@@ -512,6 +512,14 @@ config HID_MAGICMOUSE
		Say Y here if you want support for the multi-touch features of the
		Apple Wireless "Magic" Mouse and the Apple Wireless "Magic" Trackpad.

		config HID_MAYFLASH
		tristate "Mayflash game controller adapter force feedback"
		depends on HID
		select INPUT_FF_MEMLESS
		---help---
		Say Y here if you have HJZ Mayflash PS3 game controller adapters
		and want to enable force feedback support.

		config HID_MICROSOFT
		tristate "Microsoft non-fully HID-compliant devices"
		depends on HID

drivers/hid/Makefile

+1 −0

Original line number	Diff line number	Diff line
		@@ -58,6 +58,7 @@ obj-$(CONFIG_HID_LOGITECH) += hid-logitech.o
		obj-$(CONFIG_HID_LOGITECH_DJ) += hid-logitech-dj.o
		obj-$(CONFIG_HID_LOGITECH_HIDPP) += hid-logitech-hidpp.o
		obj-$(CONFIG_HID_MAGICMOUSE) += hid-magicmouse.o
		obj-$(CONFIG_HID_MAYFLASH) += hid-mf.o
		obj-$(CONFIG_HID_MICROSOFT) += hid-microsoft.o
		obj-$(CONFIG_HID_MONTEREY) += hid-monterey.o
		obj-$(CONFIG_HID_MULTITOUCH) += hid-multitouch.o

drivers/hid/hid-core.c

+3 −0

Original line number	Diff line number	Diff line
		@@ -1883,6 +1883,9 @@ static const struct hid_device_id hid_have_special_driver[] = {
		{ HID_USB_DEVICE(USB_VENDOR_ID_DELCOM, USB_DEVICE_ID_DELCOM_VISUAL_IND) },
		{ HID_USB_DEVICE(USB_VENDOR_ID_DRAGONRISE, 0x0006) },
		{ HID_USB_DEVICE(USB_VENDOR_ID_DRAGONRISE, 0x0011) },
		#if IS_ENABLED(CONFIG_HID_MAYFLASH)
		{ HID_USB_DEVICE(USB_VENDOR_ID_DRAGONRISE, USB_DEVICE_ID_DRAGONRISE_PS3) },
		#endif
		{ HID_USB_DEVICE(USB_VENDOR_ID_DREAM_CHEEKY, USB_DEVICE_ID_DREAM_CHEEKY_WN) },
		{ HID_USB_DEVICE(USB_VENDOR_ID_DREAM_CHEEKY, USB_DEVICE_ID_DREAM_CHEEKY_FA) },
		{ HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_ELECOM, USB_DEVICE_ID_ELECOM_BM084) },

drivers/hid/hid-mf.c

0 → 100644

+166 −0

Original line number	Diff line number	Diff line
		/*
		* Force feedback support for Mayflash game controller adapters.
		*
		* These devices are manufactured by Mayflash but identify themselves
		* using the vendor ID of DragonRise Inc.
		*
		* Tested with:
		* 0079:1801 "DragonRise Inc. Mayflash PS3 Game Controller Adapter"
		*
		* The following adapters probably work too, but need to be tested:
		* 0079:1800 "DragonRise Inc. Mayflash WIIU Game Controller Adapter"
		* 0079:1843 "DragonRise Inc. Mayflash GameCube Game Controller Adapter"
		*
		* Copyright (c) 2016 Marcel Hasler <mahasler@gmail.com>
		*/

		/*
		* This program is free software; you can redistribute it and/or modify
		* it under the terms of the GNU General Public License as published by
		* the Free Software Foundation; either version 2 of the License, or
		* (at your option) any later version.
		*
		* This program is distributed in the hope that it will be useful,
		* but WITHOUT ANY WARRANTY; without even the implied warranty of
		* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		* GNU General Public License for more details.
		*/

		#include <linux/input.h>
		#include <linux/slab.h>
		#include <linux/hid.h>
		#include <linux/module.h>

		#include "hid-ids.h"

		struct mf_device {
		struct hid_report *report;
		};

		static int mf_play(struct input_dev dev, void data, struct ff_effect *effect)
		{
		struct hid_device *hid = input_get_drvdata(dev);
		struct mf_device *mf = data;
		int strong, weak;

		strong = effect->u.rumble.strong_magnitude;
		weak = effect->u.rumble.weak_magnitude;

		dbg_hid("Called with 0x%04x 0x%04x.\n", strong, weak);

		strong = strong * 0xff / 0xffff;
		weak = weak * 0xff / 0xffff;

		dbg_hid("Running with 0x%02x 0x%02x.\n", strong, weak);

		mf->report->field[0]->value[0] = weak;
		mf->report->field[0]->value[1] = strong;
		hid_hw_request(hid, mf->report, HID_REQ_SET_REPORT);

		return 0;
		}

		static int mf_init(struct hid_device *hid)
		{
		struct mf_device *mf;

		struct list_head *report_list =
		&hid->report_enum[HID_OUTPUT_REPORT].report_list;

		struct list_head *report_ptr;
		struct hid_report *report;

		struct list_head *input_ptr = &hid->inputs;
		struct hid_input *input;

		struct input_dev *dev;

		int error;

		/* Setup each of the four inputs */
		list_for_each(report_ptr, report_list) {
		report = list_entry(report_ptr, struct hid_report, list);

		if (report->maxfield < 1 \|\| report->field[0]->report_count < 2) {
		hid_err(hid, "Invalid report, this should never happen!\n");
		return -ENODEV;
		}

		if (list_is_last(input_ptr, &hid->inputs)) {
		hid_err(hid, "Missing input, this should never happen!\n");
		return -ENODEV;
		}

		input_ptr = input_ptr->next;
		input = list_entry(input_ptr, struct hid_input, list);

		mf = kzalloc(sizeof(struct mf_device), GFP_KERNEL);
		if (!mf)
		return -ENOMEM;

		dev = input->input;
		set_bit(FF_RUMBLE, dev->ffbit);

		error = input_ff_create_memless(dev, mf, mf_play);
		if (error) {
		kfree(mf);
		return error;
		}

		mf->report = report;
		mf->report->field[0]->value[0] = 0x00;
		mf->report->field[0]->value[1] = 0x00;
		hid_hw_request(hid, mf->report, HID_REQ_SET_REPORT);
		}

		hid_info(hid, "Force feedback for HJZ Mayflash game controller "
		"adapters by Marcel Hasler <mahasler@gmail.com>\n");

		return 0;
		}

		static int mf_probe(struct hid_device hid, const struct hid_device_id id)
		{
		int error;

		dev_dbg(&hid->dev, "Mayflash HID hardware probe...\n");

		/* Split device into four inputs */
		hid->quirks \|= HID_QUIRK_MULTI_INPUT;

		error = hid_parse(hid);
		if (error) {
		hid_err(hid, "HID parse failed.\n");
		return error;
		}

		error = hid_hw_start(hid, HID_CONNECT_DEFAULT & ~HID_CONNECT_FF);
		if (error) {
		hid_err(hid, "HID hw start failed\n");
		return error;
		}

		error = mf_init(hid);
		if (error) {
		hid_err(hid, "Force feedback init failed.\n");
		hid_hw_stop(hid);
		return error;
		}

		return 0;
		}

		static const struct hid_device_id mf_devices[] = {
		{ HID_USB_DEVICE(USB_VENDOR_ID_DRAGONRISE, USB_DEVICE_ID_DRAGONRISE_PS3), },
		{ }
		};
		MODULE_DEVICE_TABLE(hid, mf_devices);

		static struct hid_driver mf_driver = {
		.name = "hid_mf",
		.id_table = mf_devices,
		.probe = mf_probe,
		};
		module_hid_driver(mf_driver);

		MODULE_LICENSE("GPL");

Admin message