btsdio.c 7.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. *
  4. * Generic Bluetooth SDIO driver
  5. *
  6. * Copyright (C) 2007 Cambridge Silicon Radio Ltd.
  7. * Copyright (C) 2007 Marcel Holtmann <marcel@holtmann.org>
  8. */
  9. #include <linux/kernel.h>
  10. #include <linux/module.h>
  11. #include <linux/init.h>
  12. #include <linux/slab.h>
  13. #include <linux/types.h>
  14. #include <linux/sched.h>
  15. #include <linux/errno.h>
  16. #include <linux/skbuff.h>
  17. #include <linux/mmc/host.h>
  18. #include <linux/mmc/sdio_ids.h>
  19. #include <linux/mmc/sdio_func.h>
  20. #include <net/bluetooth/bluetooth.h>
  21. #include <net/bluetooth/hci_core.h>
  22. #define VERSION "0.1"
  23. static const struct sdio_device_id btsdio_table[] = {
  24. /* Generic Bluetooth Type-A SDIO device */
  25. { SDIO_DEVICE_CLASS(SDIO_CLASS_BT_A) },
  26. /* Generic Bluetooth Type-B SDIO device */
  27. { SDIO_DEVICE_CLASS(SDIO_CLASS_BT_B) },
  28. /* Generic Bluetooth AMP controller */
  29. { SDIO_DEVICE_CLASS(SDIO_CLASS_BT_AMP) },
  30. { } /* Terminating entry */
  31. };
  32. MODULE_DEVICE_TABLE(sdio, btsdio_table);
  33. struct btsdio_data {
  34. struct hci_dev *hdev;
  35. struct sdio_func *func;
  36. struct work_struct work;
  37. struct sk_buff_head txq;
  38. };
  39. #define REG_RDAT 0x00 /* Receiver Data */
  40. #define REG_TDAT 0x00 /* Transmitter Data */
  41. #define REG_PC_RRT 0x10 /* Read Packet Control */
  42. #define REG_PC_WRT 0x11 /* Write Packet Control */
  43. #define REG_RTC_STAT 0x12 /* Retry Control Status */
  44. #define REG_RTC_SET 0x12 /* Retry Control Set */
  45. #define REG_INTRD 0x13 /* Interrupt Indication */
  46. #define REG_CL_INTRD 0x13 /* Interrupt Clear */
  47. #define REG_EN_INTRD 0x14 /* Interrupt Enable */
  48. #define REG_MD_STAT 0x20 /* Bluetooth Mode Status */
  49. #define REG_MD_SET 0x20 /* Bluetooth Mode Set */
  50. static int btsdio_tx_packet(struct btsdio_data *data, struct sk_buff *skb)
  51. {
  52. int err;
  53. BT_DBG("%s", data->hdev->name);
  54. /* Prepend Type-A header */
  55. skb_push(skb, 4);
  56. skb->data[0] = (skb->len & 0x0000ff);
  57. skb->data[1] = (skb->len & 0x00ff00) >> 8;
  58. skb->data[2] = (skb->len & 0xff0000) >> 16;
  59. skb->data[3] = hci_skb_pkt_type(skb);
  60. err = sdio_writesb(data->func, REG_TDAT, skb->data, skb->len);
  61. if (err < 0) {
  62. skb_pull(skb, 4);
  63. sdio_writeb(data->func, 0x01, REG_PC_WRT, NULL);
  64. return err;
  65. }
  66. data->hdev->stat.byte_tx += skb->len;
  67. kfree_skb(skb);
  68. return 0;
  69. }
  70. static void btsdio_work(struct work_struct *work)
  71. {
  72. struct btsdio_data *data = container_of(work, struct btsdio_data, work);
  73. struct sk_buff *skb;
  74. int err;
  75. BT_DBG("%s", data->hdev->name);
  76. sdio_claim_host(data->func);
  77. while ((skb = skb_dequeue(&data->txq))) {
  78. err = btsdio_tx_packet(data, skb);
  79. if (err < 0) {
  80. data->hdev->stat.err_tx++;
  81. skb_queue_head(&data->txq, skb);
  82. break;
  83. }
  84. }
  85. sdio_release_host(data->func);
  86. }
  87. static int btsdio_rx_packet(struct btsdio_data *data)
  88. {
  89. u8 hdr[4] __attribute__ ((aligned(4)));
  90. struct sk_buff *skb;
  91. int err, len;
  92. BT_DBG("%s", data->hdev->name);
  93. err = sdio_readsb(data->func, hdr, REG_RDAT, 4);
  94. if (err < 0)
  95. return err;
  96. len = hdr[0] | (hdr[1] << 8) | (hdr[2] << 16);
  97. if (len < 4 || len > 65543)
  98. return -EILSEQ;
  99. skb = bt_skb_alloc(len - 4, GFP_KERNEL);
  100. if (!skb) {
  101. /* Out of memory. Prepare a read retry and just
  102. * return with the expectation that the next time
  103. * we're called we'll have more memory.
  104. */
  105. return -ENOMEM;
  106. }
  107. skb_put(skb, len - 4);
  108. err = sdio_readsb(data->func, skb->data, REG_RDAT, len - 4);
  109. if (err < 0) {
  110. kfree_skb(skb);
  111. return err;
  112. }
  113. data->hdev->stat.byte_rx += len;
  114. switch (hdr[3]) {
  115. case HCI_EVENT_PKT:
  116. case HCI_ACLDATA_PKT:
  117. case HCI_SCODATA_PKT:
  118. case HCI_ISODATA_PKT:
  119. hci_skb_pkt_type(skb) = hdr[3];
  120. err = hci_recv_frame(data->hdev, skb);
  121. if (err < 0)
  122. return err;
  123. break;
  124. default:
  125. kfree_skb(skb);
  126. return -EINVAL;
  127. }
  128. sdio_writeb(data->func, 0x00, REG_PC_RRT, NULL);
  129. return 0;
  130. }
  131. static void btsdio_interrupt(struct sdio_func *func)
  132. {
  133. struct btsdio_data *data = sdio_get_drvdata(func);
  134. int intrd;
  135. BT_DBG("%s", data->hdev->name);
  136. intrd = sdio_readb(func, REG_INTRD, NULL);
  137. if (intrd & 0x01) {
  138. sdio_writeb(func, 0x01, REG_CL_INTRD, NULL);
  139. if (btsdio_rx_packet(data) < 0) {
  140. data->hdev->stat.err_rx++;
  141. sdio_writeb(data->func, 0x01, REG_PC_RRT, NULL);
  142. }
  143. }
  144. }
  145. static int btsdio_open(struct hci_dev *hdev)
  146. {
  147. struct btsdio_data *data = hci_get_drvdata(hdev);
  148. int err;
  149. BT_DBG("%s", hdev->name);
  150. sdio_claim_host(data->func);
  151. err = sdio_enable_func(data->func);
  152. if (err < 0)
  153. goto release;
  154. err = sdio_claim_irq(data->func, btsdio_interrupt);
  155. if (err < 0) {
  156. sdio_disable_func(data->func);
  157. goto release;
  158. }
  159. if (data->func->class == SDIO_CLASS_BT_B)
  160. sdio_writeb(data->func, 0x00, REG_MD_SET, NULL);
  161. sdio_writeb(data->func, 0x01, REG_EN_INTRD, NULL);
  162. release:
  163. sdio_release_host(data->func);
  164. return err;
  165. }
  166. static int btsdio_close(struct hci_dev *hdev)
  167. {
  168. struct btsdio_data *data = hci_get_drvdata(hdev);
  169. BT_DBG("%s", hdev->name);
  170. sdio_claim_host(data->func);
  171. sdio_writeb(data->func, 0x00, REG_EN_INTRD, NULL);
  172. sdio_release_irq(data->func);
  173. sdio_disable_func(data->func);
  174. sdio_release_host(data->func);
  175. return 0;
  176. }
  177. static int btsdio_flush(struct hci_dev *hdev)
  178. {
  179. struct btsdio_data *data = hci_get_drvdata(hdev);
  180. BT_DBG("%s", hdev->name);
  181. skb_queue_purge(&data->txq);
  182. return 0;
  183. }
  184. static int btsdio_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
  185. {
  186. struct btsdio_data *data = hci_get_drvdata(hdev);
  187. BT_DBG("%s", hdev->name);
  188. switch (hci_skb_pkt_type(skb)) {
  189. case HCI_COMMAND_PKT:
  190. hdev->stat.cmd_tx++;
  191. break;
  192. case HCI_ACLDATA_PKT:
  193. hdev->stat.acl_tx++;
  194. break;
  195. case HCI_SCODATA_PKT:
  196. hdev->stat.sco_tx++;
  197. break;
  198. default:
  199. return -EILSEQ;
  200. }
  201. skb_queue_tail(&data->txq, skb);
  202. schedule_work(&data->work);
  203. return 0;
  204. }
  205. static int btsdio_probe(struct sdio_func *func,
  206. const struct sdio_device_id *id)
  207. {
  208. struct btsdio_data *data;
  209. struct hci_dev *hdev;
  210. struct sdio_func_tuple *tuple = func->tuples;
  211. int err;
  212. BT_DBG("func %p id %p class 0x%04x", func, id, func->class);
  213. while (tuple) {
  214. BT_DBG("code 0x%x size %d", tuple->code, tuple->size);
  215. tuple = tuple->next;
  216. }
  217. /* Broadcom devices soldered onto the PCB (non-removable) use an
  218. * UART connection for Bluetooth, ignore the BT SDIO interface.
  219. */
  220. if (func->vendor == SDIO_VENDOR_ID_BROADCOM &&
  221. !mmc_card_is_removable(func->card->host)) {
  222. switch (func->device) {
  223. case SDIO_DEVICE_ID_BROADCOM_43341:
  224. case SDIO_DEVICE_ID_BROADCOM_43430:
  225. case SDIO_DEVICE_ID_BROADCOM_4356:
  226. return -ENODEV;
  227. }
  228. }
  229. data = devm_kzalloc(&func->dev, sizeof(*data), GFP_KERNEL);
  230. if (!data)
  231. return -ENOMEM;
  232. data->func = func;
  233. INIT_WORK(&data->work, btsdio_work);
  234. skb_queue_head_init(&data->txq);
  235. hdev = hci_alloc_dev();
  236. if (!hdev)
  237. return -ENOMEM;
  238. hdev->bus = HCI_SDIO;
  239. hci_set_drvdata(hdev, data);
  240. if (id->class == SDIO_CLASS_BT_AMP)
  241. hdev->dev_type = HCI_AMP;
  242. else
  243. hdev->dev_type = HCI_PRIMARY;
  244. data->hdev = hdev;
  245. SET_HCIDEV_DEV(hdev, &func->dev);
  246. hdev->open = btsdio_open;
  247. hdev->close = btsdio_close;
  248. hdev->flush = btsdio_flush;
  249. hdev->send = btsdio_send_frame;
  250. if (func->vendor == 0x0104 && func->device == 0x00c5)
  251. set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
  252. err = hci_register_dev(hdev);
  253. if (err < 0) {
  254. hci_free_dev(hdev);
  255. return err;
  256. }
  257. sdio_set_drvdata(func, data);
  258. return 0;
  259. }
  260. static void btsdio_remove(struct sdio_func *func)
  261. {
  262. struct btsdio_data *data = sdio_get_drvdata(func);
  263. struct hci_dev *hdev;
  264. BT_DBG("func %p", func);
  265. if (!data)
  266. return;
  267. hdev = data->hdev;
  268. sdio_set_drvdata(func, NULL);
  269. hci_unregister_dev(hdev);
  270. hci_free_dev(hdev);
  271. }
  272. static struct sdio_driver btsdio_driver = {
  273. .name = "btsdio",
  274. .probe = btsdio_probe,
  275. .remove = btsdio_remove,
  276. .id_table = btsdio_table,
  277. };
  278. module_sdio_driver(btsdio_driver);
  279. MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
  280. MODULE_DESCRIPTION("Generic Bluetooth SDIO driver ver " VERSION);
  281. MODULE_VERSION(VERSION);
  282. MODULE_LICENSE("GPL");