blob: 9c2d7c23f2966f43953626b82d03cf62bca0c8ba [file] [log] [blame]
Jiri Kosina86166b72007-05-14 09:57:40 +02001/*
2 * HID raw devices, giving access to raw HID events.
3 *
4 * In comparison to hiddev, this device does not process the
5 * hid events at all (no parsing, no lookups). This lets applications
6 * to work on raw hid events as they want to, and avoids a need to
7 * use a transport-specific userspace libhid/libusb libraries.
8 *
Jiri Kosina61834532014-01-06 16:43:27 +01009 * Copyright (c) 2007-2014 Jiri Kosina
Jiri Kosina86166b72007-05-14 09:57:40 +020010 */
11
12/*
13 * This program is free software; you can redistribute it and/or modify it
14 * under the terms and conditions of the GNU General Public License,
15 * version 2, as published by the Free Software Foundation.
16 *
17 * You should have received a copy of the GNU General Public License along with
18 * this program; if not, write to the Free Software Foundation, Inc.,
19 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
20 */
21
Joe Perches4291ee32010-12-09 19:29:03 -080022#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
23
Jiri Kosina86166b72007-05-14 09:57:40 +020024#include <linux/fs.h>
25#include <linux/module.h>
26#include <linux/errno.h>
27#include <linux/kernel.h>
28#include <linux/init.h>
29#include <linux/cdev.h>
30#include <linux/poll.h>
31#include <linux/device.h>
32#include <linux/major.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090033#include <linux/slab.h>
Jiri Kosina86166b72007-05-14 09:57:40 +020034#include <linux/hid.h>
35#include <linux/mutex.h>
Alexey Dobriyana99bbaf2009-10-04 16:11:37 +040036#include <linux/sched.h>
Jiri Kosina86166b72007-05-14 09:57:40 +020037
38#include <linux/hidraw.h>
39
40static int hidraw_major;
41static struct cdev hidraw_cdev;
42static struct class *hidraw_class;
43static struct hidraw *hidraw_table[HIDRAW_MAX_DEVICES];
Oliver Neukum7d672cd2008-10-31 00:07:23 +010044static DEFINE_MUTEX(minors_lock);
Jiri Kosina86166b72007-05-14 09:57:40 +020045
46static ssize_t hidraw_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos)
47{
48 struct hidraw_list *list = file->private_data;
49 int ret = 0, len;
Jiri Kosina86166b72007-05-14 09:57:40 +020050 DECLARE_WAITQUEUE(wait, current);
51
Jiri Kosinab0e14952009-10-12 11:25:56 +020052 mutex_lock(&list->read_mutex);
53
Jiri Kosina86166b72007-05-14 09:57:40 +020054 while (ret == 0) {
Jiri Kosina86166b72007-05-14 09:57:40 +020055 if (list->head == list->tail) {
56 add_wait_queue(&list->hidraw->wait, &wait);
57 set_current_state(TASK_INTERRUPTIBLE);
58
59 while (list->head == list->tail) {
Jiri Kosina86166b72007-05-14 09:57:40 +020060 if (signal_pending(current)) {
61 ret = -ERESTARTSYS;
62 break;
63 }
64 if (!list->hidraw->exist) {
65 ret = -EIO;
66 break;
67 }
Founder Fang7611e8d2012-11-21 15:20:31 +080068 if (file->f_flags & O_NONBLOCK) {
69 ret = -EAGAIN;
70 break;
71 }
Jiri Kosina86166b72007-05-14 09:57:40 +020072
73 /* allow O_NONBLOCK to work well from other threads */
74 mutex_unlock(&list->read_mutex);
75 schedule();
76 mutex_lock(&list->read_mutex);
77 set_current_state(TASK_INTERRUPTIBLE);
78 }
79
80 set_current_state(TASK_RUNNING);
81 remove_wait_queue(&list->hidraw->wait, &wait);
82 }
83
84 if (ret)
85 goto out;
86
Jiri Kosina86166b72007-05-14 09:57:40 +020087 len = list->buffer[list->tail].len > count ?
88 count : list->buffer[list->tail].len;
89
Jiri Kosinab6787242012-04-27 00:56:08 +020090 if (list->buffer[list->tail].value) {
91 if (copy_to_user(buffer, list->buffer[list->tail].value, len)) {
92 ret = -EFAULT;
93 goto out;
94 }
95 ret = len;
Jiri Kosina86166b72007-05-14 09:57:40 +020096 }
Jiri Kosina86166b72007-05-14 09:57:40 +020097
98 kfree(list->buffer[list->tail].value);
Matthieu CASTET4c7b4172012-06-28 16:51:56 +020099 list->buffer[list->tail].value = NULL;
Jiri Kosina86166b72007-05-14 09:57:40 +0200100 list->tail = (list->tail + 1) & (HIDRAW_BUFFER_SIZE - 1);
101 }
102out:
103 mutex_unlock(&list->read_mutex);
104 return ret;
105}
106
Jiri Kosina61834532014-01-06 16:43:27 +0100107/*
108 * The first byte of the report buffer is expected to be a report number.
109 *
110 * This function is to be called with the minors_lock mutex held.
111 */
Alan Ottb4dbde92011-01-18 03:04:39 -0500112static ssize_t hidraw_send_report(struct file *file, const char __user *buffer, size_t count, unsigned char report_type)
Jiri Kosina86166b72007-05-14 09:57:40 +0200113{
Al Viro496ad9a2013-01-23 17:07:38 -0500114 unsigned int minor = iminor(file_inode(file));
Jiri Kosina2e574802010-03-25 14:15:11 +0100115 struct hid_device *dev;
Jiri Kosina86166b72007-05-14 09:57:40 +0200116 __u8 *buf;
117 int ret = 0;
118
Manoj Chourasia212a8712013-07-22 15:33:13 +0530119 if (!hidraw_table[minor] || !hidraw_table[minor]->exist) {
Antonio Ospitee42dee92010-10-05 17:20:17 +0200120 ret = -ENODEV;
121 goto out;
122 }
123
Jiri Kosina2e574802010-03-25 14:15:11 +0100124 dev = hidraw_table[minor]->hid;
125
Jiri Kosina86166b72007-05-14 09:57:40 +0200126
Jiri Kosina2b107d62008-09-17 19:41:58 +0200127 if (count > HID_MAX_BUFFER_SIZE) {
Joe Perches4291ee32010-12-09 19:29:03 -0800128 hid_warn(dev, "pid %d passed too large report\n",
129 task_pid_nr(current));
Jiri Kosina2e574802010-03-25 14:15:11 +0100130 ret = -EINVAL;
131 goto out;
Jiri Kosina86166b72007-05-14 09:57:40 +0200132 }
133
134 if (count < 2) {
Joe Perches4291ee32010-12-09 19:29:03 -0800135 hid_warn(dev, "pid %d passed too short report\n",
136 task_pid_nr(current));
Jiri Kosina2e574802010-03-25 14:15:11 +0100137 ret = -EINVAL;
Jiri Kosina86166b72007-05-14 09:57:40 +0200138 goto out;
139 }
140
Jiri Kosina2e574802010-03-25 14:15:11 +0100141 buf = kmalloc(count * sizeof(__u8), GFP_KERNEL);
142 if (!buf) {
143 ret = -ENOMEM;
144 goto out;
145 }
146
147 if (copy_from_user(buf, buffer, count)) {
148 ret = -EFAULT;
149 goto out_free;
150 }
151
Benjamin Tissoirese534a932014-03-08 22:52:42 -0500152 if ((report_type == HID_OUTPUT_REPORT) &&
153 !(dev->quirks & HID_QUIRK_NO_OUTPUT_REPORTS_ON_INTR_EP)) {
Benjamin Tissoires3a75b242014-02-20 15:24:50 -0500154 ret = hid_hw_output_report(dev, buf, count);
155 /*
156 * compatibility with old implementation of USB-HID and I2C-HID:
157 * if the device does not support receiving output reports,
158 * on an interrupt endpoint, fallback to SET_REPORT HID command.
159 */
160 if (ret != -ENOSYS)
161 goto out_free;
162 }
163
164 ret = hid_hw_raw_request(dev, buf[0], buf, count, report_type,
165 HID_REQ_SET_REPORT);
166
Jiri Kosina2e574802010-03-25 14:15:11 +0100167out_free:
Jiri Kosina86166b72007-05-14 09:57:40 +0200168 kfree(buf);
Jiri Kosina2e574802010-03-25 14:15:11 +0100169out:
Alan Ottb4dbde92011-01-18 03:04:39 -0500170 return ret;
171}
172
Alan Ottb4dbde92011-01-18 03:04:39 -0500173static ssize_t hidraw_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
174{
175 ssize_t ret;
176 mutex_lock(&minors_lock);
177 ret = hidraw_send_report(file, buffer, count, HID_OUTPUT_REPORT);
Jiri Kosina2e574802010-03-25 14:15:11 +0100178 mutex_unlock(&minors_lock);
Jiri Kosina86166b72007-05-14 09:57:40 +0200179 return ret;
180}
181
Alan Ottb4dbde92011-01-18 03:04:39 -0500182
Jiri Kosina61834532014-01-06 16:43:27 +0100183/*
184 * This function performs a Get_Report transfer over the control endpoint
Jiri Kosinad2a1cfe2011-03-27 20:29:02 +0200185 * per section 7.2.1 of the HID specification, version 1.1. The first byte
186 * of buffer is the report number to request, or 0x0 if the defice does not
187 * use numbered reports. The report_type parameter can be HID_FEATURE_REPORT
Jiri Kosina61834532014-01-06 16:43:27 +0100188 * or HID_INPUT_REPORT.
189 *
190 * This function is to be called with the minors_lock mutex held.
191 */
Alan Ottb4dbde92011-01-18 03:04:39 -0500192static ssize_t hidraw_get_report(struct file *file, char __user *buffer, size_t count, unsigned char report_type)
193{
Al Viro496ad9a2013-01-23 17:07:38 -0500194 unsigned int minor = iminor(file_inode(file));
Alan Ottb4dbde92011-01-18 03:04:39 -0500195 struct hid_device *dev;
196 __u8 *buf;
197 int ret = 0, len;
198 unsigned char report_number;
199
200 dev = hidraw_table[minor]->hid;
201
Benjamin Tissoirescafebc02014-02-05 16:33:22 -0500202 if (!dev->ll_driver->raw_request) {
Alan Ottb4dbde92011-01-18 03:04:39 -0500203 ret = -ENODEV;
204 goto out;
205 }
206
207 if (count > HID_MAX_BUFFER_SIZE) {
208 printk(KERN_WARNING "hidraw: pid %d passed too large report\n",
209 task_pid_nr(current));
210 ret = -EINVAL;
211 goto out;
212 }
213
214 if (count < 2) {
215 printk(KERN_WARNING "hidraw: pid %d passed too short report\n",
216 task_pid_nr(current));
217 ret = -EINVAL;
218 goto out;
219 }
220
221 buf = kmalloc(count * sizeof(__u8), GFP_KERNEL);
222 if (!buf) {
223 ret = -ENOMEM;
224 goto out;
225 }
226
Jiri Kosina61834532014-01-06 16:43:27 +0100227 /*
228 * Read the first byte from the user. This is the report number,
Benjamin Tissoirescafebc02014-02-05 16:33:22 -0500229 * which is passed to hid_hw_raw_request().
Jiri Kosina61834532014-01-06 16:43:27 +0100230 */
Alan Ottb4dbde92011-01-18 03:04:39 -0500231 if (copy_from_user(&report_number, buffer, 1)) {
232 ret = -EFAULT;
233 goto out_free;
234 }
235
Benjamin Tissoirescafebc02014-02-05 16:33:22 -0500236 ret = hid_hw_raw_request(dev, report_number, buf, count, report_type,
237 HID_REQ_GET_REPORT);
Alan Ottb4dbde92011-01-18 03:04:39 -0500238
239 if (ret < 0)
240 goto out_free;
241
242 len = (ret < count) ? ret : count;
243
244 if (copy_to_user(buffer, buf, len)) {
245 ret = -EFAULT;
246 goto out_free;
247 }
248
249 ret = len;
250
251out_free:
252 kfree(buf);
253out:
254 return ret;
255}
256
Jiri Kosina86166b72007-05-14 09:57:40 +0200257static unsigned int hidraw_poll(struct file *file, poll_table *wait)
258{
259 struct hidraw_list *list = file->private_data;
260
261 poll_wait(file, &list->hidraw->wait, wait);
262 if (list->head != list->tail)
263 return POLLIN | POLLRDNORM;
264 if (!list->hidraw->exist)
265 return POLLERR | POLLHUP;
266 return 0;
267}
268
269static int hidraw_open(struct inode *inode, struct file *file)
270{
271 unsigned int minor = iminor(inode);
272 struct hidraw *dev;
273 struct hidraw_list *list;
Yonghua Zheng277fe442013-08-26 23:38:35 +0800274 unsigned long flags;
Jiri Kosina86166b72007-05-14 09:57:40 +0200275 int err = 0;
276
277 if (!(list = kzalloc(sizeof(struct hidraw_list), GFP_KERNEL))) {
278 err = -ENOMEM;
279 goto out;
280 }
281
Oliver Neukum7d672cd2008-10-31 00:07:23 +0100282 mutex_lock(&minors_lock);
Manoj Chourasia212a8712013-07-22 15:33:13 +0530283 if (!hidraw_table[minor] || !hidraw_table[minor]->exist) {
Jiri Kosina86166b72007-05-14 09:57:40 +0200284 err = -ENODEV;
285 goto out_unlock;
286 }
287
Jiri Kosina86166b72007-05-14 09:57:40 +0200288 dev = hidraw_table[minor];
Oliver Neukum7d672cd2008-10-31 00:07:23 +0100289 if (!dev->open++) {
Dmitry Torokhov5bea7662010-12-07 23:02:48 -0800290 err = hid_hw_power(dev->hid, PM_HINT_FULLON);
Amit Nagalf554ff82011-09-27 13:41:58 -0400291 if (err < 0) {
292 dev->open--;
Dmitry Torokhov5bea7662010-12-07 23:02:48 -0800293 goto out_unlock;
Amit Nagalf554ff82011-09-27 13:41:58 -0400294 }
Dmitry Torokhov5bea7662010-12-07 23:02:48 -0800295
296 err = hid_hw_open(dev->hid);
Oliver Neukum0361a282008-12-17 15:38:03 +0100297 if (err < 0) {
Dmitry Torokhov5bea7662010-12-07 23:02:48 -0800298 hid_hw_power(dev->hid, PM_HINT_NORMAL);
Oliver Neukum7d672cd2008-10-31 00:07:23 +0100299 dev->open--;
Yonghua Zheng277fe442013-08-26 23:38:35 +0800300 goto out_unlock;
Oliver Neukum0361a282008-12-17 15:38:03 +0100301 }
Oliver Neukum7d672cd2008-10-31 00:07:23 +0100302 }
Jiri Kosina86166b72007-05-14 09:57:40 +0200303
Yonghua Zheng277fe442013-08-26 23:38:35 +0800304 list->hidraw = hidraw_table[minor];
305 mutex_init(&list->read_mutex);
306 spin_lock_irqsave(&hidraw_table[minor]->list_lock, flags);
307 list_add_tail(&list->node, &hidraw_table[minor]->list);
308 spin_unlock_irqrestore(&hidraw_table[minor]->list_lock, flags);
309 file->private_data = list;
Jiri Kosina86166b72007-05-14 09:57:40 +0200310out_unlock:
Oliver Neukum7d672cd2008-10-31 00:07:23 +0100311 mutex_unlock(&minors_lock);
Oliver Neukum7d672cd2008-10-31 00:07:23 +0100312out:
Amit Nagal1a896232011-09-07 13:48:47 +0200313 if (err < 0)
314 kfree(list);
Jiri Kosina86166b72007-05-14 09:57:40 +0200315 return err;
316
317}
318
Andrew Dugganb5531312012-11-27 19:02:27 -0800319static int hidraw_fasync(int fd, struct file *file, int on)
320{
321 struct hidraw_list *list = file->private_data;
322
323 return fasync_helper(fd, file, on, &list->fasync);
324}
325
Manoj Chourasia212a8712013-07-22 15:33:13 +0530326static void drop_ref(struct hidraw *hidraw, int exists_bit)
327{
328 if (exists_bit) {
Manoj Chourasia212a8712013-07-22 15:33:13 +0530329 hidraw->exist = 0;
Manoj Chourasia0f5a24c2013-10-01 15:39:00 +0530330 if (hidraw->open) {
331 hid_hw_close(hidraw->hid);
Manoj Chourasia212a8712013-07-22 15:33:13 +0530332 wake_up_interruptible(&hidraw->wait);
Manoj Chourasia0f5a24c2013-10-01 15:39:00 +0530333 }
Fernando Luis Vázquez Cao47587fc2014-02-26 16:51:24 +0900334 device_destroy(hidraw_class,
335 MKDEV(hidraw_major, hidraw->minor));
Manoj Chourasia212a8712013-07-22 15:33:13 +0530336 } else {
337 --hidraw->open;
338 }
Manoj Chourasia0f5a24c2013-10-01 15:39:00 +0530339 if (!hidraw->open) {
340 if (!hidraw->exist) {
Manoj Chourasia0f5a24c2013-10-01 15:39:00 +0530341 hidraw_table[hidraw->minor] = NULL;
342 kfree(hidraw);
343 } else {
344 /* close device for last reader */
345 hid_hw_power(hidraw->hid, PM_HINT_NORMAL);
346 hid_hw_close(hidraw->hid);
347 }
Manoj Chourasia212a8712013-07-22 15:33:13 +0530348 }
349}
350
Jiri Kosina86166b72007-05-14 09:57:40 +0200351static int hidraw_release(struct inode * inode, struct file * file)
352{
353 unsigned int minor = iminor(inode);
Jiri Kosina86166b72007-05-14 09:57:40 +0200354 struct hidraw_list *list = file->private_data;
Yonghua Zheng277fe442013-08-26 23:38:35 +0800355 unsigned long flags;
Jiri Kosina86166b72007-05-14 09:57:40 +0200356
Jiri Kosinadf0cfd62012-11-01 11:33:26 +0100357 mutex_lock(&minors_lock);
Jiri Kosinadf0cfd62012-11-01 11:33:26 +0100358
Yonghua Zheng277fe442013-08-26 23:38:35 +0800359 spin_lock_irqsave(&hidraw_table[minor]->list_lock, flags);
Jiri Kosina86166b72007-05-14 09:57:40 +0200360 list_del(&list->node);
Yonghua Zheng277fe442013-08-26 23:38:35 +0800361 spin_unlock_irqrestore(&hidraw_table[minor]->list_lock, flags);
Jiri Kosina4db1c622008-06-24 14:45:27 +0200362 kfree(list);
Jiri Kosinadf0cfd62012-11-01 11:33:26 +0100363
Manoj Chourasia212a8712013-07-22 15:33:13 +0530364 drop_ref(hidraw_table[minor], 0);
365
366 mutex_unlock(&minors_lock);
367 return 0;
Jiri Kosina86166b72007-05-14 09:57:40 +0200368}
369
Alan Cox979c4072008-05-26 11:25:26 +0200370static long hidraw_ioctl(struct file *file, unsigned int cmd,
371 unsigned long arg)
Jiri Kosina86166b72007-05-14 09:57:40 +0200372{
Al Viro496ad9a2013-01-23 17:07:38 -0500373 struct inode *inode = file_inode(file);
Jiri Kosina86166b72007-05-14 09:57:40 +0200374 unsigned int minor = iminor(inode);
Alan Cox979c4072008-05-26 11:25:26 +0200375 long ret = 0;
Jiri Kosina2e574802010-03-25 14:15:11 +0100376 struct hidraw *dev;
Jiri Kosina86166b72007-05-14 09:57:40 +0200377 void __user *user_arg = (void __user*) arg;
378
Jiri Kosina2e574802010-03-25 14:15:11 +0100379 mutex_lock(&minors_lock);
380 dev = hidraw_table[minor];
Antonio Ospited20d5ff2010-10-05 17:20:16 +0200381 if (!dev) {
382 ret = -ENODEV;
383 goto out;
384 }
Jiri Kosina2e574802010-03-25 14:15:11 +0100385
Jiri Kosina86166b72007-05-14 09:57:40 +0200386 switch (cmd) {
387 case HIDIOCGRDESCSIZE:
388 if (put_user(dev->hid->rsize, (int __user *)arg))
Alan Cox979c4072008-05-26 11:25:26 +0200389 ret = -EFAULT;
390 break;
Jiri Kosina86166b72007-05-14 09:57:40 +0200391
392 case HIDIOCGRDESC:
393 {
394 __u32 len;
395
396 if (get_user(len, (int __user *)arg))
Alan Cox979c4072008-05-26 11:25:26 +0200397 ret = -EFAULT;
398 else if (len > HID_MAX_DESCRIPTOR_SIZE - 1)
399 ret = -EINVAL;
400 else if (copy_to_user(user_arg + offsetof(
401 struct hidraw_report_descriptor,
402 value[0]),
403 dev->hid->rdesc,
404 min(dev->hid->rsize, len)))
405 ret = -EFAULT;
406 break;
Jiri Kosina86166b72007-05-14 09:57:40 +0200407 }
408 case HIDIOCGRAWINFO:
409 {
410 struct hidraw_devinfo dinfo;
411
412 dinfo.bustype = dev->hid->bus;
413 dinfo.vendor = dev->hid->vendor;
414 dinfo.product = dev->hid->product;
415 if (copy_to_user(user_arg, &dinfo, sizeof(dinfo)))
Alan Cox979c4072008-05-26 11:25:26 +0200416 ret = -EFAULT;
417 break;
Jiri Kosina86166b72007-05-14 09:57:40 +0200418 }
419 default:
Jiri Kosina9188e792008-11-12 16:14:08 +0100420 {
421 struct hid_device *hid = dev->hid;
Alan Ottb4dbde92011-01-18 03:04:39 -0500422 if (_IOC_TYPE(cmd) != 'H') {
423 ret = -EINVAL;
424 break;
425 }
426
427 if (_IOC_NR(cmd) == _IOC_NR(HIDIOCSFEATURE(0))) {
428 int len = _IOC_SIZE(cmd);
429 ret = hidraw_send_report(file, user_arg, len, HID_FEATURE_REPORT);
430 break;
431 }
432 if (_IOC_NR(cmd) == _IOC_NR(HIDIOCGFEATURE(0))) {
433 int len = _IOC_SIZE(cmd);
434 ret = hidraw_get_report(file, user_arg, len, HID_FEATURE_REPORT);
435 break;
436 }
437
438 /* Begin Read-only ioctls. */
439 if (_IOC_DIR(cmd) != _IOC_READ) {
Dan Carpenterdfd395af2009-02-03 16:35:17 +0300440 ret = -EINVAL;
441 break;
442 }
Jiri Kosina9188e792008-11-12 16:14:08 +0100443
444 if (_IOC_NR(cmd) == _IOC_NR(HIDIOCGRAWNAME(0))) {
Daniel Mackdd2ed482011-05-15 18:07:42 +0200445 int len = strlen(hid->name) + 1;
Jiri Kosina9188e792008-11-12 16:14:08 +0100446 if (len > _IOC_SIZE(cmd))
447 len = _IOC_SIZE(cmd);
Dan Carpenterdfd395af2009-02-03 16:35:17 +0300448 ret = copy_to_user(user_arg, hid->name, len) ?
Jiri Kosina9188e792008-11-12 16:14:08 +0100449 -EFAULT : len;
Dan Carpenterdfd395af2009-02-03 16:35:17 +0300450 break;
Jiri Kosina9188e792008-11-12 16:14:08 +0100451 }
452
453 if (_IOC_NR(cmd) == _IOC_NR(HIDIOCGRAWPHYS(0))) {
Daniel Mackdd2ed482011-05-15 18:07:42 +0200454 int len = strlen(hid->phys) + 1;
Jiri Kosina9188e792008-11-12 16:14:08 +0100455 if (len > _IOC_SIZE(cmd))
456 len = _IOC_SIZE(cmd);
Dan Carpenterdfd395af2009-02-03 16:35:17 +0300457 ret = copy_to_user(user_arg, hid->phys, len) ?
Jiri Kosina9188e792008-11-12 16:14:08 +0100458 -EFAULT : len;
Dan Carpenterdfd395af2009-02-03 16:35:17 +0300459 break;
Jiri Kosina9188e792008-11-12 16:14:08 +0100460 }
Alan Ottb4dbde92011-01-18 03:04:39 -0500461 }
Jiri Kosina9188e792008-11-12 16:14:08 +0100462
Dan Carpenterdfd395af2009-02-03 16:35:17 +0300463 ret = -ENOTTY;
Jiri Kosina86166b72007-05-14 09:57:40 +0200464 }
Antonio Ospited20d5ff2010-10-05 17:20:16 +0200465out:
Jiri Kosina2e574802010-03-25 14:15:11 +0100466 mutex_unlock(&minors_lock);
Alan Cox979c4072008-05-26 11:25:26 +0200467 return ret;
Jiri Kosina86166b72007-05-14 09:57:40 +0200468}
469
470static const struct file_operations hidraw_ops = {
471 .owner = THIS_MODULE,
472 .read = hidraw_read,
473 .write = hidraw_write,
474 .poll = hidraw_poll,
475 .open = hidraw_open,
476 .release = hidraw_release,
Alan Cox979c4072008-05-26 11:25:26 +0200477 .unlocked_ioctl = hidraw_ioctl,
Andrew Dugganb5531312012-11-27 19:02:27 -0800478 .fasync = hidraw_fasync,
Alan Ottae5e49c2011-01-04 00:37:22 -0500479#ifdef CONFIG_COMPAT
480 .compat_ioctl = hidraw_ioctl,
481#endif
Arnd Bergmann6038f372010-08-15 18:52:59 +0200482 .llseek = noop_llseek,
Jiri Kosina86166b72007-05-14 09:57:40 +0200483};
484
Jiri Kosinab6787242012-04-27 00:56:08 +0200485int hidraw_report_event(struct hid_device *hid, u8 *data, int len)
Jiri Kosina86166b72007-05-14 09:57:40 +0200486{
487 struct hidraw *dev = hid->hidraw;
488 struct hidraw_list *list;
Jiri Kosinab6787242012-04-27 00:56:08 +0200489 int ret = 0;
Yonghua Zheng277fe442013-08-26 23:38:35 +0800490 unsigned long flags;
Jiri Kosina86166b72007-05-14 09:57:40 +0200491
Yonghua Zheng277fe442013-08-26 23:38:35 +0800492 spin_lock_irqsave(&dev->list_lock, flags);
Jiri Kosina86166b72007-05-14 09:57:40 +0200493 list_for_each_entry(list, &dev->list, node) {
Matthieu CASTET4c7b4172012-06-28 16:51:56 +0200494 int new_head = (list->head + 1) & (HIDRAW_BUFFER_SIZE - 1);
495
496 if (new_head == list->tail)
497 continue;
498
Jiri Kosinab6787242012-04-27 00:56:08 +0200499 if (!(list->buffer[list->head].value = kmemdup(data, len, GFP_ATOMIC))) {
500 ret = -ENOMEM;
501 break;
502 }
Jiri Kosina86166b72007-05-14 09:57:40 +0200503 list->buffer[list->head].len = len;
Matthieu CASTET4c7b4172012-06-28 16:51:56 +0200504 list->head = new_head;
Jiri Kosina86166b72007-05-14 09:57:40 +0200505 kill_fasync(&list->fasync, SIGIO, POLL_IN);
506 }
Yonghua Zheng277fe442013-08-26 23:38:35 +0800507 spin_unlock_irqrestore(&dev->list_lock, flags);
Jiri Kosina86166b72007-05-14 09:57:40 +0200508
509 wake_up_interruptible(&dev->wait);
Jiri Kosinab6787242012-04-27 00:56:08 +0200510 return ret;
Jiri Kosina86166b72007-05-14 09:57:40 +0200511}
512EXPORT_SYMBOL_GPL(hidraw_report_event);
513
514int hidraw_connect(struct hid_device *hid)
515{
Mariusz Kozlowski709d27c2007-09-27 11:24:55 +0200516 int minor, result;
Jiri Kosina86166b72007-05-14 09:57:40 +0200517 struct hidraw *dev;
518
Jiri Kosina61834532014-01-06 16:43:27 +0100519 /* we accept any HID device, all applications */
Jiri Kosina86166b72007-05-14 09:57:40 +0200520
Mariusz Kozlowski709d27c2007-09-27 11:24:55 +0200521 dev = kzalloc(sizeof(struct hidraw), GFP_KERNEL);
522 if (!dev)
523 return -ENOMEM;
524
525 result = -EINVAL;
Jiri Kosina86166b72007-05-14 09:57:40 +0200526
Oliver Neukum7d672cd2008-10-31 00:07:23 +0100527 mutex_lock(&minors_lock);
Jiri Kosina86166b72007-05-14 09:57:40 +0200528
529 for (minor = 0; minor < HIDRAW_MAX_DEVICES; minor++) {
530 if (hidraw_table[minor])
531 continue;
532 hidraw_table[minor] = dev;
533 result = 0;
534 break;
535 }
536
Mariusz Kozlowski709d27c2007-09-27 11:24:55 +0200537 if (result) {
Oliver Neukum7d672cd2008-10-31 00:07:23 +0100538 mutex_unlock(&minors_lock);
Mariusz Kozlowski709d27c2007-09-27 11:24:55 +0200539 kfree(dev);
Jiri Kosina86166b72007-05-14 09:57:40 +0200540 goto out;
Mariusz Kozlowski709d27c2007-09-27 11:24:55 +0200541 }
Jiri Kosina86166b72007-05-14 09:57:40 +0200542
Jiri Kosinaaae6c282008-12-04 16:16:46 +0100543 dev->dev = device_create(hidraw_class, &hid->dev, MKDEV(hidraw_major, minor),
Greg Kroah-Hartmana9b12612008-07-21 20:03:34 -0700544 NULL, "%s%d", "hidraw", minor);
Jiri Kosina86166b72007-05-14 09:57:40 +0200545
546 if (IS_ERR(dev->dev)) {
Jiri Kosina86166b72007-05-14 09:57:40 +0200547 hidraw_table[minor] = NULL;
Oliver Neukum7d672cd2008-10-31 00:07:23 +0100548 mutex_unlock(&minors_lock);
Jiri Kosina86166b72007-05-14 09:57:40 +0200549 result = PTR_ERR(dev->dev);
Mariusz Kozlowski709d27c2007-09-27 11:24:55 +0200550 kfree(dev);
Jiri Kosina86166b72007-05-14 09:57:40 +0200551 goto out;
552 }
553
554 init_waitqueue_head(&dev->wait);
Yonghua Zheng277fe442013-08-26 23:38:35 +0800555 spin_lock_init(&dev->list_lock);
Jiri Kosina86166b72007-05-14 09:57:40 +0200556 INIT_LIST_HEAD(&dev->list);
557
558 dev->hid = hid;
559 dev->minor = minor;
560
561 dev->exist = 1;
562 hid->hidraw = dev;
563
Yonghua Zheng8e552e52013-07-30 14:16:10 +0800564 mutex_unlock(&minors_lock);
Jiri Kosina86166b72007-05-14 09:57:40 +0200565out:
566 return result;
567
568}
569EXPORT_SYMBOL_GPL(hidraw_connect);
570
571void hidraw_disconnect(struct hid_device *hid)
572{
573 struct hidraw *hidraw = hid->hidraw;
Jiri Kosinadf0cfd62012-11-01 11:33:26 +0100574
575 mutex_lock(&minors_lock);
Jiri Kosinadf0cfd62012-11-01 11:33:26 +0100576
Manoj Chourasia212a8712013-07-22 15:33:13 +0530577 drop_ref(hidraw, 1);
Jiri Kosinadf0cfd62012-11-01 11:33:26 +0100578
Jiri Kosinadf0cfd62012-11-01 11:33:26 +0100579 mutex_unlock(&minors_lock);
Jiri Kosina86166b72007-05-14 09:57:40 +0200580}
581EXPORT_SYMBOL_GPL(hidraw_disconnect);
582
583int __init hidraw_init(void)
584{
585 int result;
586 dev_t dev_id;
587
588 result = alloc_chrdev_region(&dev_id, HIDRAW_FIRST_MINOR,
589 HIDRAW_MAX_DEVICES, "hidraw");
590
591 hidraw_major = MAJOR(dev_id);
592
593 if (result < 0) {
Joe Perches4291ee32010-12-09 19:29:03 -0800594 pr_warn("can't get major number\n");
Jiri Kosina86166b72007-05-14 09:57:40 +0200595 goto out;
596 }
597
598 hidraw_class = class_create(THIS_MODULE, "hidraw");
599 if (IS_ERR(hidraw_class)) {
600 result = PTR_ERR(hidraw_class);
Alexey Khoroshilovbcb4a752012-08-15 23:31:45 +0400601 goto error_cdev;
Jiri Kosina86166b72007-05-14 09:57:40 +0200602 }
603
604 cdev_init(&hidraw_cdev, &hidraw_ops);
Alexey Khoroshilovbcb4a752012-08-15 23:31:45 +0400605 result = cdev_add(&hidraw_cdev, dev_id, HIDRAW_MAX_DEVICES);
606 if (result < 0)
607 goto error_class;
608
Jiri Kosina0f690cc2013-02-19 14:05:34 +0100609 printk(KERN_INFO "hidraw: raw HID events driver (C) Jiri Kosina\n");
Jiri Kosina86166b72007-05-14 09:57:40 +0200610out:
611 return result;
Alexey Khoroshilovbcb4a752012-08-15 23:31:45 +0400612
613error_class:
614 class_destroy(hidraw_class);
615error_cdev:
616 unregister_chrdev_region(dev_id, HIDRAW_MAX_DEVICES);
617 goto out;
Jiri Kosina86166b72007-05-14 09:57:40 +0200618}
619
Jiri Slaby140ae3e2008-10-17 18:04:48 +0200620void hidraw_exit(void)
Jiri Kosina86166b72007-05-14 09:57:40 +0200621{
622 dev_t dev_id = MKDEV(hidraw_major, 0);
623
624 cdev_del(&hidraw_cdev);
625 class_destroy(hidraw_class);
626 unregister_chrdev_region(dev_id, HIDRAW_MAX_DEVICES);
627
628}