btmrvl_main.c 18 KB

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