btmrvl_main.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Marvell Bluetooth driver
  4. *
  5. * Copyright (C) 2009, Marvell International Ltd.
  6. **/
  7. #include <linux/module.h>
  8. #include <linux/of.h>
  9. #include <net/bluetooth/bluetooth.h>
  10. #include <net/bluetooth/hci_core.h>
  11. #include <linux/mmc/sdio_func.h>
  12. #include "btmrvl_drv.h"
  13. #include "btmrvl_sdio.h"
  14. #define VERSION "1.0"
  15. /*
  16. * This function is called by interface specific interrupt handler.
  17. * It updates Power Save & Host Sleep states, and wakes up the main
  18. * thread.
  19. */
  20. void btmrvl_interrupt(struct btmrvl_private *priv)
  21. {
  22. priv->adapter->ps_state = PS_AWAKE;
  23. priv->adapter->wakeup_tries = 0;
  24. priv->adapter->int_count++;
  25. if (priv->adapter->hs_state == HS_ACTIVATED) {
  26. BT_DBG("BT: HS DEACTIVATED in ISR!");
  27. priv->adapter->hs_state = HS_DEACTIVATED;
  28. }
  29. wake_up_interruptible(&priv->main_thread.wait_q);
  30. }
  31. EXPORT_SYMBOL_GPL(btmrvl_interrupt);
  32. bool btmrvl_check_evtpkt(struct btmrvl_private *priv, struct sk_buff *skb)
  33. {
  34. struct hci_event_hdr *hdr = (void *) skb->data;
  35. if (hdr->evt == HCI_EV_CMD_COMPLETE) {
  36. struct hci_ev_cmd_complete *ec;
  37. u16 opcode;
  38. ec = (void *) (skb->data + HCI_EVENT_HDR_SIZE);
  39. opcode = __le16_to_cpu(ec->opcode);
  40. if (priv->btmrvl_dev.sendcmdflag) {
  41. priv->btmrvl_dev.sendcmdflag = false;
  42. priv->adapter->cmd_complete = true;
  43. wake_up_interruptible(&priv->adapter->cmd_wait_q);
  44. if (hci_opcode_ogf(opcode) == 0x3F) {
  45. BT_DBG("vendor event skipped: opcode=%#4.4x",
  46. opcode);
  47. kfree_skb(skb);
  48. return false;
  49. }
  50. }
  51. }
  52. return true;
  53. }
  54. EXPORT_SYMBOL_GPL(btmrvl_check_evtpkt);
  55. int btmrvl_process_event(struct btmrvl_private *priv, struct sk_buff *skb)
  56. {
  57. struct btmrvl_adapter *adapter = priv->adapter;
  58. struct btmrvl_event *event;
  59. int ret = 0;
  60. event = (struct btmrvl_event *) skb->data;
  61. if (event->ec != 0xff) {
  62. BT_DBG("Not Marvell Event=%x", event->ec);
  63. ret = -EINVAL;
  64. goto exit;
  65. }
  66. switch (event->data[0]) {
  67. case BT_EVENT_AUTO_SLEEP_MODE:
  68. if (!event->data[2]) {
  69. if (event->data[1] == BT_PS_ENABLE)
  70. adapter->psmode = 1;
  71. else
  72. adapter->psmode = 0;
  73. BT_DBG("PS Mode:%s",
  74. (adapter->psmode) ? "Enable" : "Disable");
  75. } else {
  76. BT_DBG("PS Mode command failed");
  77. }
  78. break;
  79. case BT_EVENT_HOST_SLEEP_CONFIG:
  80. if (!event->data[3])
  81. BT_DBG("gpio=%x, gap=%x", event->data[1],
  82. event->data[2]);
  83. else
  84. BT_DBG("HSCFG command failed");
  85. break;
  86. case BT_EVENT_HOST_SLEEP_ENABLE:
  87. if (!event->data[1]) {
  88. adapter->hs_state = HS_ACTIVATED;
  89. if (adapter->psmode)
  90. adapter->ps_state = PS_SLEEP;
  91. wake_up_interruptible(&adapter->event_hs_wait_q);
  92. BT_DBG("HS ACTIVATED!");
  93. } else {
  94. BT_DBG("HS Enable failed");
  95. }
  96. break;
  97. case BT_EVENT_MODULE_CFG_REQ:
  98. if (priv->btmrvl_dev.sendcmdflag &&
  99. event->data[1] == MODULE_BRINGUP_REQ) {
  100. BT_DBG("EVENT:%s",
  101. ((event->data[2] == MODULE_BROUGHT_UP) ||
  102. (event->data[2] == MODULE_ALREADY_UP)) ?
  103. "Bring-up succeed" : "Bring-up failed");
  104. } else if (priv->btmrvl_dev.sendcmdflag &&
  105. event->data[1] == MODULE_SHUTDOWN_REQ) {
  106. BT_DBG("EVENT:%s", (event->data[2]) ?
  107. "Shutdown failed" : "Shutdown succeed");
  108. } else {
  109. BT_DBG("BT_CMD_MODULE_CFG_REQ resp for APP");
  110. ret = -EINVAL;
  111. }
  112. break;
  113. case BT_EVENT_POWER_STATE:
  114. if (event->data[1] == BT_PS_SLEEP)
  115. adapter->ps_state = PS_SLEEP;
  116. BT_DBG("EVENT:%s",
  117. (adapter->ps_state) ? "PS_SLEEP" : "PS_AWAKE");
  118. break;
  119. default:
  120. BT_DBG("Unknown Event=%d", event->data[0]);
  121. ret = -EINVAL;
  122. break;
  123. }
  124. exit:
  125. if (!ret)
  126. kfree_skb(skb);
  127. return ret;
  128. }
  129. EXPORT_SYMBOL_GPL(btmrvl_process_event);
  130. static int btmrvl_send_sync_cmd(struct btmrvl_private *priv, u16 opcode,
  131. const void *param, u8 len)
  132. {
  133. struct sk_buff *skb;
  134. struct hci_command_hdr *hdr;
  135. if (priv->surprise_removed) {
  136. BT_ERR("Card is removed");
  137. return -EFAULT;
  138. }
  139. skb = bt_skb_alloc(HCI_COMMAND_HDR_SIZE + len, GFP_KERNEL);
  140. if (!skb) {
  141. BT_ERR("No free skb");
  142. return -ENOMEM;
  143. }
  144. hdr = skb_put(skb, HCI_COMMAND_HDR_SIZE);
  145. hdr->opcode = cpu_to_le16(opcode);
  146. hdr->plen = len;
  147. if (len)
  148. skb_put_data(skb, param, len);
  149. hci_skb_pkt_type(skb) = MRVL_VENDOR_PKT;
  150. skb_queue_head(&priv->adapter->tx_queue, skb);
  151. priv->btmrvl_dev.sendcmdflag = true;
  152. priv->adapter->cmd_complete = false;
  153. wake_up_interruptible(&priv->main_thread.wait_q);
  154. if (!wait_event_interruptible_timeout(priv->adapter->cmd_wait_q,
  155. priv->adapter->cmd_complete ||
  156. priv->surprise_removed,
  157. WAIT_UNTIL_CMD_RESP))
  158. return -ETIMEDOUT;
  159. if (priv->surprise_removed)
  160. return -EFAULT;
  161. return 0;
  162. }
  163. int btmrvl_send_module_cfg_cmd(struct btmrvl_private *priv, u8 subcmd)
  164. {
  165. int ret;
  166. ret = btmrvl_send_sync_cmd(priv, BT_CMD_MODULE_CFG_REQ, &subcmd, 1);
  167. if (ret)
  168. BT_ERR("module_cfg_cmd(%x) failed", subcmd);
  169. return ret;
  170. }
  171. EXPORT_SYMBOL_GPL(btmrvl_send_module_cfg_cmd);
  172. static int btmrvl_enable_sco_routing_to_host(struct btmrvl_private *priv)
  173. {
  174. int ret;
  175. u8 subcmd = 0;
  176. ret = btmrvl_send_sync_cmd(priv, BT_CMD_ROUTE_SCO_TO_HOST, &subcmd, 1);
  177. if (ret)
  178. BT_ERR("BT_CMD_ROUTE_SCO_TO_HOST command failed: %#x", ret);
  179. return ret;
  180. }
  181. int btmrvl_pscan_window_reporting(struct btmrvl_private *priv, u8 subcmd)
  182. {
  183. struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
  184. int ret;
  185. if (!card->support_pscan_win_report)
  186. return 0;
  187. ret = btmrvl_send_sync_cmd(priv, BT_CMD_PSCAN_WIN_REPORT_ENABLE,
  188. &subcmd, 1);
  189. if (ret)
  190. BT_ERR("PSCAN_WIN_REPORT_ENABLE command failed: %#x", ret);
  191. return ret;
  192. }
  193. EXPORT_SYMBOL_GPL(btmrvl_pscan_window_reporting);
  194. int btmrvl_send_hscfg_cmd(struct btmrvl_private *priv)
  195. {
  196. int ret;
  197. u8 param[2];
  198. param[0] = (priv->btmrvl_dev.gpio_gap & 0xff00) >> 8;
  199. param[1] = (u8) (priv->btmrvl_dev.gpio_gap & 0x00ff);
  200. BT_DBG("Sending HSCFG Command, gpio=0x%x, gap=0x%x",
  201. param[0], param[1]);
  202. ret = btmrvl_send_sync_cmd(priv, BT_CMD_HOST_SLEEP_CONFIG, param, 2);
  203. if (ret)
  204. BT_ERR("HSCFG command failed");
  205. return ret;
  206. }
  207. EXPORT_SYMBOL_GPL(btmrvl_send_hscfg_cmd);
  208. int btmrvl_enable_ps(struct btmrvl_private *priv)
  209. {
  210. int ret;
  211. u8 param;
  212. if (priv->btmrvl_dev.psmode)
  213. param = BT_PS_ENABLE;
  214. else
  215. param = BT_PS_DISABLE;
  216. ret = btmrvl_send_sync_cmd(priv, BT_CMD_AUTO_SLEEP_MODE, &param, 1);
  217. if (ret)
  218. BT_ERR("PSMODE command failed");
  219. return 0;
  220. }
  221. EXPORT_SYMBOL_GPL(btmrvl_enable_ps);
  222. int btmrvl_enable_hs(struct btmrvl_private *priv)
  223. {
  224. struct btmrvl_adapter *adapter = priv->adapter;
  225. int ret;
  226. ret = btmrvl_send_sync_cmd(priv, BT_CMD_HOST_SLEEP_ENABLE, NULL, 0);
  227. if (ret) {
  228. BT_ERR("Host sleep enable command failed");
  229. return ret;
  230. }
  231. ret = wait_event_interruptible_timeout(adapter->event_hs_wait_q,
  232. adapter->hs_state ||
  233. priv->surprise_removed,
  234. WAIT_UNTIL_HS_STATE_CHANGED);
  235. if (ret < 0 || priv->surprise_removed) {
  236. BT_ERR("event_hs_wait_q terminated (%d): %d,%d,%d",
  237. ret, adapter->hs_state, adapter->ps_state,
  238. adapter->wakeup_tries);
  239. } else if (!ret) {
  240. BT_ERR("hs_enable timeout: %d,%d,%d", adapter->hs_state,
  241. adapter->ps_state, adapter->wakeup_tries);
  242. ret = -ETIMEDOUT;
  243. } else {
  244. BT_DBG("host sleep enabled: %d,%d,%d", adapter->hs_state,
  245. adapter->ps_state, adapter->wakeup_tries);
  246. ret = 0;
  247. }
  248. return ret;
  249. }
  250. EXPORT_SYMBOL_GPL(btmrvl_enable_hs);
  251. int btmrvl_prepare_command(struct btmrvl_private *priv)
  252. {
  253. int ret = 0;
  254. if (priv->btmrvl_dev.hscfgcmd) {
  255. priv->btmrvl_dev.hscfgcmd = 0;
  256. btmrvl_send_hscfg_cmd(priv);
  257. }
  258. if (priv->btmrvl_dev.pscmd) {
  259. priv->btmrvl_dev.pscmd = 0;
  260. btmrvl_enable_ps(priv);
  261. }
  262. if (priv->btmrvl_dev.hscmd) {
  263. priv->btmrvl_dev.hscmd = 0;
  264. if (priv->btmrvl_dev.hsmode) {
  265. ret = btmrvl_enable_hs(priv);
  266. } else {
  267. ret = priv->hw_wakeup_firmware(priv);
  268. priv->adapter->hs_state = HS_DEACTIVATED;
  269. BT_DBG("BT: HS DEACTIVATED due to host activity!");
  270. }
  271. }
  272. return ret;
  273. }
  274. static int btmrvl_tx_pkt(struct btmrvl_private *priv, struct sk_buff *skb)
  275. {
  276. int ret = 0;
  277. if (!skb || !skb->data)
  278. return -EINVAL;
  279. if (!skb->len || ((skb->len + BTM_HEADER_LEN) > BTM_UPLD_SIZE)) {
  280. BT_ERR("Tx Error: Bad skb length %d : %d",
  281. skb->len, BTM_UPLD_SIZE);
  282. return -EINVAL;
  283. }
  284. skb_push(skb, BTM_HEADER_LEN);
  285. /* header type: byte[3]
  286. * HCI_COMMAND = 1, ACL_DATA = 2, SCO_DATA = 3, 0xFE = Vendor
  287. * header length: byte[2][1][0]
  288. */
  289. skb->data[0] = (skb->len & 0x0000ff);
  290. skb->data[1] = (skb->len & 0x00ff00) >> 8;
  291. skb->data[2] = (skb->len & 0xff0000) >> 16;
  292. skb->data[3] = hci_skb_pkt_type(skb);
  293. if (priv->hw_host_to_card)
  294. ret = priv->hw_host_to_card(priv, skb->data, skb->len);
  295. return ret;
  296. }
  297. static void btmrvl_init_adapter(struct btmrvl_private *priv)
  298. {
  299. int buf_size;
  300. skb_queue_head_init(&priv->adapter->tx_queue);
  301. priv->adapter->ps_state = PS_AWAKE;
  302. buf_size = ALIGN_SZ(SDIO_BLOCK_SIZE, BTSDIO_DMA_ALIGN);
  303. priv->adapter->hw_regs_buf = kzalloc(buf_size, GFP_KERNEL);
  304. if (!priv->adapter->hw_regs_buf) {
  305. priv->adapter->hw_regs = NULL;
  306. BT_ERR("Unable to allocate buffer for hw_regs.");
  307. } else {
  308. priv->adapter->hw_regs =
  309. (u8 *)ALIGN_ADDR(priv->adapter->hw_regs_buf,
  310. BTSDIO_DMA_ALIGN);
  311. BT_DBG("hw_regs_buf=%p hw_regs=%p",
  312. priv->adapter->hw_regs_buf, priv->adapter->hw_regs);
  313. }
  314. init_waitqueue_head(&priv->adapter->cmd_wait_q);
  315. init_waitqueue_head(&priv->adapter->event_hs_wait_q);
  316. }
  317. static void btmrvl_free_adapter(struct btmrvl_private *priv)
  318. {
  319. skb_queue_purge(&priv->adapter->tx_queue);
  320. kfree(priv->adapter->hw_regs_buf);
  321. kfree(priv->adapter);
  322. priv->adapter = NULL;
  323. }
  324. static int btmrvl_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
  325. {
  326. struct btmrvl_private *priv = hci_get_drvdata(hdev);
  327. BT_DBG("type=%d, len=%d", hci_skb_pkt_type(skb), skb->len);
  328. if (priv->adapter->is_suspending || priv->adapter->is_suspended) {
  329. BT_ERR("%s: Device is suspending or suspended", __func__);
  330. return -EBUSY;
  331. }
  332. switch (hci_skb_pkt_type(skb)) {
  333. case HCI_COMMAND_PKT:
  334. hdev->stat.cmd_tx++;
  335. break;
  336. case HCI_ACLDATA_PKT:
  337. hdev->stat.acl_tx++;
  338. break;
  339. case HCI_SCODATA_PKT:
  340. hdev->stat.sco_tx++;
  341. break;
  342. }
  343. skb_queue_tail(&priv->adapter->tx_queue, skb);
  344. if (!priv->adapter->is_suspended)
  345. wake_up_interruptible(&priv->main_thread.wait_q);
  346. return 0;
  347. }
  348. static int btmrvl_flush(struct hci_dev *hdev)
  349. {
  350. struct btmrvl_private *priv = hci_get_drvdata(hdev);
  351. skb_queue_purge(&priv->adapter->tx_queue);
  352. return 0;
  353. }
  354. static int btmrvl_close(struct hci_dev *hdev)
  355. {
  356. struct btmrvl_private *priv = hci_get_drvdata(hdev);
  357. skb_queue_purge(&priv->adapter->tx_queue);
  358. return 0;
  359. }
  360. static int btmrvl_open(struct hci_dev *hdev)
  361. {
  362. return 0;
  363. }
  364. static int btmrvl_download_cal_data(struct btmrvl_private *priv,
  365. u8 *data, int len)
  366. {
  367. int ret;
  368. data[0] = 0x00;
  369. data[1] = 0x00;
  370. data[2] = 0x00;
  371. data[3] = len;
  372. print_hex_dump_bytes("Calibration data: ",
  373. DUMP_PREFIX_OFFSET, data, BT_CAL_HDR_LEN + len);
  374. ret = btmrvl_send_sync_cmd(priv, BT_CMD_LOAD_CONFIG_DATA, data,
  375. BT_CAL_HDR_LEN + len);
  376. if (ret)
  377. BT_ERR("Failed to download calibration data");
  378. return 0;
  379. }
  380. static int btmrvl_check_device_tree(struct btmrvl_private *priv)
  381. {
  382. struct device_node *dt_node;
  383. struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
  384. u8 cal_data[BT_CAL_HDR_LEN + BT_CAL_DATA_SIZE];
  385. int ret = 0;
  386. u16 gpio, gap;
  387. if (card->plt_of_node) {
  388. dt_node = card->plt_of_node;
  389. ret = of_property_read_u16(dt_node, "marvell,wakeup-pin",
  390. &gpio);
  391. if (ret)
  392. gpio = (priv->btmrvl_dev.gpio_gap & 0xff00) >> 8;
  393. ret = of_property_read_u16(dt_node, "marvell,wakeup-gap-ms",
  394. &gap);
  395. if (ret)
  396. gap = (u8)(priv->btmrvl_dev.gpio_gap & 0x00ff);
  397. priv->btmrvl_dev.gpio_gap = (gpio << 8) + gap;
  398. ret = of_property_read_u8_array(dt_node, "marvell,cal-data",
  399. cal_data + BT_CAL_HDR_LEN,
  400. BT_CAL_DATA_SIZE);
  401. if (ret)
  402. return ret;
  403. BT_DBG("Use cal data from device tree");
  404. ret = btmrvl_download_cal_data(priv, cal_data,
  405. BT_CAL_DATA_SIZE);
  406. if (ret)
  407. BT_ERR("Fail to download calibrate data");
  408. }
  409. return ret;
  410. }
  411. static int btmrvl_setup(struct hci_dev *hdev)
  412. {
  413. struct btmrvl_private *priv = hci_get_drvdata(hdev);
  414. int ret;
  415. ret = btmrvl_send_module_cfg_cmd(priv, MODULE_BRINGUP_REQ);
  416. if (ret)
  417. return ret;
  418. priv->btmrvl_dev.gpio_gap = 0xfffe;
  419. btmrvl_check_device_tree(priv);
  420. btmrvl_enable_sco_routing_to_host(priv);
  421. btmrvl_pscan_window_reporting(priv, 0x01);
  422. priv->btmrvl_dev.psmode = 1;
  423. btmrvl_enable_ps(priv);
  424. btmrvl_send_hscfg_cmd(priv);
  425. return 0;
  426. }
  427. static int btmrvl_set_bdaddr(struct hci_dev *hdev, const bdaddr_t *bdaddr)
  428. {
  429. struct sk_buff *skb;
  430. long ret;
  431. u8 buf[8];
  432. buf[0] = MRVL_VENDOR_PKT;
  433. buf[1] = sizeof(bdaddr_t);
  434. memcpy(buf + 2, bdaddr, sizeof(bdaddr_t));
  435. skb = __hci_cmd_sync(hdev, BT_CMD_SET_BDADDR, sizeof(buf), buf,
  436. HCI_INIT_TIMEOUT);
  437. if (IS_ERR(skb)) {
  438. ret = PTR_ERR(skb);
  439. BT_ERR("%s: changing btmrvl device address failed (%ld)",
  440. hdev->name, ret);
  441. return ret;
  442. }
  443. kfree_skb(skb);
  444. return 0;
  445. }
  446. static bool btmrvl_wakeup(struct hci_dev *hdev)
  447. {
  448. struct btmrvl_private *priv = hci_get_drvdata(hdev);
  449. struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
  450. return device_may_wakeup(&card->func->dev);
  451. }
  452. /*
  453. * This function handles the event generated by firmware, rx data
  454. * received from firmware, and tx data sent from kernel.
  455. */
  456. static int btmrvl_service_main_thread(void *data)
  457. {
  458. struct btmrvl_thread *thread = data;
  459. struct btmrvl_private *priv = thread->priv;
  460. struct btmrvl_adapter *adapter = priv->adapter;
  461. wait_queue_entry_t wait;
  462. struct sk_buff *skb;
  463. ulong flags;
  464. init_waitqueue_entry(&wait, current);
  465. for (;;) {
  466. add_wait_queue(&thread->wait_q, &wait);
  467. set_current_state(TASK_INTERRUPTIBLE);
  468. if (kthread_should_stop() || priv->surprise_removed) {
  469. BT_DBG("main_thread: break from main thread");
  470. break;
  471. }
  472. if (adapter->wakeup_tries ||
  473. ((!adapter->int_count) &&
  474. (!priv->btmrvl_dev.tx_dnld_rdy ||
  475. skb_queue_empty(&adapter->tx_queue)))) {
  476. BT_DBG("main_thread is sleeping...");
  477. schedule();
  478. }
  479. set_current_state(TASK_RUNNING);
  480. remove_wait_queue(&thread->wait_q, &wait);
  481. BT_DBG("main_thread woke up");
  482. if (kthread_should_stop() || priv->surprise_removed) {
  483. BT_DBG("main_thread: break from main thread");
  484. break;
  485. }
  486. spin_lock_irqsave(&priv->driver_lock, flags);
  487. if (adapter->int_count) {
  488. adapter->int_count = 0;
  489. spin_unlock_irqrestore(&priv->driver_lock, flags);
  490. priv->hw_process_int_status(priv);
  491. } else if (adapter->ps_state == PS_SLEEP &&
  492. !skb_queue_empty(&adapter->tx_queue)) {
  493. spin_unlock_irqrestore(&priv->driver_lock, flags);
  494. adapter->wakeup_tries++;
  495. priv->hw_wakeup_firmware(priv);
  496. continue;
  497. } else {
  498. spin_unlock_irqrestore(&priv->driver_lock, flags);
  499. }
  500. if (adapter->ps_state == PS_SLEEP)
  501. continue;
  502. if (!priv->btmrvl_dev.tx_dnld_rdy ||
  503. priv->adapter->is_suspended)
  504. continue;
  505. skb = skb_dequeue(&adapter->tx_queue);
  506. if (skb) {
  507. if (btmrvl_tx_pkt(priv, skb))
  508. priv->btmrvl_dev.hcidev->stat.err_tx++;
  509. else
  510. priv->btmrvl_dev.hcidev->stat.byte_tx += skb->len;
  511. kfree_skb(skb);
  512. }
  513. }
  514. return 0;
  515. }
  516. int btmrvl_register_hdev(struct btmrvl_private *priv)
  517. {
  518. struct hci_dev *hdev = NULL;
  519. struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
  520. int ret;
  521. hdev = hci_alloc_dev();
  522. if (!hdev) {
  523. BT_ERR("Can not allocate HCI device");
  524. goto err_hdev;
  525. }
  526. priv->btmrvl_dev.hcidev = hdev;
  527. hci_set_drvdata(hdev, priv);
  528. hdev->bus = HCI_SDIO;
  529. hdev->open = btmrvl_open;
  530. hdev->close = btmrvl_close;
  531. hdev->flush = btmrvl_flush;
  532. hdev->send = btmrvl_send_frame;
  533. hdev->setup = btmrvl_setup;
  534. hdev->set_bdaddr = btmrvl_set_bdaddr;
  535. hdev->wakeup = btmrvl_wakeup;
  536. SET_HCIDEV_DEV(hdev, &card->func->dev);
  537. ret = hci_register_dev(hdev);
  538. if (ret < 0) {
  539. BT_ERR("Can not register HCI device");
  540. goto err_hci_register_dev;
  541. }
  542. #ifdef CONFIG_DEBUG_FS
  543. btmrvl_debugfs_init(hdev);
  544. #endif
  545. return 0;
  546. err_hci_register_dev:
  547. hci_free_dev(hdev);
  548. err_hdev:
  549. /* Stop the thread servicing the interrupts */
  550. kthread_stop(priv->main_thread.task);
  551. btmrvl_free_adapter(priv);
  552. kfree(priv);
  553. return -ENOMEM;
  554. }
  555. EXPORT_SYMBOL_GPL(btmrvl_register_hdev);
  556. struct btmrvl_private *btmrvl_add_card(void *card)
  557. {
  558. struct btmrvl_private *priv;
  559. priv = kzalloc(sizeof(*priv), GFP_KERNEL);
  560. if (!priv) {
  561. BT_ERR("Can not allocate priv");
  562. goto err_priv;
  563. }
  564. priv->adapter = kzalloc(sizeof(*priv->adapter), GFP_KERNEL);
  565. if (!priv->adapter) {
  566. BT_ERR("Allocate buffer for btmrvl_adapter failed!");
  567. goto err_adapter;
  568. }
  569. btmrvl_init_adapter(priv);
  570. BT_DBG("Starting kthread...");
  571. priv->main_thread.priv = priv;
  572. spin_lock_init(&priv->driver_lock);
  573. init_waitqueue_head(&priv->main_thread.wait_q);
  574. priv->main_thread.task = kthread_run(btmrvl_service_main_thread,
  575. &priv->main_thread, "btmrvl_main_service");
  576. if (IS_ERR(priv->main_thread.task))
  577. goto err_thread;
  578. priv->btmrvl_dev.card = card;
  579. priv->btmrvl_dev.tx_dnld_rdy = true;
  580. return priv;
  581. err_thread:
  582. btmrvl_free_adapter(priv);
  583. err_adapter:
  584. kfree(priv);
  585. err_priv:
  586. return NULL;
  587. }
  588. EXPORT_SYMBOL_GPL(btmrvl_add_card);
  589. int btmrvl_remove_card(struct btmrvl_private *priv)
  590. {
  591. struct hci_dev *hdev;
  592. hdev = priv->btmrvl_dev.hcidev;
  593. wake_up_interruptible(&priv->adapter->cmd_wait_q);
  594. wake_up_interruptible(&priv->adapter->event_hs_wait_q);
  595. kthread_stop(priv->main_thread.task);
  596. #ifdef CONFIG_DEBUG_FS
  597. btmrvl_debugfs_remove(hdev);
  598. #endif
  599. hci_unregister_dev(hdev);
  600. hci_free_dev(hdev);
  601. priv->btmrvl_dev.hcidev = NULL;
  602. btmrvl_free_adapter(priv);
  603. kfree(priv);
  604. return 0;
  605. }
  606. EXPORT_SYMBOL_GPL(btmrvl_remove_card);
  607. MODULE_AUTHOR("Marvell International Ltd.");
  608. MODULE_DESCRIPTION("Marvell Bluetooth driver ver " VERSION);
  609. MODULE_VERSION(VERSION);
  610. MODULE_LICENSE("GPL v2");