ark1668ed-bsp/linux/drivers/hid/hid-plantronics.c

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 *  Plantronics USB HID Driver
 *
 *  Copyright (c) 2014 JD Cole <jd.cole@plantronics.com>
 *  Copyright (c) 2015-2018 Terry Junge <terry.junge@plantronics.com>
 */

#include "hid-ids.h"

#include <linux/hid.h>
#include <linux/module.h>
#include <linux/jiffies.h>

#define PLT_HID_1_0_PAGE	0xffa00000
#define PLT_HID_2_0_PAGE	0xffa20000

#define PLT_BASIC_TELEPHONY	0x0003
#define PLT_BASIC_EXCEPTION	0x0005

#define PLT_VOL_UP		0x00b1
#define PLT_VOL_DOWN		0x00b2
#define PLT_MIC_MUTE		0x00b5

#define PLT1_VOL_UP		(PLT_HID_1_0_PAGE | PLT_VOL_UP)
#define PLT1_VOL_DOWN		(PLT_HID_1_0_PAGE | PLT_VOL_DOWN)
#define PLT1_MIC_MUTE		(PLT_HID_1_0_PAGE | PLT_MIC_MUTE)
#define PLT2_VOL_UP		(PLT_HID_2_0_PAGE | PLT_VOL_UP)
#define PLT2_VOL_DOWN		(PLT_HID_2_0_PAGE | PLT_VOL_DOWN)
#define PLT2_MIC_MUTE		(PLT_HID_2_0_PAGE | PLT_MIC_MUTE)
#define HID_TELEPHONY_MUTE	(HID_UP_TELEPHONY | 0x2f)
#define HID_CONSUMER_MUTE	(HID_UP_CONSUMER | 0xe2)

#define PLT_DA60		0xda60
#define PLT_BT300_MIN		0x0413
#define PLT_BT300_MAX		0x0418

#define PLT_DOUBLE_KEY_TIMEOUT 5 /* ms */

struct plt_drv_data {
	unsigned long device_type;
	unsigned long last_key_ts;
	unsigned long double_key_to;
	__u16 last_key;
};

static int plantronics_input_mapping(struct hid_device *hdev,
				     struct hid_input *hi,
				     struct hid_field *field,
				     struct hid_usage *usage,
				     unsigned long **bit, int *max)
{
	unsigned short mapped_key;
	struct plt_drv_data *drv_data = hid_get_drvdata(hdev);
	unsigned long plt_type = drv_data->device_type;
	int allow_mute = usage->hid == HID_TELEPHONY_MUTE;
	int allow_consumer = field->application == HID_CP_CONSUMERCONTROL &&
			(usage->hid & HID_USAGE_PAGE) == HID_UP_CONSUMER &&
			usage->hid != HID_CONSUMER_MUTE;

	/* special case for PTT products */
	if (field->application == HID_GD_JOYSTICK)
		goto defaulted;

	/* non-standard types or multi-HID interfaces - plt_type is PID */
	if (!(plt_type & HID_USAGE_PAGE)) {
		switch (plt_type) {
		case PLT_DA60:
			if (allow_consumer)
				goto defaulted;
			if (usage->hid == HID_CONSUMER_MUTE) {
				mapped_key = KEY_MICMUTE;
				goto mapped;
			}
			break;
		default:
			if (allow_consumer || allow_mute)
				goto defaulted;
		}
		goto ignored;
	}

	/* handle standard consumer control mapping */
	/* and standard telephony mic mute mapping */
	if (allow_consumer || allow_mute)
		goto defaulted;

	/* handle vendor unique types - plt_type is 0xffa0uuuu or 0xffa2uuuu */
	/* if not 'basic telephony compliant' - map vendor unique controls */
	if (!((plt_type & HID_USAGE) >= PLT_BASIC_TELEPHONY &&
	      (plt_type & HID_USAGE) != PLT_BASIC_EXCEPTION) &&
	      !((field->application ^ plt_type) & HID_USAGE_PAGE))
		switch (usage->hid) {
		case PLT1_VOL_UP:
		case PLT2_VOL_UP:
			mapped_key = KEY_VOLUMEUP;
			goto mapped;
		case PLT1_VOL_DOWN:
		case PLT2_VOL_DOWN:
			mapped_key = KEY_VOLUMEDOWN;
			goto mapped;
		case PLT1_MIC_MUTE:
		case PLT2_MIC_MUTE:
			mapped_key = KEY_MICMUTE;
			goto mapped;
		}

/*
 * Future mapping of call control or other usages,
 * if and when keys are defined would go here
 * otherwise, ignore everything else that was not mapped
 */

ignored:
	hid_dbg(hdev, "usage: %08x (appl: %08x) - ignored\n",
		usage->hid, field->application);
	return -1;

defaulted:
	hid_dbg(hdev, "usage: %08x (appl: %08x) - defaulted\n",
		usage->hid, field->application);
	return 0;

mapped:
	hid_map_usage_clear(hi, usage, bit, max, EV_KEY, mapped_key);
	hid_dbg(hdev, "usage: %08x (appl: %08x) - mapped to key %d\n",
		usage->hid, field->application, mapped_key);
	return 1;
}

static int plantronics_event(struct hid_device *hdev, struct hid_field *field,
			     struct hid_usage *usage, __s32 value)
{
	struct plt_drv_data *drv_data = hid_get_drvdata(hdev);
	unsigned long prev_tsto, cur_ts;
	__u16 prev_key, cur_key;

	/* Usages are filtered in plantronics_usages. */

	/* HZ too low for ms resolution - double key detection disabled */
	/* or it is a key release - handle key presses only. */
	if (!drv_data->double_key_to || !value)
		return 0;

	prev_tsto = drv_data->last_key_ts + drv_data->double_key_to;
	cur_ts = drv_data->last_key_ts = jiffies;
	prev_key = drv_data->last_key;
	cur_key = drv_data->last_key = usage->code;

	/* If the same key occurs in <= double_key_to -- ignore it */
	if (prev_key == cur_key && time_before_eq(cur_ts, prev_tsto)) {
		hid_dbg(hdev, "double key %d ignored\n", cur_key);
		return 1; /* Ignore the repeated key. */
	}
	return 0;
}

static unsigned long plantronics_device_type(struct hid_device *hdev)
{
	unsigned i, col_page;
	unsigned long plt_type = hdev->product;

	/* multi-HID interfaces? - plt_type is PID */
	if (plt_type >= PLT_BT300_MIN && plt_type <= PLT_BT300_MAX)
		goto exit;

	/* determine primary vendor page */
	for (i = 0; i < hdev->maxcollection; i++) {
		col_page = hdev->collection[i].usage & HID_USAGE_PAGE;
		if (col_page == PLT_HID_2_0_PAGE) {
			plt_type = hdev->collection[i].usage;
			break;
		}
		if (col_page == PLT_HID_1_0_PAGE)
			plt_type = hdev->collection[i].usage;
	}

exit:
	hid_dbg(hdev, "plt_type decoded as: %08lx\n", plt_type);
	return plt_type;
}

static int plantronics_probe(struct hid_device *hdev,
			     const struct hid_device_id *id)
{
	struct plt_drv_data *drv_data;
	int ret;

	drv_data = devm_kzalloc(&hdev->dev, sizeof(*drv_data), GFP_KERNEL);
	if (!drv_data)
		return -ENOMEM;

	ret = hid_parse(hdev);
	if (ret) {
		hid_err(hdev, "parse failed\n");
		return ret;
	}

	drv_data->device_type = plantronics_device_type(hdev);
	drv_data->double_key_to = msecs_to_jiffies(PLT_DOUBLE_KEY_TIMEOUT);
	drv_data->last_key_ts = jiffies - drv_data->double_key_to;

	/* if HZ does not allow ms resolution - disable double key detection */
	if (drv_data->double_key_to < PLT_DOUBLE_KEY_TIMEOUT)
		drv_data->double_key_to = 0;

	hid_set_drvdata(hdev, drv_data);

	ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT |
		HID_CONNECT_HIDINPUT_FORCE | HID_CONNECT_HIDDEV_FORCE);
	if (ret)
		hid_err(hdev, "hw start failed\n");

	return ret;
}

static const struct hid_device_id plantronics_devices[] = {
	{ HID_USB_DEVICE(USB_VENDOR_ID_PLANTRONICS, HID_ANY_ID) },
	{ }
};
MODULE_DEVICE_TABLE(hid, plantronics_devices);

static const struct hid_usage_id plantronics_usages[] = {
	{ HID_CP_VOLUMEUP, EV_KEY, HID_ANY_ID },
	{ HID_CP_VOLUMEDOWN, EV_KEY, HID_ANY_ID },
	{ HID_TELEPHONY_MUTE, EV_KEY, HID_ANY_ID },
	{ HID_CONSUMER_MUTE, EV_KEY, HID_ANY_ID },
	{ PLT2_VOL_UP, EV_KEY, HID_ANY_ID },
	{ PLT2_VOL_DOWN, EV_KEY, HID_ANY_ID },
	{ PLT2_MIC_MUTE, EV_KEY, HID_ANY_ID },
	{ PLT1_VOL_UP, EV_KEY, HID_ANY_ID },
	{ PLT1_VOL_DOWN, EV_KEY, HID_ANY_ID },
	{ PLT1_MIC_MUTE, EV_KEY, HID_ANY_ID },
	{ HID_TERMINATOR, HID_TERMINATOR, HID_TERMINATOR }
};

static struct hid_driver plantronics_driver = {
	.name = "plantronics",
	.id_table = plantronics_devices,
	.usage_table = plantronics_usages,
	.input_mapping = plantronics_input_mapping,
	.event = plantronics_event,
	.probe = plantronics_probe,
};
module_hid_driver(plantronics_driver);

MODULE_AUTHOR("JD Cole <jd.cole@plantronics.com>");
MODULE_AUTHOR("Terry Junge <terry.junge@plantronics.com>");
MODULE_DESCRIPTION("Plantronics USB HID Driver");
MODULE_LICENSE("GPL");