bpa10x.c 8.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. *
  4. * Digianswer Bluetooth USB driver
  5. *
  6. * Copyright (C) 2004-2007 Marcel Holtmann <marcel@holtmann.org>
  7. */
  8. #include <linux/kernel.h>
  9. #include <linux/module.h>
  10. #include <linux/init.h>
  11. #include <linux/slab.h>
  12. #include <linux/types.h>
  13. #include <linux/sched.h>
  14. #include <linux/errno.h>
  15. #include <linux/skbuff.h>
  16. #include <linux/usb.h>
  17. #include <net/bluetooth/bluetooth.h>
  18. #include <net/bluetooth/hci_core.h>
  19. #include "h4_recv.h"
  20. #define VERSION "0.11"
  21. static const struct usb_device_id bpa10x_table[] = {
  22. /* Tektronix BPA 100/105 (Digianswer) */
  23. { USB_DEVICE(0x08fd, 0x0002) },
  24. { } /* Terminating entry */
  25. };
  26. MODULE_DEVICE_TABLE(usb, bpa10x_table);
  27. struct bpa10x_data {
  28. struct hci_dev *hdev;
  29. struct usb_device *udev;
  30. struct usb_anchor tx_anchor;
  31. struct usb_anchor rx_anchor;
  32. struct sk_buff *rx_skb[2];
  33. };
  34. static void bpa10x_tx_complete(struct urb *urb)
  35. {
  36. struct sk_buff *skb = urb->context;
  37. struct hci_dev *hdev = (struct hci_dev *) skb->dev;
  38. BT_DBG("%s urb %p status %d count %d", hdev->name,
  39. urb, urb->status, urb->actual_length);
  40. if (!test_bit(HCI_RUNNING, &hdev->flags))
  41. goto done;
  42. if (!urb->status)
  43. hdev->stat.byte_tx += urb->transfer_buffer_length;
  44. else
  45. hdev->stat.err_tx++;
  46. done:
  47. kfree(urb->setup_packet);
  48. kfree_skb(skb);
  49. }
  50. #define HCI_VENDOR_HDR_SIZE 5
  51. #define HCI_RECV_VENDOR \
  52. .type = HCI_VENDOR_PKT, \
  53. .hlen = HCI_VENDOR_HDR_SIZE, \
  54. .loff = 3, \
  55. .lsize = 2, \
  56. .maxlen = HCI_MAX_FRAME_SIZE
  57. static const struct h4_recv_pkt bpa10x_recv_pkts[] = {
  58. { H4_RECV_ACL, .recv = hci_recv_frame },
  59. { H4_RECV_SCO, .recv = hci_recv_frame },
  60. { H4_RECV_EVENT, .recv = hci_recv_frame },
  61. { HCI_RECV_VENDOR, .recv = hci_recv_diag },
  62. };
  63. static void bpa10x_rx_complete(struct urb *urb)
  64. {
  65. struct hci_dev *hdev = urb->context;
  66. struct bpa10x_data *data = hci_get_drvdata(hdev);
  67. int err;
  68. BT_DBG("%s urb %p status %d count %d", hdev->name,
  69. urb, urb->status, urb->actual_length);
  70. if (!test_bit(HCI_RUNNING, &hdev->flags))
  71. return;
  72. if (urb->status == 0) {
  73. bool idx = usb_pipebulk(urb->pipe);
  74. data->rx_skb[idx] = h4_recv_buf(hdev, data->rx_skb[idx],
  75. urb->transfer_buffer,
  76. urb->actual_length,
  77. bpa10x_recv_pkts,
  78. ARRAY_SIZE(bpa10x_recv_pkts));
  79. if (IS_ERR(data->rx_skb[idx])) {
  80. bt_dev_err(hdev, "corrupted event packet");
  81. hdev->stat.err_rx++;
  82. data->rx_skb[idx] = NULL;
  83. }
  84. }
  85. usb_anchor_urb(urb, &data->rx_anchor);
  86. err = usb_submit_urb(urb, GFP_ATOMIC);
  87. if (err < 0) {
  88. bt_dev_err(hdev, "urb %p failed to resubmit (%d)", urb, -err);
  89. usb_unanchor_urb(urb);
  90. }
  91. }
  92. static inline int bpa10x_submit_intr_urb(struct hci_dev *hdev)
  93. {
  94. struct bpa10x_data *data = hci_get_drvdata(hdev);
  95. struct urb *urb;
  96. unsigned char *buf;
  97. unsigned int pipe;
  98. int err, size = 16;
  99. BT_DBG("%s", hdev->name);
  100. urb = usb_alloc_urb(0, GFP_KERNEL);
  101. if (!urb)
  102. return -ENOMEM;
  103. buf = kmalloc(size, GFP_KERNEL);
  104. if (!buf) {
  105. usb_free_urb(urb);
  106. return -ENOMEM;
  107. }
  108. pipe = usb_rcvintpipe(data->udev, 0x81);
  109. usb_fill_int_urb(urb, data->udev, pipe, buf, size,
  110. bpa10x_rx_complete, hdev, 1);
  111. urb->transfer_flags |= URB_FREE_BUFFER;
  112. usb_anchor_urb(urb, &data->rx_anchor);
  113. err = usb_submit_urb(urb, GFP_KERNEL);
  114. if (err < 0) {
  115. bt_dev_err(hdev, "urb %p submission failed (%d)", urb, -err);
  116. usb_unanchor_urb(urb);
  117. }
  118. usb_free_urb(urb);
  119. return err;
  120. }
  121. static inline int bpa10x_submit_bulk_urb(struct hci_dev *hdev)
  122. {
  123. struct bpa10x_data *data = hci_get_drvdata(hdev);
  124. struct urb *urb;
  125. unsigned char *buf;
  126. unsigned int pipe;
  127. int err, size = 64;
  128. BT_DBG("%s", hdev->name);
  129. urb = usb_alloc_urb(0, GFP_KERNEL);
  130. if (!urb)
  131. return -ENOMEM;
  132. buf = kmalloc(size, GFP_KERNEL);
  133. if (!buf) {
  134. usb_free_urb(urb);
  135. return -ENOMEM;
  136. }
  137. pipe = usb_rcvbulkpipe(data->udev, 0x82);
  138. usb_fill_bulk_urb(urb, data->udev, pipe,
  139. buf, size, bpa10x_rx_complete, hdev);
  140. urb->transfer_flags |= URB_FREE_BUFFER;
  141. usb_anchor_urb(urb, &data->rx_anchor);
  142. err = usb_submit_urb(urb, GFP_KERNEL);
  143. if (err < 0) {
  144. bt_dev_err(hdev, "urb %p submission failed (%d)", urb, -err);
  145. usb_unanchor_urb(urb);
  146. }
  147. usb_free_urb(urb);
  148. return err;
  149. }
  150. static int bpa10x_open(struct hci_dev *hdev)
  151. {
  152. struct bpa10x_data *data = hci_get_drvdata(hdev);
  153. int err;
  154. BT_DBG("%s", hdev->name);
  155. err = bpa10x_submit_intr_urb(hdev);
  156. if (err < 0)
  157. goto error;
  158. err = bpa10x_submit_bulk_urb(hdev);
  159. if (err < 0)
  160. goto error;
  161. return 0;
  162. error:
  163. usb_kill_anchored_urbs(&data->rx_anchor);
  164. return err;
  165. }
  166. static int bpa10x_close(struct hci_dev *hdev)
  167. {
  168. struct bpa10x_data *data = hci_get_drvdata(hdev);
  169. BT_DBG("%s", hdev->name);
  170. usb_kill_anchored_urbs(&data->rx_anchor);
  171. return 0;
  172. }
  173. static int bpa10x_flush(struct hci_dev *hdev)
  174. {
  175. struct bpa10x_data *data = hci_get_drvdata(hdev);
  176. BT_DBG("%s", hdev->name);
  177. usb_kill_anchored_urbs(&data->tx_anchor);
  178. return 0;
  179. }
  180. static int bpa10x_setup(struct hci_dev *hdev)
  181. {
  182. static const u8 req[] = { 0x07 };
  183. struct sk_buff *skb;
  184. BT_DBG("%s", hdev->name);
  185. /* Read revision string */
  186. skb = __hci_cmd_sync(hdev, 0xfc0e, sizeof(req), req, HCI_INIT_TIMEOUT);
  187. if (IS_ERR(skb))
  188. return PTR_ERR(skb);
  189. bt_dev_info(hdev, "%s", (char *)(skb->data + 1));
  190. hci_set_fw_info(hdev, "%s", skb->data + 1);
  191. kfree_skb(skb);
  192. return 0;
  193. }
  194. static int bpa10x_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
  195. {
  196. struct bpa10x_data *data = hci_get_drvdata(hdev);
  197. struct usb_ctrlrequest *dr;
  198. struct urb *urb;
  199. unsigned int pipe;
  200. int err;
  201. BT_DBG("%s", hdev->name);
  202. skb->dev = (void *) hdev;
  203. urb = usb_alloc_urb(0, GFP_KERNEL);
  204. if (!urb)
  205. return -ENOMEM;
  206. /* Prepend skb with frame type */
  207. *(u8 *)skb_push(skb, 1) = hci_skb_pkt_type(skb);
  208. switch (hci_skb_pkt_type(skb)) {
  209. case HCI_COMMAND_PKT:
  210. dr = kmalloc(sizeof(*dr), GFP_KERNEL);
  211. if (!dr) {
  212. usb_free_urb(urb);
  213. return -ENOMEM;
  214. }
  215. dr->bRequestType = USB_TYPE_VENDOR;
  216. dr->bRequest = 0;
  217. dr->wIndex = 0;
  218. dr->wValue = 0;
  219. dr->wLength = __cpu_to_le16(skb->len);
  220. pipe = usb_sndctrlpipe(data->udev, 0x00);
  221. usb_fill_control_urb(urb, data->udev, pipe, (void *) dr,
  222. skb->data, skb->len, bpa10x_tx_complete, skb);
  223. hdev->stat.cmd_tx++;
  224. break;
  225. case HCI_ACLDATA_PKT:
  226. pipe = usb_sndbulkpipe(data->udev, 0x02);
  227. usb_fill_bulk_urb(urb, data->udev, pipe,
  228. skb->data, skb->len, bpa10x_tx_complete, skb);
  229. hdev->stat.acl_tx++;
  230. break;
  231. case HCI_SCODATA_PKT:
  232. pipe = usb_sndbulkpipe(data->udev, 0x02);
  233. usb_fill_bulk_urb(urb, data->udev, pipe,
  234. skb->data, skb->len, bpa10x_tx_complete, skb);
  235. hdev->stat.sco_tx++;
  236. break;
  237. default:
  238. usb_free_urb(urb);
  239. return -EILSEQ;
  240. }
  241. usb_anchor_urb(urb, &data->tx_anchor);
  242. err = usb_submit_urb(urb, GFP_KERNEL);
  243. if (err < 0) {
  244. bt_dev_err(hdev, "urb %p submission failed", urb);
  245. kfree(urb->setup_packet);
  246. usb_unanchor_urb(urb);
  247. }
  248. usb_free_urb(urb);
  249. return err;
  250. }
  251. static int bpa10x_set_diag(struct hci_dev *hdev, bool enable)
  252. {
  253. const u8 req[] = { 0x00, enable };
  254. struct sk_buff *skb;
  255. BT_DBG("%s", hdev->name);
  256. if (!test_bit(HCI_RUNNING, &hdev->flags))
  257. return -ENETDOWN;
  258. /* Enable sniffer operation */
  259. skb = __hci_cmd_sync(hdev, 0xfc0e, sizeof(req), req, HCI_INIT_TIMEOUT);
  260. if (IS_ERR(skb))
  261. return PTR_ERR(skb);
  262. kfree_skb(skb);
  263. return 0;
  264. }
  265. static int bpa10x_probe(struct usb_interface *intf,
  266. const struct usb_device_id *id)
  267. {
  268. struct bpa10x_data *data;
  269. struct hci_dev *hdev;
  270. int err;
  271. BT_DBG("intf %p id %p", intf, id);
  272. if (intf->cur_altsetting->desc.bInterfaceNumber != 0)
  273. return -ENODEV;
  274. data = devm_kzalloc(&intf->dev, sizeof(*data), GFP_KERNEL);
  275. if (!data)
  276. return -ENOMEM;
  277. data->udev = interface_to_usbdev(intf);
  278. init_usb_anchor(&data->tx_anchor);
  279. init_usb_anchor(&data->rx_anchor);
  280. hdev = hci_alloc_dev();
  281. if (!hdev)
  282. return -ENOMEM;
  283. hdev->bus = HCI_USB;
  284. hci_set_drvdata(hdev, data);
  285. data->hdev = hdev;
  286. SET_HCIDEV_DEV(hdev, &intf->dev);
  287. hdev->open = bpa10x_open;
  288. hdev->close = bpa10x_close;
  289. hdev->flush = bpa10x_flush;
  290. hdev->setup = bpa10x_setup;
  291. hdev->send = bpa10x_send_frame;
  292. hdev->set_diag = bpa10x_set_diag;
  293. set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
  294. err = hci_register_dev(hdev);
  295. if (err < 0) {
  296. hci_free_dev(hdev);
  297. return err;
  298. }
  299. usb_set_intfdata(intf, data);
  300. return 0;
  301. }
  302. static void bpa10x_disconnect(struct usb_interface *intf)
  303. {
  304. struct bpa10x_data *data = usb_get_intfdata(intf);
  305. BT_DBG("intf %p", intf);
  306. if (!data)
  307. return;
  308. usb_set_intfdata(intf, NULL);
  309. hci_unregister_dev(data->hdev);
  310. hci_free_dev(data->hdev);
  311. kfree_skb(data->rx_skb[0]);
  312. kfree_skb(data->rx_skb[1]);
  313. }
  314. static struct usb_driver bpa10x_driver = {
  315. .name = "bpa10x",
  316. .probe = bpa10x_probe,
  317. .disconnect = bpa10x_disconnect,
  318. .id_table = bpa10x_table,
  319. .disable_hub_initiated_lpm = 1,
  320. };
  321. module_usb_driver(bpa10x_driver);
  322. MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
  323. MODULE_DESCRIPTION("Digianswer Bluetooth USB driver ver " VERSION);
  324. MODULE_VERSION(VERSION);
  325. MODULE_LICENSE("GPL");