2 HIDP implementation for Linux Bluetooth stack (BlueZ).
3 Copyright (C) 2003-2004 Marcel Holtmann <marcel@holtmann.org>
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU General Public License version 2 as
7 published by the Free Software Foundation;
9 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
10 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
11 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
12 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
13 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
14 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
19 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
20 SOFTWARE IS DISCLAIMED.
23 #include <linux/module.h>
25 #include <linux/types.h>
26 #include <linux/errno.h>
27 #include <linux/kernel.h>
28 #include <linux/sched.h>
29 #include <linux/slab.h>
30 #include <linux/poll.h>
31 #include <linux/freezer.h>
32 #include <linux/fcntl.h>
33 #include <linux/skbuff.h>
34 #include <linux/socket.h>
35 #include <linux/ioctl.h>
36 #include <linux/file.h>
37 #include <linux/init.h>
38 #include <linux/wait.h>
39 #include <linux/mutex.h>
40 #include <linux/kthread.h>
43 #include <linux/input.h>
44 #include <linux/hid.h>
45 #include <linux/hidraw.h>
47 #include <net/bluetooth/bluetooth.h>
48 #include <net/bluetooth/hci_core.h>
49 #include <net/bluetooth/l2cap.h>
55 static DECLARE_RWSEM(hidp_session_sem);
56 static LIST_HEAD(hidp_session_list);
58 static unsigned char hidp_keycode[256] = {
59 0, 0, 0, 0, 30, 48, 46, 32, 18, 33, 34, 35, 23, 36,
60 37, 38, 50, 49, 24, 25, 16, 19, 31, 20, 22, 47, 17, 45,
61 21, 44, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 28, 1,
62 14, 15, 57, 12, 13, 26, 27, 43, 43, 39, 40, 41, 51, 52,
63 53, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 87, 88,
64 99, 70, 119, 110, 102, 104, 111, 107, 109, 106, 105, 108, 103, 69,
65 98, 55, 74, 78, 96, 79, 80, 81, 75, 76, 77, 71, 72, 73,
66 82, 83, 86, 127, 116, 117, 183, 184, 185, 186, 187, 188, 189, 190,
67 191, 192, 193, 194, 134, 138, 130, 132, 128, 129, 131, 137, 133, 135,
68 136, 113, 115, 114, 0, 0, 0, 121, 0, 89, 93, 124, 92, 94,
69 95, 0, 0, 0, 122, 123, 90, 91, 85, 0, 0, 0, 0, 0,
70 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
71 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
72 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
73 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
74 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
75 29, 42, 56, 125, 97, 54, 100, 126, 164, 166, 165, 163, 161, 115,
76 114, 113, 150, 158, 159, 128, 136, 177, 178, 176, 142, 152, 173, 140
79 static unsigned char hidp_mkeyspat[] = { 0x01, 0x01, 0x01, 0x01, 0x01, 0x01 };
81 static struct hidp_session *__hidp_get_session(bdaddr_t *bdaddr)
83 struct hidp_session *session;
88 list_for_each(p, &hidp_session_list) {
89 session = list_entry(p, struct hidp_session, list);
90 if (!bacmp(bdaddr, &session->bdaddr))
96 static void __hidp_link_session(struct hidp_session *session)
98 __module_get(THIS_MODULE);
99 list_add(&session->list, &hidp_session_list);
101 hci_conn_hold_device(session->conn);
104 static void __hidp_unlink_session(struct hidp_session *session)
106 hci_conn_put_device(session->conn);
108 list_del(&session->list);
109 module_put(THIS_MODULE);
112 static void __hidp_copy_session(struct hidp_session *session, struct hidp_conninfo *ci)
114 memset(ci, 0, sizeof(*ci));
115 bacpy(&ci->bdaddr, &session->bdaddr);
117 ci->flags = session->flags;
118 ci->state = session->state;
121 ci->product = 0x0000;
122 ci->version = 0x0000;
124 if (session->input) {
125 ci->vendor = session->input->id.vendor;
126 ci->product = session->input->id.product;
127 ci->version = session->input->id.version;
128 if (session->input->name)
129 strncpy(ci->name, session->input->name, 128);
131 strncpy(ci->name, "HID Boot Device", 128);
135 ci->vendor = session->hid->vendor;
136 ci->product = session->hid->product;
137 ci->version = session->hid->version;
138 strncpy(ci->name, session->hid->name, 128);
142 static int hidp_queue_event(struct hidp_session *session, struct input_dev *dev,
143 unsigned int type, unsigned int code, int value)
145 unsigned char newleds;
148 BT_DBG("session %p type %d code %d value %d", session, type, code, value);
153 newleds = (!!test_bit(LED_KANA, dev->led) << 3) |
154 (!!test_bit(LED_COMPOSE, dev->led) << 3) |
155 (!!test_bit(LED_SCROLLL, dev->led) << 2) |
156 (!!test_bit(LED_CAPSL, dev->led) << 1) |
157 (!!test_bit(LED_NUML, dev->led));
159 if (session->leds == newleds)
162 session->leds = newleds;
164 skb = alloc_skb(3, GFP_ATOMIC);
166 BT_ERR("Can't allocate memory for new frame");
170 *skb_put(skb, 1) = HIDP_TRANS_DATA | HIDP_DATA_RTYPE_OUPUT;
171 *skb_put(skb, 1) = 0x01;
172 *skb_put(skb, 1) = newleds;
174 skb_queue_tail(&session->intr_transmit, skb);
176 hidp_schedule(session);
181 static int hidp_hidinput_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
183 struct hid_device *hid = input_get_drvdata(dev);
184 struct hidp_session *session = hid->driver_data;
186 return hidp_queue_event(session, dev, type, code, value);
189 static int hidp_input_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
191 struct hidp_session *session = input_get_drvdata(dev);
193 return hidp_queue_event(session, dev, type, code, value);
196 static void hidp_input_report(struct hidp_session *session, struct sk_buff *skb)
198 struct input_dev *dev = session->input;
199 unsigned char *keys = session->keys;
200 unsigned char *udata = skb->data + 1;
201 signed char *sdata = skb->data + 1;
202 int i, size = skb->len - 1;
204 switch (skb->data[0]) {
205 case 0x01: /* Keyboard report */
206 for (i = 0; i < 8; i++)
207 input_report_key(dev, hidp_keycode[i + 224], (udata[0] >> i) & 1);
209 /* If all the key codes have been set to 0x01, it means
210 * too many keys were pressed at the same time. */
211 if (!memcmp(udata + 2, hidp_mkeyspat, 6))
214 for (i = 2; i < 8; i++) {
215 if (keys[i] > 3 && memscan(udata + 2, keys[i], 6) == udata + 8) {
216 if (hidp_keycode[keys[i]])
217 input_report_key(dev, hidp_keycode[keys[i]], 0);
219 BT_ERR("Unknown key (scancode %#x) released.", keys[i]);
222 if (udata[i] > 3 && memscan(keys + 2, udata[i], 6) == keys + 8) {
223 if (hidp_keycode[udata[i]])
224 input_report_key(dev, hidp_keycode[udata[i]], 1);
226 BT_ERR("Unknown key (scancode %#x) pressed.", udata[i]);
230 memcpy(keys, udata, 8);
233 case 0x02: /* Mouse report */
234 input_report_key(dev, BTN_LEFT, sdata[0] & 0x01);
235 input_report_key(dev, BTN_RIGHT, sdata[0] & 0x02);
236 input_report_key(dev, BTN_MIDDLE, sdata[0] & 0x04);
237 input_report_key(dev, BTN_SIDE, sdata[0] & 0x08);
238 input_report_key(dev, BTN_EXTRA, sdata[0] & 0x10);
240 input_report_rel(dev, REL_X, sdata[1]);
241 input_report_rel(dev, REL_Y, sdata[2]);
244 input_report_rel(dev, REL_WHEEL, sdata[3]);
251 static int __hidp_send_ctrl_message(struct hidp_session *session,
252 unsigned char hdr, unsigned char *data, int size)
256 BT_DBG("session %p data %p size %d", session, data, size);
258 skb = alloc_skb(size + 1, GFP_ATOMIC);
260 BT_ERR("Can't allocate memory for new frame");
264 *skb_put(skb, 1) = hdr;
265 if (data && size > 0)
266 memcpy(skb_put(skb, size), data, size);
268 skb_queue_tail(&session->ctrl_transmit, skb);
273 static inline int hidp_send_ctrl_message(struct hidp_session *session,
274 unsigned char hdr, unsigned char *data, int size)
278 err = __hidp_send_ctrl_message(session, hdr, data, size);
280 hidp_schedule(session);
285 static int hidp_queue_report(struct hidp_session *session,
286 unsigned char *data, int size)
290 BT_DBG("session %p hid %p data %p size %d", session, session->hid, data, size);
292 skb = alloc_skb(size + 1, GFP_ATOMIC);
294 BT_ERR("Can't allocate memory for new frame");
298 *skb_put(skb, 1) = 0xa2;
300 memcpy(skb_put(skb, size), data, size);
302 skb_queue_tail(&session->intr_transmit, skb);
304 hidp_schedule(session);
309 static int hidp_send_report(struct hidp_session *session, struct hid_report *report)
311 unsigned char buf[32];
314 rsize = ((report->size - 1) >> 3) + 1 + (report->id > 0);
315 if (rsize > sizeof(buf))
318 hid_output_report(report, buf);
320 return hidp_queue_report(session, buf, rsize);
323 static int hidp_get_raw_report(struct hid_device *hid,
324 unsigned char report_number,
325 unsigned char *data, size_t count,
326 unsigned char report_type)
328 struct hidp_session *session = hid->driver_data;
331 int numbered_reports = hid->report_enum[report_type].numbered;
333 switch (report_type) {
334 case HID_FEATURE_REPORT:
335 report_type = HIDP_TRANS_GET_REPORT | HIDP_DATA_RTYPE_FEATURE;
337 case HID_INPUT_REPORT:
338 report_type = HIDP_TRANS_GET_REPORT | HIDP_DATA_RTYPE_INPUT;
340 case HID_OUTPUT_REPORT:
341 report_type = HIDP_TRANS_GET_REPORT | HIDP_DATA_RTYPE_OUPUT;
347 if (mutex_lock_interruptible(&session->report_mutex))
350 /* Set up our wait, and send the report request to the device. */
351 session->waiting_report_type = report_type & HIDP_DATA_RTYPE_MASK;
352 session->waiting_report_number = numbered_reports ? report_number : -1;
353 set_bit(HIDP_WAITING_FOR_RETURN, &session->flags);
354 data[0] = report_number;
355 if (hidp_send_ctrl_message(hid->driver_data, report_type, data, 1))
358 /* Wait for the return of the report. The returned report
359 gets put in session->report_return. */
360 while (test_bit(HIDP_WAITING_FOR_RETURN, &session->flags)) {
363 res = wait_event_interruptible_timeout(session->report_queue,
364 !test_bit(HIDP_WAITING_FOR_RETURN, &session->flags),
376 skb = session->report_return;
378 len = skb->len < count ? skb->len : count;
379 memcpy(data, skb->data, len);
382 session->report_return = NULL;
384 /* Device returned a HANDSHAKE, indicating protocol error. */
388 clear_bit(HIDP_WAITING_FOR_RETURN, &session->flags);
389 mutex_unlock(&session->report_mutex);
394 clear_bit(HIDP_WAITING_FOR_RETURN, &session->flags);
395 mutex_unlock(&session->report_mutex);
398 clear_bit(HIDP_WAITING_FOR_RETURN, &session->flags);
399 mutex_unlock(&session->report_mutex);
403 static int hidp_output_raw_report(struct hid_device *hid, unsigned char *data, size_t count,
404 unsigned char report_type)
406 struct hidp_session *session = hid->driver_data;
409 switch (report_type) {
410 case HID_FEATURE_REPORT:
411 report_type = HIDP_TRANS_SET_REPORT | HIDP_DATA_RTYPE_FEATURE;
413 case HID_OUTPUT_REPORT:
414 report_type = HIDP_TRANS_SET_REPORT | HIDP_DATA_RTYPE_OUPUT;
420 if (mutex_lock_interruptible(&session->report_mutex))
423 /* Set up our wait, and send the report request to the device. */
424 set_bit(HIDP_WAITING_FOR_SEND_ACK, &session->flags);
425 if (hidp_send_ctrl_message(hid->driver_data, report_type,
431 /* Wait for the ACK from the device. */
432 while (test_bit(HIDP_WAITING_FOR_SEND_ACK, &session->flags)) {
435 res = wait_event_interruptible_timeout(session->report_queue,
436 !test_bit(HIDP_WAITING_FOR_SEND_ACK, &session->flags),
450 if (!session->output_report_success) {
458 clear_bit(HIDP_WAITING_FOR_SEND_ACK, &session->flags);
459 mutex_unlock(&session->report_mutex);
463 static void hidp_idle_timeout(unsigned long arg)
465 struct hidp_session *session = (struct hidp_session *) arg;
467 atomic_inc(&session->terminate);
468 wake_up_process(session->task);
471 static void hidp_set_timer(struct hidp_session *session)
473 if (session->idle_to > 0)
474 mod_timer(&session->timer, jiffies + HZ * session->idle_to);
477 static inline void hidp_del_timer(struct hidp_session *session)
479 if (session->idle_to > 0)
480 del_timer(&session->timer);
483 static void hidp_process_handshake(struct hidp_session *session,
486 BT_DBG("session %p param 0x%02x", session, param);
487 session->output_report_success = 0; /* default condition */
490 case HIDP_HSHK_SUCCESSFUL:
491 /* FIXME: Call into SET_ GET_ handlers here */
492 session->output_report_success = 1;
495 case HIDP_HSHK_NOT_READY:
496 case HIDP_HSHK_ERR_INVALID_REPORT_ID:
497 case HIDP_HSHK_ERR_UNSUPPORTED_REQUEST:
498 case HIDP_HSHK_ERR_INVALID_PARAMETER:
499 if (test_bit(HIDP_WAITING_FOR_RETURN, &session->flags)) {
500 clear_bit(HIDP_WAITING_FOR_RETURN, &session->flags);
501 wake_up_interruptible(&session->report_queue);
503 /* FIXME: Call into SET_ GET_ handlers here */
506 case HIDP_HSHK_ERR_UNKNOWN:
509 case HIDP_HSHK_ERR_FATAL:
510 /* Device requests a reboot, as this is the only way this error
511 * can be recovered. */
512 __hidp_send_ctrl_message(session,
513 HIDP_TRANS_HID_CONTROL | HIDP_CTRL_SOFT_RESET, NULL, 0);
517 __hidp_send_ctrl_message(session,
518 HIDP_TRANS_HANDSHAKE | HIDP_HSHK_ERR_INVALID_PARAMETER, NULL, 0);
522 /* Wake up the waiting thread. */
523 if (test_bit(HIDP_WAITING_FOR_SEND_ACK, &session->flags)) {
524 clear_bit(HIDP_WAITING_FOR_SEND_ACK, &session->flags);
525 wake_up_interruptible(&session->report_queue);
529 static void hidp_process_hid_control(struct hidp_session *session,
532 BT_DBG("session %p param 0x%02x", session, param);
534 if (param == HIDP_CTRL_VIRTUAL_CABLE_UNPLUG) {
535 /* Flush the transmit queues */
536 skb_queue_purge(&session->ctrl_transmit);
537 skb_queue_purge(&session->intr_transmit);
539 atomic_inc(&session->terminate);
540 wake_up_process(current);
544 /* Returns true if the passed-in skb should be freed by the caller. */
545 static int hidp_process_data(struct hidp_session *session, struct sk_buff *skb,
548 int done_with_skb = 1;
549 BT_DBG("session %p skb %p len %d param 0x%02x", session, skb, skb->len, param);
552 case HIDP_DATA_RTYPE_INPUT:
553 hidp_set_timer(session);
556 hidp_input_report(session, skb);
559 hid_input_report(session->hid, HID_INPUT_REPORT, skb->data, skb->len, 0);
562 case HIDP_DATA_RTYPE_OTHER:
563 case HIDP_DATA_RTYPE_OUPUT:
564 case HIDP_DATA_RTYPE_FEATURE:
568 __hidp_send_ctrl_message(session,
569 HIDP_TRANS_HANDSHAKE | HIDP_HSHK_ERR_INVALID_PARAMETER, NULL, 0);
572 if (test_bit(HIDP_WAITING_FOR_RETURN, &session->flags) &&
573 param == session->waiting_report_type) {
574 if (session->waiting_report_number < 0 ||
575 session->waiting_report_number == skb->data[0]) {
576 /* hidp_get_raw_report() is waiting on this report. */
577 session->report_return = skb;
579 clear_bit(HIDP_WAITING_FOR_RETURN, &session->flags);
580 wake_up_interruptible(&session->report_queue);
584 return done_with_skb;
587 static void hidp_recv_ctrl_frame(struct hidp_session *session,
590 unsigned char hdr, type, param;
593 BT_DBG("session %p skb %p len %d", session, skb, skb->len);
598 type = hdr & HIDP_HEADER_TRANS_MASK;
599 param = hdr & HIDP_HEADER_PARAM_MASK;
602 case HIDP_TRANS_HANDSHAKE:
603 hidp_process_handshake(session, param);
606 case HIDP_TRANS_HID_CONTROL:
607 hidp_process_hid_control(session, param);
610 case HIDP_TRANS_DATA:
611 free_skb = hidp_process_data(session, skb, param);
615 __hidp_send_ctrl_message(session,
616 HIDP_TRANS_HANDSHAKE | HIDP_HSHK_ERR_UNSUPPORTED_REQUEST, NULL, 0);
624 static void hidp_recv_intr_frame(struct hidp_session *session,
629 BT_DBG("session %p skb %p len %d", session, skb, skb->len);
634 if (hdr == (HIDP_TRANS_DATA | HIDP_DATA_RTYPE_INPUT)) {
635 hidp_set_timer(session);
638 hidp_input_report(session, skb);
641 hid_input_report(session->hid, HID_INPUT_REPORT, skb->data, skb->len, 1);
642 BT_DBG("report len %d", skb->len);
645 BT_DBG("Unsupported protocol header 0x%02x", hdr);
651 static int hidp_send_frame(struct socket *sock, unsigned char *data, int len)
653 struct kvec iv = { data, len };
656 BT_DBG("sock %p data %p len %d", sock, data, len);
661 memset(&msg, 0, sizeof(msg));
663 return kernel_sendmsg(sock, &msg, &iv, 1, len);
666 static void hidp_process_transmit(struct hidp_session *session)
670 BT_DBG("session %p", session);
672 while ((skb = skb_dequeue(&session->ctrl_transmit))) {
673 if (hidp_send_frame(session->ctrl_sock, skb->data, skb->len) < 0) {
674 skb_queue_head(&session->ctrl_transmit, skb);
678 hidp_set_timer(session);
682 while ((skb = skb_dequeue(&session->intr_transmit))) {
683 if (hidp_send_frame(session->intr_sock, skb->data, skb->len) < 0) {
684 skb_queue_head(&session->intr_transmit, skb);
688 hidp_set_timer(session);
693 static int hidp_session(void *arg)
695 struct hidp_session *session = arg;
696 struct sock *ctrl_sk = session->ctrl_sock->sk;
697 struct sock *intr_sk = session->intr_sock->sk;
699 wait_queue_t ctrl_wait, intr_wait;
701 BT_DBG("session %p", session);
703 set_user_nice(current, -15);
705 init_waitqueue_entry(&ctrl_wait, current);
706 init_waitqueue_entry(&intr_wait, current);
707 add_wait_queue(sk_sleep(ctrl_sk), &ctrl_wait);
708 add_wait_queue(sk_sleep(intr_sk), &intr_wait);
709 session->waiting_for_startup = 0;
710 wake_up_interruptible(&session->startup_queue);
711 set_current_state(TASK_INTERRUPTIBLE);
712 while (!atomic_read(&session->terminate)) {
713 if (ctrl_sk->sk_state != BT_CONNECTED ||
714 intr_sk->sk_state != BT_CONNECTED)
717 while ((skb = skb_dequeue(&ctrl_sk->sk_receive_queue))) {
719 if (!skb_linearize(skb))
720 hidp_recv_ctrl_frame(session, skb);
725 while ((skb = skb_dequeue(&intr_sk->sk_receive_queue))) {
727 if (!skb_linearize(skb))
728 hidp_recv_intr_frame(session, skb);
733 hidp_process_transmit(session);
736 set_current_state(TASK_INTERRUPTIBLE);
738 set_current_state(TASK_RUNNING);
739 remove_wait_queue(sk_sleep(intr_sk), &intr_wait);
740 remove_wait_queue(sk_sleep(ctrl_sk), &ctrl_wait);
742 down_write(&hidp_session_sem);
744 hidp_del_timer(session);
746 if (session->input) {
747 input_unregister_device(session->input);
748 session->input = NULL;
752 hid_destroy_device(session->hid);
756 /* Wakeup user-space polling for socket errors */
757 session->intr_sock->sk->sk_err = EUNATCH;
758 session->ctrl_sock->sk->sk_err = EUNATCH;
760 hidp_schedule(session);
762 fput(session->intr_sock->file);
764 wait_event_timeout(*(sk_sleep(ctrl_sk)),
765 (ctrl_sk->sk_state == BT_CLOSED), msecs_to_jiffies(500));
767 fput(session->ctrl_sock->file);
769 __hidp_unlink_session(session);
771 up_write(&hidp_session_sem);
773 kfree(session->rd_data);
778 static struct device *hidp_get_device(struct hidp_session *session)
780 bdaddr_t *src = &bt_sk(session->ctrl_sock->sk)->src;
781 bdaddr_t *dst = &bt_sk(session->ctrl_sock->sk)->dst;
782 struct device *device = NULL;
783 struct hci_dev *hdev;
785 hdev = hci_get_route(dst, src);
789 session->conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, dst);
791 device = &session->conn->dev;
798 static int hidp_setup_input(struct hidp_session *session,
799 struct hidp_connadd_req *req)
801 struct input_dev *input;
804 input = input_allocate_device();
808 session->input = input;
810 input_set_drvdata(input, session);
812 input->name = "Bluetooth HID Boot Protocol Device";
814 input->id.bustype = BUS_BLUETOOTH;
815 input->id.vendor = req->vendor;
816 input->id.product = req->product;
817 input->id.version = req->version;
819 if (req->subclass & 0x40) {
820 set_bit(EV_KEY, input->evbit);
821 set_bit(EV_LED, input->evbit);
822 set_bit(EV_REP, input->evbit);
824 set_bit(LED_NUML, input->ledbit);
825 set_bit(LED_CAPSL, input->ledbit);
826 set_bit(LED_SCROLLL, input->ledbit);
827 set_bit(LED_COMPOSE, input->ledbit);
828 set_bit(LED_KANA, input->ledbit);
830 for (i = 0; i < sizeof(hidp_keycode); i++)
831 set_bit(hidp_keycode[i], input->keybit);
832 clear_bit(0, input->keybit);
835 if (req->subclass & 0x80) {
836 input->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REL);
837 input->keybit[BIT_WORD(BTN_MOUSE)] = BIT_MASK(BTN_LEFT) |
838 BIT_MASK(BTN_RIGHT) | BIT_MASK(BTN_MIDDLE);
839 input->relbit[0] = BIT_MASK(REL_X) | BIT_MASK(REL_Y);
840 input->keybit[BIT_WORD(BTN_MOUSE)] |= BIT_MASK(BTN_SIDE) |
842 input->relbit[0] |= BIT_MASK(REL_WHEEL);
845 input->dev.parent = hidp_get_device(session);
847 input->event = hidp_input_event;
849 err = input_register_device(input);
851 input_free_device(input);
852 session->input = NULL;
859 static int hidp_open(struct hid_device *hid)
864 static void hidp_close(struct hid_device *hid)
868 static int hidp_parse(struct hid_device *hid)
870 struct hidp_session *session = hid->driver_data;
872 return hid_parse_report(session->hid, session->rd_data,
876 static int hidp_start(struct hid_device *hid)
878 struct hidp_session *session = hid->driver_data;
879 struct hid_report *report;
881 if (hid->quirks & HID_QUIRK_NO_INIT_REPORTS)
884 list_for_each_entry(report, &hid->report_enum[HID_INPUT_REPORT].
886 hidp_send_report(session, report);
888 list_for_each_entry(report, &hid->report_enum[HID_FEATURE_REPORT].
890 hidp_send_report(session, report);
895 static void hidp_stop(struct hid_device *hid)
897 struct hidp_session *session = hid->driver_data;
899 skb_queue_purge(&session->ctrl_transmit);
900 skb_queue_purge(&session->intr_transmit);
905 static struct hid_ll_driver hidp_hid_driver = {
911 .hidinput_input_event = hidp_hidinput_event,
914 /* This function sets up the hid device. It does not add it
915 to the HID system. That is done in hidp_add_connection(). */
916 static int hidp_setup_hid(struct hidp_session *session,
917 struct hidp_connadd_req *req)
919 struct hid_device *hid;
922 session->rd_data = kzalloc(req->rd_size, GFP_KERNEL);
923 if (!session->rd_data)
926 if (copy_from_user(session->rd_data, req->rd_data, req->rd_size)) {
930 session->rd_size = req->rd_size;
932 hid = hid_allocate_device();
940 hid->driver_data = session;
942 hid->bus = BUS_BLUETOOTH;
943 hid->vendor = req->vendor;
944 hid->product = req->product;
945 hid->version = req->version;
946 hid->country = req->country;
948 strncpy(hid->name, req->name, sizeof(req->name) - 1);
949 strncpy(hid->phys, batostr(&bt_sk(session->ctrl_sock->sk)->src), 64);
950 strncpy(hid->uniq, batostr(&bt_sk(session->ctrl_sock->sk)->dst), 64);
952 hid->dev.parent = hidp_get_device(session);
953 hid->ll_driver = &hidp_hid_driver;
955 hid->hid_get_raw_report = hidp_get_raw_report;
956 hid->hid_output_raw_report = hidp_output_raw_report;
961 kfree(session->rd_data);
962 session->rd_data = NULL;
967 int hidp_add_connection(struct hidp_connadd_req *req, struct socket *ctrl_sock, struct socket *intr_sock)
969 struct hidp_session *session, *s;
975 if (!l2cap_is_socket(ctrl_sock) || !l2cap_is_socket(intr_sock))
977 if (bacmp(&bt_sk(ctrl_sock->sk)->src, &bt_sk(intr_sock->sk)->src) ||
978 bacmp(&bt_sk(ctrl_sock->sk)->dst, &bt_sk(intr_sock->sk)->dst))
981 session = kzalloc(sizeof(struct hidp_session), GFP_KERNEL);
985 BT_DBG("rd_data %p rd_size %d", req->rd_data, req->rd_size);
987 down_write(&hidp_session_sem);
989 s = __hidp_get_session(&bt_sk(ctrl_sock->sk)->dst);
990 if (s && s->state == BT_CONNECTED) {
995 bacpy(&session->bdaddr, &bt_sk(ctrl_sock->sk)->dst);
997 session->ctrl_mtu = min_t(uint, l2cap_pi(ctrl_sock->sk)->chan->omtu,
998 l2cap_pi(ctrl_sock->sk)->chan->imtu);
999 session->intr_mtu = min_t(uint, l2cap_pi(intr_sock->sk)->chan->omtu,
1000 l2cap_pi(intr_sock->sk)->chan->imtu);
1002 BT_DBG("ctrl mtu %d intr mtu %d", session->ctrl_mtu, session->intr_mtu);
1004 session->ctrl_sock = ctrl_sock;
1005 session->intr_sock = intr_sock;
1006 session->state = BT_CONNECTED;
1008 setup_timer(&session->timer, hidp_idle_timeout, (unsigned long)session);
1010 skb_queue_head_init(&session->ctrl_transmit);
1011 skb_queue_head_init(&session->intr_transmit);
1013 mutex_init(&session->report_mutex);
1014 init_waitqueue_head(&session->report_queue);
1015 init_waitqueue_head(&session->startup_queue);
1016 session->waiting_for_startup = 1;
1017 session->flags = req->flags & (1 << HIDP_BLUETOOTH_VENDOR_ID);
1018 session->idle_to = req->idle_to;
1020 if (req->rd_size > 0) {
1021 err = hidp_setup_hid(session, req);
1022 if (err && err != -ENODEV)
1026 if (!session->hid) {
1027 err = hidp_setup_input(session, req);
1032 __hidp_link_session(session);
1034 hidp_set_timer(session);
1037 vendor = session->hid->vendor;
1038 product = session->hid->product;
1039 } else if (session->input) {
1040 vendor = session->input->id.vendor;
1041 product = session->input->id.product;
1047 session->task = kthread_run(hidp_session, session, "khidpd_%04x%04x",
1049 if (IS_ERR(session->task)) {
1050 err = PTR_ERR(session->task);
1054 while (session->waiting_for_startup) {
1055 wait_event_interruptible(session->startup_queue,
1056 !session->waiting_for_startup);
1059 err = hid_add_device(session->hid);
1061 atomic_inc(&session->terminate);
1062 wake_up_process(session->task);
1063 up_write(&hidp_session_sem);
1067 if (session->input) {
1068 hidp_send_ctrl_message(session,
1069 HIDP_TRANS_SET_PROTOCOL | HIDP_PROTO_BOOT, NULL, 0);
1070 session->flags |= (1 << HIDP_BOOT_PROTOCOL_MODE);
1072 session->leds = 0xff;
1073 hidp_input_event(session->input, EV_LED, 0, 0);
1076 up_write(&hidp_session_sem);
1080 hidp_del_timer(session);
1082 __hidp_unlink_session(session);
1084 if (session->input) {
1085 input_unregister_device(session->input);
1086 session->input = NULL;
1090 hid_destroy_device(session->hid);
1091 session->hid = NULL;
1094 kfree(session->rd_data);
1095 session->rd_data = NULL;
1098 skb_queue_purge(&session->ctrl_transmit);
1099 skb_queue_purge(&session->intr_transmit);
1102 up_write(&hidp_session_sem);
1108 int hidp_del_connection(struct hidp_conndel_req *req)
1110 struct hidp_session *session;
1115 down_read(&hidp_session_sem);
1117 session = __hidp_get_session(&req->bdaddr);
1119 if (req->flags & (1 << HIDP_VIRTUAL_CABLE_UNPLUG)) {
1120 hidp_send_ctrl_message(session,
1121 HIDP_TRANS_HID_CONTROL | HIDP_CTRL_VIRTUAL_CABLE_UNPLUG, NULL, 0);
1123 /* Flush the transmit queues */
1124 skb_queue_purge(&session->ctrl_transmit);
1125 skb_queue_purge(&session->intr_transmit);
1127 atomic_inc(&session->terminate);
1128 wake_up_process(session->task);
1133 up_read(&hidp_session_sem);
1137 int hidp_get_connlist(struct hidp_connlist_req *req)
1139 struct list_head *p;
1144 down_read(&hidp_session_sem);
1146 list_for_each(p, &hidp_session_list) {
1147 struct hidp_session *session;
1148 struct hidp_conninfo ci;
1150 session = list_entry(p, struct hidp_session, list);
1152 __hidp_copy_session(session, &ci);
1154 if (copy_to_user(req->ci, &ci, sizeof(ci))) {
1159 if (++n >= req->cnum)
1166 up_read(&hidp_session_sem);
1170 int hidp_get_conninfo(struct hidp_conninfo *ci)
1172 struct hidp_session *session;
1175 down_read(&hidp_session_sem);
1177 session = __hidp_get_session(&ci->bdaddr);
1179 __hidp_copy_session(session, ci);
1183 up_read(&hidp_session_sem);
1187 static const struct hid_device_id hidp_table[] = {
1188 { HID_BLUETOOTH_DEVICE(HID_ANY_ID, HID_ANY_ID) },
1192 static struct hid_driver hidp_driver = {
1193 .name = "generic-bluetooth",
1194 .id_table = hidp_table,
1197 static int __init hidp_init(void)
1201 BT_INFO("HIDP (Human Interface Emulation) ver %s", VERSION);
1203 ret = hid_register_driver(&hidp_driver);
1207 ret = hidp_init_sockets();
1213 hid_unregister_driver(&hidp_driver);
1218 static void __exit hidp_exit(void)
1220 hidp_cleanup_sockets();
1221 hid_unregister_driver(&hidp_driver);
1224 module_init(hidp_init);
1225 module_exit(hidp_exit);
1227 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
1228 MODULE_DESCRIPTION("Bluetooth HIDP ver " VERSION);
1229 MODULE_VERSION(VERSION);
1230 MODULE_LICENSE("GPL");
1231 MODULE_ALIAS("bt-proto-6");