Release 4.11 drivers/staging/greybus/hid.c

/*
 * HID class driver for the Greybus.
 *
 * Copyright 2014 Google Inc.
 * Copyright 2014 Linaro Ltd.
 *
 * Released under the GPLv2 only.
 */

#include <linux/bitops.h>
#include <linux/hid.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/slab.h>

#include "greybus.h"

/* Greybus HID device's structure */

struct gb_hid {
	
struct gb_bundle *bundle;
	
struct gb_connection		*connection;

	
struct hid_device		*hid;
	
struct gb_hid_desc_response	hdesc;

	
unsigned long			flags;

#define GB_HID_STARTED			0x01

#define GB_HID_READ_PENDING		0x04

	
unsigned int			bufsize;
	
char				*inbuf;
};

static DEFINE_MUTEX(gb_hid_open_mutex);

/* Routines to get controller's information over greybus */

/* Operations performed on greybus */


static int gb_hid_get_desc(struct gb_hid *ghid)
{
	return gb_operation_sync(ghid->connection, GB_HID_TYPE_GET_DESC, NULL,
				 0, &ghid->hdesc, sizeof(ghid->hdesc));
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
37
100.00%
1
100.00%
Total
37
100.00%
1
100.00%



static int gb_hid_get_report_desc(struct gb_hid *ghid, char *rdesc)
{
	int ret;

	ret = gb_pm_runtime_get_sync(ghid->bundle);
	if (ret)
		return ret;

	ret = gb_operation_sync(ghid->connection, GB_HID_TYPE_GET_REPORT_DESC,
				 NULL, 0, rdesc,
				 le16_to_cpu(ghid->hdesc.wReportDescLength));

	gb_pm_runtime_put_autosuspend(ghid->bundle);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
40
57.14%
1
50.00%
Philip Yang
30
42.86%
1
50.00%
Total
70
100.00%
2
100.00%



static int gb_hid_set_power(struct gb_hid *ghid, int type)
{
	int ret;

	ret = gb_pm_runtime_get_sync(ghid->bundle);
	if (ret)
		return ret;

	ret = gb_operation_sync(ghid->connection, type, NULL, 0, NULL, 0);

	gb_pm_runtime_put_autosuspend(ghid->bundle);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
32
51.61%
1
50.00%
Philip Yang
30
48.39%
1
50.00%
Total
62
100.00%
2
100.00%



static int gb_hid_get_report(struct gb_hid *ghid, u8 report_type, u8 report_id,
			     unsigned char *buf, int len)
{
	struct gb_hid_get_report_request request;
	int ret;

	ret = gb_pm_runtime_get_sync(ghid->bundle);
	if (ret)
		return ret;

	request.report_type = report_type;
	request.report_id = report_id;

	ret = gb_operation_sync(ghid->connection, GB_HID_TYPE_GET_REPORT,
				 &request, sizeof(request), buf, len);

	gb_pm_runtime_put_autosuspend(ghid->bundle);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
62
66.67%
1
50.00%
Philip Yang
31
33.33%
1
50.00%
Total
93
100.00%
2
100.00%



static int gb_hid_set_report(struct gb_hid *ghid, u8 report_type, u8 report_id,
			     unsigned char *buf, int len)
{
	struct gb_hid_set_report_request *request;
	struct gb_operation *operation;
	int ret, size = sizeof(*request) + len - 1;

	ret = gb_pm_runtime_get_sync(ghid->bundle);
	if (ret)
		return ret;

	operation = gb_operation_create(ghid->connection,
					GB_HID_TYPE_SET_REPORT, size, 0,
					GFP_KERNEL);
	if (!operation) {
		gb_pm_runtime_put_autosuspend(ghid->bundle);
		return -ENOMEM;
	}

	request = operation->request->payload;
	request->report_type = report_type;
	request->report_id = report_id;
	memcpy(request->report, buf, len);

	ret = gb_operation_request_send_sync(operation);
	if (ret) {
		dev_err(&operation->connection->bundle->dev,
			"failed to set report: %d\n", ret);
	} else {
		ret = len;
	}

	gb_operation_put(operation);
	gb_pm_runtime_put_autosuspend(ghid->bundle);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
134
73.22%
2
28.57%
Philip Yang
32
17.49%
1
14.29%
Johan Hovold
15
8.20%
3
42.86%
Greg Kroah-Hartman
2
1.09%
1
14.29%
Total
183
100.00%
7
100.00%



static int gb_hid_request_handler(struct gb_operation *op)
{
	struct gb_connection *connection = op->connection;
	struct gb_hid *ghid = gb_connection_get_data(connection);
	struct gb_hid_input_report_request *request = op->request->payload;

	if (op->type != GB_HID_TYPE_IRQ_EVENT) {
		dev_err(&connection->bundle->dev,
			"unsupported unsolicited request\n");
		return -EINVAL;
	}

	if (test_bit(GB_HID_STARTED, &ghid->flags))
		hid_input_report(ghid->hid, HID_INPUT_REPORT,
				 request->report, op->request->payload_size, 1);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
79
76.70%
2
22.22%
Johan Hovold
19
18.45%
5
55.56%
Greg Kroah-Hartman
5
4.85%
2
22.22%
Total
103
100.00%
9
100.00%



static int gb_hid_report_len(struct hid_report *report)
{
	return ((report->size - 1) >> 3) + 1 +
		report->device->report_enum[report->type].numbered;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
39
100.00%
1
100.00%
Total
39
100.00%
1
100.00%



static void gb_hid_find_max_report(struct hid_device *hid, unsigned int type,
				   unsigned int *max)
{
	struct hid_report *report;
	unsigned int size;

	list_for_each_entry(report, &hid->report_enum[type].report_list, list) {
		size = gb_hid_report_len(report);
		if (*max < size)
			*max = size;
	}
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
58
100.00%
1
100.00%
Total
58
100.00%
1
100.00%



static void gb_hid_free_buffers(struct gb_hid *ghid)
{
	kfree(ghid->inbuf);
	ghid->inbuf = NULL;
	ghid->bufsize = 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
30
100.00%
1
100.00%
Total
30
100.00%
1
100.00%



static int gb_hid_alloc_buffers(struct gb_hid *ghid, size_t bufsize)
{
	ghid->inbuf = kzalloc(bufsize, GFP_KERNEL);
	if (!ghid->inbuf)
		return -ENOMEM;

	ghid->bufsize = bufsize;

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
45
100.00%
1
100.00%
Total
45
100.00%
1
100.00%

/* Routines dealing with reports */


static void gb_hid_init_report(struct gb_hid *ghid, struct hid_report *report)
{
	unsigned int size;

	size = gb_hid_report_len(report);
	if (gb_hid_get_report(ghid, report->type, report->id, ghid->inbuf,
			      size))
		return;

	/*
         * hid->driver_lock is held as we are in probe function,
         * we just need to setup the input fields, so using
         * hid_report_raw_event is safe.
         */
	hid_report_raw_event(ghid->hid, report->type, ghid->inbuf, size, 1);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
69
100.00%
1
100.00%
Total
69
100.00%
1
100.00%



static void gb_hid_init_reports(struct gb_hid *ghid)
{
	struct hid_device *hid = ghid->hid;
	struct hid_report *report;

	list_for_each_entry(report,
		&hid->report_enum[HID_INPUT_REPORT].report_list, list)
		gb_hid_init_report(ghid, report);

	list_for_each_entry(report,
		&hid->report_enum[HID_FEATURE_REPORT].report_list, list)
		gb_hid_init_report(ghid, report);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
55
100.00%
1
100.00%
Total
55
100.00%
1
100.00%



static int __gb_hid_get_raw_report(struct hid_device *hid,
		unsigned char report_number, __u8 *buf, size_t count,
		unsigned char report_type)
{
	struct gb_hid *ghid = hid->driver_data;
	int ret;

	if (report_type == HID_OUTPUT_REPORT)
		return -EINVAL;

	ret = gb_hid_get_report(ghid, report_type, report_number, buf, count);
	if (!ret)
		ret = count;

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
75
100.00%
1
100.00%
Total
75
100.00%
1
100.00%



static int __gb_hid_output_raw_report(struct hid_device *hid, __u8 *buf,
				      size_t len, unsigned char report_type)
{
	struct gb_hid *ghid = hid->driver_data;
	int report_id = buf[0];
	int ret;

	if (report_type == HID_INPUT_REPORT)
		return -EINVAL;

	if (report_id) {
		buf++;
		len--;
	}

	ret = gb_hid_set_report(ghid, report_type, report_id, buf, len);
	if (report_id && ret >= 0)
		ret++; /* add report_id to the number of transfered bytes */

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
94
100.00%
1
100.00%
Total
94
100.00%
1
100.00%



static int gb_hid_raw_request(struct hid_device *hid, unsigned char reportnum,
			       __u8 *buf, size_t len, unsigned char rtype,
			       int reqtype)
{
	switch (reqtype) {
	case HID_REQ_GET_REPORT:
		return __gb_hid_get_raw_report(hid, reportnum, buf, len, rtype);
	case HID_REQ_SET_REPORT:
		if (buf[0] != reportnum)
			return -EINVAL;
		return __gb_hid_output_raw_report(hid, buf, len, rtype);
	default:
		return -EIO;
	}
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
85
100.00%
1
100.00%
Total
85
100.00%
1
100.00%

/* HID Callbacks */


static int gb_hid_parse(struct hid_device *hid)
{
	struct gb_hid *ghid = hid->driver_data;
	unsigned int rsize;
	char *rdesc;
	int ret;

	rsize = le16_to_cpu(ghid->hdesc.wReportDescLength);
	if (!rsize || rsize > HID_MAX_DESCRIPTOR_SIZE) {
		dbg_hid("weird size of report descriptor (%u)\n", rsize);
		return -EINVAL;
	}

	rdesc = kzalloc(rsize, GFP_KERNEL);
	if (!rdesc) {
		dbg_hid("couldn't allocate rdesc memory\n");
		return -ENOMEM;
	}

	ret = gb_hid_get_report_desc(ghid, rdesc);
	if (ret) {
		hid_err(hid, "reading report descriptor failed\n");
		goto free_rdesc;
	}

	ret = hid_parse_report(hid, rdesc, rsize);
	if (ret)
		dbg_hid("parsing report descriptor failed\n");

free_rdesc:
	kfree(rdesc);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
144
100.00%
1
100.00%
Total
144
100.00%
1
100.00%



static int gb_hid_start(struct hid_device *hid)
{
	struct gb_hid *ghid = hid->driver_data;
	unsigned int bufsize = HID_MIN_BUFFER_SIZE;
	int ret;

	gb_hid_find_max_report(hid, HID_INPUT_REPORT, &bufsize);
	gb_hid_find_max_report(hid, HID_OUTPUT_REPORT, &bufsize);
	gb_hid_find_max_report(hid, HID_FEATURE_REPORT, &bufsize);

	if (bufsize > HID_MAX_BUFFER_SIZE)
		bufsize = HID_MAX_BUFFER_SIZE;

	ret = gb_hid_alloc_buffers(ghid, bufsize);
	if (ret)
		return ret;

	if (!(hid->quirks & HID_QUIRK_NO_INIT_REPORTS))
		gb_hid_init_reports(ghid);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
104
100.00%
1
100.00%
Total
104
100.00%
1
100.00%



static void gb_hid_stop(struct hid_device *hid)
{
	struct gb_hid *ghid = hid->driver_data;

	gb_hid_free_buffers(ghid);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
25
100.00%
1
100.00%
Total
25
100.00%
1
100.00%



static int gb_hid_open(struct hid_device *hid)
{
	struct gb_hid *ghid = hid->driver_data;
	int ret = 0;

	mutex_lock(&gb_hid_open_mutex);
	if (!hid->open++) {
		ret = gb_hid_set_power(ghid, GB_HID_TYPE_PWR_ON);
		if (ret < 0)
			hid->open--;
		else
			set_bit(GB_HID_STARTED, &ghid->flags);
	}
	mutex_unlock(&gb_hid_open_mutex);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
81
100.00%
1
100.00%
Total
81
100.00%
1
100.00%



static void gb_hid_close(struct hid_device *hid)
{
	struct gb_hid *ghid = hid->driver_data;
	int ret;

	/*
         * Protecting hid->open to make sure we don't restart data acquistion
         * due to a resumption we no longer care about..
         */
	mutex_lock(&gb_hid_open_mutex);
	if (!--hid->open) {
		clear_bit(GB_HID_STARTED, &ghid->flags);

		/* Save some power */
		ret = gb_hid_set_power(ghid, GB_HID_TYPE_PWR_OFF);
		if (ret)
			dev_err(&ghid->connection->bundle->dev,
				"failed to power off (%d)\n", ret);
	}
	mutex_unlock(&gb_hid_open_mutex);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
86
100.00%
2
100.00%
Total
86
100.00%
2
100.00%



static int gb_hid_power(struct hid_device *hid, int lvl)
{
	struct gb_hid *ghid = hid->driver_data;

	switch (lvl) {
	case PM_HINT_FULLON:
		return gb_hid_set_power(ghid, GB_HID_TYPE_PWR_ON);
	case PM_HINT_NORMAL:
		return gb_hid_set_power(ghid, GB_HID_TYPE_PWR_OFF);
	}

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
54
100.00%
1
100.00%
Total
54
100.00%
1
100.00%

/* HID structure to pass callbacks */

static struct hid_ll_driver gb_hid_ll_driver = {
	.parse = gb_hid_parse,
	.start = gb_hid_start,
	.stop = gb_hid_stop,
	.open = gb_hid_open,
	.close = gb_hid_close,
	.power = gb_hid_power,
	.raw_request = gb_hid_raw_request,
};



static int gb_hid_init(struct gb_hid *ghid)
{
	struct hid_device *hid = ghid->hid;
	int ret;

	ret = gb_hid_get_desc(ghid);
	if (ret)
		return ret;

	hid->version = le16_to_cpu(ghid->hdesc.bcdHID);
	hid->vendor = le16_to_cpu(ghid->hdesc.wVendorID);
	hid->product = le16_to_cpu(ghid->hdesc.wProductID);
	hid->country = ghid->hdesc.bCountryCode;

	hid->driver_data = ghid;
	hid->ll_driver = &gb_hid_ll_driver;
	hid->dev.parent = &ghid->connection->bundle->dev;
//      hid->bus = BUS_GREYBUS; /* Need a bustype for GREYBUS in <linux/input.h> */

	/* Set HID device's name */
	snprintf(hid->name, sizeof(hid->name), "%s %04X:%04X",
		 dev_name(&ghid->connection->bundle->dev),
		 hid->vendor, hid->product);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
151
97.42%
2
66.67%
Greg Kroah-Hartman
4
2.58%
1
33.33%
Total
155
100.00%
3
100.00%



static int gb_hid_probe(struct gb_bundle *bundle,
			const struct greybus_bundle_id *id)
{
	struct greybus_descriptor_cport *cport_desc;
	struct gb_connection *connection;
	struct hid_device *hid;
	struct gb_hid *ghid;
	int ret;

	if (bundle->num_cports != 1)
		return -ENODEV;

	cport_desc = &bundle->cport_desc[0];
	if (cport_desc->protocol_id != GREYBUS_PROTOCOL_HID)
		return -ENODEV;

	ghid = kzalloc(sizeof(*ghid), GFP_KERNEL);
	if (!ghid)
		return -ENOMEM;

	connection = gb_connection_create(bundle, le16_to_cpu(cport_desc->id),
						gb_hid_request_handler);
	if (IS_ERR(connection)) {
		ret = PTR_ERR(connection);
		goto err_free_ghid;
	}

	gb_connection_set_data(connection, ghid);
	ghid->connection = connection;

	hid = hid_allocate_device();
	if (IS_ERR(hid)) {
		ret = PTR_ERR(hid);
		goto err_connection_destroy;
	}

	ghid->hid = hid;
	ghid->bundle = bundle;

	greybus_set_drvdata(bundle, ghid);

	ret = gb_connection_enable(connection);
	if (ret)
		goto err_destroy_hid;

	ret = gb_hid_init(ghid);
	if (ret)
		goto err_connection_disable;

	ret = hid_add_device(hid);
	if (ret) {
		hid_err(hid, "can't add hid device: %d\n", ret);
		goto err_connection_disable;
	}

	gb_pm_runtime_put_autosuspend(bundle);

	return 0;

err_connection_disable:
	gb_connection_disable(connection);
err_destroy_hid:
	hid_destroy_device(hid);
err_connection_destroy:
	gb_connection_destroy(connection);
err_free_ghid:
	kfree(ghid);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Johan Hovold
140
50.18%
2
40.00%
Viresh Kumar
124
44.44%
1
20.00%
Philip Yang
11
3.94%
1
20.00%
Greg Kroah-Hartman
4
1.43%
1
20.00%
Total
279
100.00%
5
100.00%



static void gb_hid_disconnect(struct gb_bundle *bundle)
{
	struct gb_hid *ghid = greybus_get_drvdata(bundle);

	if (gb_pm_runtime_get_sync(bundle))
		gb_pm_runtime_get_noresume(bundle);

	hid_destroy_device(ghid->hid);
	gb_connection_disable(ghid->connection);
	gb_connection_destroy(ghid->connection);
	kfree(ghid);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
28
47.46%
2
50.00%
Johan Hovold
19
32.20%
1
25.00%
Philip Yang
12
20.34%
1
25.00%
Total
59
100.00%
4
100.00%


static const struct greybus_bundle_id gb_hid_id_table[] = {
	{ GREYBUS_DEVICE_CLASS(GREYBUS_CLASS_HID) },
	{ }
};
MODULE_DEVICE_TABLE(greybus, gb_hid_id_table);


static struct greybus_driver gb_hid_driver = {
	.name		= "hid",
	.probe		= gb_hid_probe,
	.disconnect	= gb_hid_disconnect,
	.id_table	= gb_hid_id_table,
};

module_greybus_driver(gb_hid_driver);

MODULE_LICENSE("GPL v2");
Overall Contributors
Person
Tokens
Prop
Commits
CommitProp
Viresh Kumar
1867
82.36%
7
35.00%
Johan Hovold
228
10.06%
8
40.00%
Philip Yang
151
6.66%
1
5.00%
Greg Kroah-Hartman
21
0.93%
4
20.00%
Total
2267
100.00%
20
100.00%
Directory: drivers/staging/greybus

Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.