htc.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806
  1. /*
  2. * Copyright (c) 2005-2011 Atheros Communications Inc.
  3. * Copyright (c) 2011-2013 Qualcomm Atheros, Inc.
  4. *
  5. * Permission to use, copy, modify, and/or distribute this software for any
  6. * purpose with or without fee is hereby granted, provided that the above
  7. * copyright notice and this permission notice appear in all copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  10. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  11. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  12. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  13. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  14. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  15. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  16. */
  17. #include "core.h"
  18. #include "hif.h"
  19. #include "debug.h"
  20. /********/
  21. /* Send */
  22. /********/
  23. static void ath10k_htc_control_tx_complete(struct ath10k *ar,
  24. struct sk_buff *skb)
  25. {
  26. kfree_skb(skb);
  27. }
  28. static struct sk_buff *ath10k_htc_build_tx_ctrl_skb(void *ar)
  29. {
  30. struct sk_buff *skb;
  31. struct ath10k_skb_cb *skb_cb;
  32. skb = dev_alloc_skb(ATH10K_HTC_CONTROL_BUFFER_SIZE);
  33. if (!skb)
  34. return NULL;
  35. skb_reserve(skb, 20); /* FIXME: why 20 bytes? */
  36. WARN_ONCE((unsigned long)skb->data & 3, "unaligned skb");
  37. skb_cb = ATH10K_SKB_CB(skb);
  38. memset(skb_cb, 0, sizeof(*skb_cb));
  39. ath10k_dbg(ar, ATH10K_DBG_HTC, "%s: skb %pK\n", __func__, skb);
  40. return skb;
  41. }
  42. static inline void ath10k_htc_restore_tx_skb(struct ath10k_htc *htc,
  43. struct sk_buff *skb)
  44. {
  45. struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(skb);
  46. dma_unmap_single(htc->ar->dev, skb_cb->paddr, skb->len, DMA_TO_DEVICE);
  47. skb_pull(skb, sizeof(struct ath10k_htc_hdr));
  48. }
  49. static void ath10k_htc_notify_tx_completion(struct ath10k_htc_ep *ep,
  50. struct sk_buff *skb)
  51. {
  52. struct ath10k *ar = ep->htc->ar;
  53. ath10k_dbg(ar, ATH10K_DBG_HTC, "%s: ep %d skb %pK\n", __func__,
  54. ep->eid, skb);
  55. ath10k_htc_restore_tx_skb(ep->htc, skb);
  56. if (!ep->ep_ops.ep_tx_complete) {
  57. ath10k_warn(ar, "no tx handler for eid %d\n", ep->eid);
  58. dev_kfree_skb_any(skb);
  59. return;
  60. }
  61. ep->ep_ops.ep_tx_complete(ep->htc->ar, skb);
  62. }
  63. static void ath10k_htc_prepare_tx_skb(struct ath10k_htc_ep *ep,
  64. struct sk_buff *skb)
  65. {
  66. struct ath10k_htc_hdr *hdr;
  67. hdr = (struct ath10k_htc_hdr *)skb->data;
  68. hdr->eid = ep->eid;
  69. hdr->len = __cpu_to_le16(skb->len - sizeof(*hdr));
  70. hdr->flags = 0;
  71. hdr->flags |= ATH10K_HTC_FLAG_NEED_CREDIT_UPDATE;
  72. spin_lock_bh(&ep->htc->tx_lock);
  73. hdr->seq_no = ep->seq_no++;
  74. spin_unlock_bh(&ep->htc->tx_lock);
  75. }
  76. int ath10k_htc_send(struct ath10k_htc *htc,
  77. enum ath10k_htc_ep_id eid,
  78. struct sk_buff *skb)
  79. {
  80. struct ath10k *ar = htc->ar;
  81. struct ath10k_htc_ep *ep = &htc->endpoint[eid];
  82. struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(skb);
  83. struct ath10k_hif_sg_item sg_item;
  84. struct device *dev = htc->ar->dev;
  85. int credits = 0;
  86. int ret;
  87. if (htc->ar->state == ATH10K_STATE_WEDGED)
  88. return -ECOMM;
  89. if (eid >= ATH10K_HTC_EP_COUNT) {
  90. ath10k_warn(ar, "Invalid endpoint id: %d\n", eid);
  91. return -ENOENT;
  92. }
  93. skb_push(skb, sizeof(struct ath10k_htc_hdr));
  94. if (ep->tx_credit_flow_enabled) {
  95. credits = DIV_ROUND_UP(skb->len, htc->target_credit_size);
  96. spin_lock_bh(&htc->tx_lock);
  97. if (ep->tx_credits < credits) {
  98. ath10k_dbg(ar, ATH10K_DBG_HTC,
  99. "htc insufficient credits ep %d required %d available %d\n",
  100. eid, credits, ep->tx_credits);
  101. spin_unlock_bh(&htc->tx_lock);
  102. ret = -EAGAIN;
  103. goto err_pull;
  104. }
  105. ep->tx_credits -= credits;
  106. ath10k_dbg(ar, ATH10K_DBG_HTC,
  107. "htc ep %d consumed %d credits (total %d)\n",
  108. eid, credits, ep->tx_credits);
  109. spin_unlock_bh(&htc->tx_lock);
  110. }
  111. ath10k_htc_prepare_tx_skb(ep, skb);
  112. skb_cb->eid = eid;
  113. skb_cb->paddr = dma_map_single(dev, skb->data, skb->len, DMA_TO_DEVICE);
  114. ret = dma_mapping_error(dev, skb_cb->paddr);
  115. if (ret) {
  116. ret = -EIO;
  117. goto err_credits;
  118. }
  119. sg_item.transfer_id = ep->eid;
  120. sg_item.transfer_context = skb;
  121. sg_item.vaddr = skb->data;
  122. sg_item.paddr = skb_cb->paddr;
  123. sg_item.len = skb->len;
  124. ret = ath10k_hif_tx_sg(htc->ar, ep->ul_pipe_id, &sg_item, 1);
  125. if (ret)
  126. goto err_unmap;
  127. return 0;
  128. err_unmap:
  129. dma_unmap_single(dev, skb_cb->paddr, skb->len, DMA_TO_DEVICE);
  130. err_credits:
  131. if (ep->tx_credit_flow_enabled) {
  132. spin_lock_bh(&htc->tx_lock);
  133. ep->tx_credits += credits;
  134. ath10k_dbg(ar, ATH10K_DBG_HTC,
  135. "htc ep %d reverted %d credits back (total %d)\n",
  136. eid, credits, ep->tx_credits);
  137. spin_unlock_bh(&htc->tx_lock);
  138. if (ep->ep_ops.ep_tx_credits)
  139. ep->ep_ops.ep_tx_credits(htc->ar);
  140. }
  141. err_pull:
  142. skb_pull(skb, sizeof(struct ath10k_htc_hdr));
  143. return ret;
  144. }
  145. void ath10k_htc_tx_completion_handler(struct ath10k *ar, struct sk_buff *skb)
  146. {
  147. struct ath10k_htc *htc = &ar->htc;
  148. struct ath10k_skb_cb *skb_cb;
  149. struct ath10k_htc_ep *ep;
  150. if (WARN_ON_ONCE(!skb))
  151. return;
  152. skb_cb = ATH10K_SKB_CB(skb);
  153. ep = &htc->endpoint[skb_cb->eid];
  154. ath10k_htc_notify_tx_completion(ep, skb);
  155. /* the skb now belongs to the completion handler */
  156. }
  157. EXPORT_SYMBOL(ath10k_htc_tx_completion_handler);
  158. /***********/
  159. /* Receive */
  160. /***********/
  161. static void
  162. ath10k_htc_process_credit_report(struct ath10k_htc *htc,
  163. const struct ath10k_htc_credit_report *report,
  164. int len,
  165. enum ath10k_htc_ep_id eid)
  166. {
  167. struct ath10k *ar = htc->ar;
  168. struct ath10k_htc_ep *ep;
  169. int i, n_reports;
  170. if (len % sizeof(*report))
  171. ath10k_warn(ar, "Uneven credit report len %d", len);
  172. n_reports = len / sizeof(*report);
  173. spin_lock_bh(&htc->tx_lock);
  174. for (i = 0; i < n_reports; i++, report++) {
  175. if (report->eid >= ATH10K_HTC_EP_COUNT)
  176. break;
  177. ep = &htc->endpoint[report->eid];
  178. ep->tx_credits += report->credits;
  179. ath10k_dbg(ar, ATH10K_DBG_HTC, "htc ep %d got %d credits (total %d)\n",
  180. report->eid, report->credits, ep->tx_credits);
  181. if (ep->ep_ops.ep_tx_credits) {
  182. spin_unlock_bh(&htc->tx_lock);
  183. ep->ep_ops.ep_tx_credits(htc->ar);
  184. spin_lock_bh(&htc->tx_lock);
  185. }
  186. }
  187. spin_unlock_bh(&htc->tx_lock);
  188. }
  189. static int ath10k_htc_process_trailer(struct ath10k_htc *htc,
  190. u8 *buffer,
  191. int length,
  192. enum ath10k_htc_ep_id src_eid)
  193. {
  194. struct ath10k *ar = htc->ar;
  195. int status = 0;
  196. struct ath10k_htc_record *record;
  197. u8 *orig_buffer;
  198. int orig_length;
  199. size_t len;
  200. orig_buffer = buffer;
  201. orig_length = length;
  202. while (length > 0) {
  203. record = (struct ath10k_htc_record *)buffer;
  204. if (length < sizeof(record->hdr)) {
  205. status = -EINVAL;
  206. break;
  207. }
  208. if (record->hdr.len > length) {
  209. /* no room left in buffer for record */
  210. ath10k_warn(ar, "Invalid record length: %d\n",
  211. record->hdr.len);
  212. status = -EINVAL;
  213. break;
  214. }
  215. switch (record->hdr.id) {
  216. case ATH10K_HTC_RECORD_CREDITS:
  217. len = sizeof(struct ath10k_htc_credit_report);
  218. if (record->hdr.len < len) {
  219. ath10k_warn(ar, "Credit report too long\n");
  220. status = -EINVAL;
  221. break;
  222. }
  223. ath10k_htc_process_credit_report(htc,
  224. record->credit_report,
  225. record->hdr.len,
  226. src_eid);
  227. break;
  228. default:
  229. ath10k_warn(ar, "Unhandled record: id:%d length:%d\n",
  230. record->hdr.id, record->hdr.len);
  231. break;
  232. }
  233. if (status)
  234. break;
  235. /* multiple records may be present in a trailer */
  236. buffer += sizeof(record->hdr) + record->hdr.len;
  237. length -= sizeof(record->hdr) + record->hdr.len;
  238. }
  239. if (status)
  240. ath10k_dbg_dump(ar, ATH10K_DBG_HTC, "htc rx bad trailer", "",
  241. orig_buffer, orig_length);
  242. return status;
  243. }
  244. void ath10k_htc_rx_completion_handler(struct ath10k *ar, struct sk_buff *skb)
  245. {
  246. int status = 0;
  247. struct ath10k_htc *htc = &ar->htc;
  248. struct ath10k_htc_hdr *hdr;
  249. struct ath10k_htc_ep *ep;
  250. u16 payload_len;
  251. u32 trailer_len = 0;
  252. size_t min_len;
  253. u8 eid;
  254. bool trailer_present;
  255. hdr = (struct ath10k_htc_hdr *)skb->data;
  256. skb_pull(skb, sizeof(*hdr));
  257. eid = hdr->eid;
  258. if (eid >= ATH10K_HTC_EP_COUNT) {
  259. ath10k_warn(ar, "HTC Rx: invalid eid %d\n", eid);
  260. ath10k_dbg_dump(ar, ATH10K_DBG_HTC, "htc bad header", "",
  261. hdr, sizeof(*hdr));
  262. goto out;
  263. }
  264. ep = &htc->endpoint[eid];
  265. payload_len = __le16_to_cpu(hdr->len);
  266. if (payload_len + sizeof(*hdr) > ATH10K_HTC_MAX_LEN) {
  267. ath10k_warn(ar, "HTC rx frame too long, len: %zu\n",
  268. payload_len + sizeof(*hdr));
  269. ath10k_dbg_dump(ar, ATH10K_DBG_HTC, "htc bad rx pkt len", "",
  270. hdr, sizeof(*hdr));
  271. goto out;
  272. }
  273. if (skb->len < payload_len) {
  274. ath10k_dbg(ar, ATH10K_DBG_HTC,
  275. "HTC Rx: insufficient length, got %d, expected %d\n",
  276. skb->len, payload_len);
  277. ath10k_dbg_dump(ar, ATH10K_DBG_HTC, "htc bad rx pkt len",
  278. "", hdr, sizeof(*hdr));
  279. goto out;
  280. }
  281. /* get flags to check for trailer */
  282. trailer_present = hdr->flags & ATH10K_HTC_FLAG_TRAILER_PRESENT;
  283. if (trailer_present) {
  284. u8 *trailer;
  285. trailer_len = hdr->trailer_len;
  286. min_len = sizeof(struct ath10k_ath10k_htc_record_hdr);
  287. if ((trailer_len < min_len) ||
  288. (trailer_len > payload_len)) {
  289. ath10k_warn(ar, "Invalid trailer length: %d\n",
  290. trailer_len);
  291. goto out;
  292. }
  293. trailer = (u8 *)hdr;
  294. trailer += sizeof(*hdr);
  295. trailer += payload_len;
  296. trailer -= trailer_len;
  297. status = ath10k_htc_process_trailer(htc, trailer,
  298. trailer_len, hdr->eid);
  299. if (status)
  300. goto out;
  301. skb_trim(skb, skb->len - trailer_len);
  302. }
  303. if (((int)payload_len - (int)trailer_len) <= 0)
  304. /* zero length packet with trailer data, just drop these */
  305. goto out;
  306. if (eid == ATH10K_HTC_EP_0) {
  307. struct ath10k_htc_msg *msg = (struct ath10k_htc_msg *)skb->data;
  308. switch (__le16_to_cpu(msg->hdr.message_id)) {
  309. case ATH10K_HTC_MSG_READY_ID:
  310. case ATH10K_HTC_MSG_CONNECT_SERVICE_RESP_ID:
  311. /* handle HTC control message */
  312. if (completion_done(&htc->ctl_resp)) {
  313. /*
  314. * this is a fatal error, target should not be
  315. * sending unsolicited messages on the ep 0
  316. */
  317. ath10k_warn(ar, "HTC rx ctrl still processing\n");
  318. complete(&htc->ctl_resp);
  319. goto out;
  320. }
  321. htc->control_resp_len =
  322. min_t(int, skb->len,
  323. ATH10K_HTC_MAX_CTRL_MSG_LEN);
  324. memcpy(htc->control_resp_buffer, skb->data,
  325. htc->control_resp_len);
  326. complete(&htc->ctl_resp);
  327. break;
  328. case ATH10K_HTC_MSG_SEND_SUSPEND_COMPLETE:
  329. htc->htc_ops.target_send_suspend_complete(ar);
  330. break;
  331. default:
  332. ath10k_warn(ar, "ignoring unsolicited htc ep0 event\n");
  333. break;
  334. }
  335. goto out;
  336. }
  337. ath10k_dbg(ar, ATH10K_DBG_HTC, "htc rx completion ep %d skb %pK\n",
  338. eid, skb);
  339. ep->ep_ops.ep_rx_complete(ar, skb);
  340. /* skb is now owned by the rx completion handler */
  341. skb = NULL;
  342. out:
  343. kfree_skb(skb);
  344. }
  345. EXPORT_SYMBOL(ath10k_htc_rx_completion_handler);
  346. static void ath10k_htc_control_rx_complete(struct ath10k *ar,
  347. struct sk_buff *skb)
  348. {
  349. /* This is unexpected. FW is not supposed to send regular rx on this
  350. * endpoint.
  351. */
  352. ath10k_warn(ar, "unexpected htc rx\n");
  353. kfree_skb(skb);
  354. }
  355. /***************/
  356. /* Init/Deinit */
  357. /***************/
  358. static const char *htc_service_name(enum ath10k_htc_svc_id id)
  359. {
  360. switch (id) {
  361. case ATH10K_HTC_SVC_ID_RESERVED:
  362. return "Reserved";
  363. case ATH10K_HTC_SVC_ID_RSVD_CTRL:
  364. return "Control";
  365. case ATH10K_HTC_SVC_ID_WMI_CONTROL:
  366. return "WMI";
  367. case ATH10K_HTC_SVC_ID_WMI_DATA_BE:
  368. return "DATA BE";
  369. case ATH10K_HTC_SVC_ID_WMI_DATA_BK:
  370. return "DATA BK";
  371. case ATH10K_HTC_SVC_ID_WMI_DATA_VI:
  372. return "DATA VI";
  373. case ATH10K_HTC_SVC_ID_WMI_DATA_VO:
  374. return "DATA VO";
  375. case ATH10K_HTC_SVC_ID_NMI_CONTROL:
  376. return "NMI Control";
  377. case ATH10K_HTC_SVC_ID_NMI_DATA:
  378. return "NMI Data";
  379. case ATH10K_HTC_SVC_ID_HTT_DATA_MSG:
  380. return "HTT Data";
  381. case ATH10K_HTC_SVC_ID_TEST_RAW_STREAMS:
  382. return "RAW";
  383. }
  384. return "Unknown";
  385. }
  386. static void ath10k_htc_reset_endpoint_states(struct ath10k_htc *htc)
  387. {
  388. struct ath10k_htc_ep *ep;
  389. int i;
  390. for (i = ATH10K_HTC_EP_0; i < ATH10K_HTC_EP_COUNT; i++) {
  391. ep = &htc->endpoint[i];
  392. ep->service_id = ATH10K_HTC_SVC_ID_UNUSED;
  393. ep->max_ep_message_len = 0;
  394. ep->max_tx_queue_depth = 0;
  395. ep->eid = i;
  396. ep->htc = htc;
  397. ep->tx_credit_flow_enabled = true;
  398. }
  399. }
  400. static u8 ath10k_htc_get_credit_allocation(struct ath10k_htc *htc,
  401. u16 service_id)
  402. {
  403. u8 allocation = 0;
  404. /* The WMI control service is the only service with flow control.
  405. * Let it have all transmit credits.
  406. */
  407. if (service_id == ATH10K_HTC_SVC_ID_WMI_CONTROL)
  408. allocation = htc->total_transmit_credits;
  409. return allocation;
  410. }
  411. int ath10k_htc_wait_target(struct ath10k_htc *htc)
  412. {
  413. struct ath10k *ar = htc->ar;
  414. int i, status = 0;
  415. unsigned long time_left;
  416. struct ath10k_htc_svc_conn_req conn_req;
  417. struct ath10k_htc_svc_conn_resp conn_resp;
  418. struct ath10k_htc_msg *msg;
  419. u16 message_id;
  420. u16 credit_count;
  421. u16 credit_size;
  422. time_left = wait_for_completion_timeout(&htc->ctl_resp,
  423. ATH10K_HTC_WAIT_TIMEOUT_HZ);
  424. if (!time_left) {
  425. /* Workaround: In some cases the PCI HIF doesn't
  426. * receive interrupt for the control response message
  427. * even if the buffer was completed. It is suspected
  428. * iomap writes unmasking PCI CE irqs aren't propagated
  429. * properly in KVM PCI-passthrough sometimes.
  430. */
  431. ath10k_warn(ar, "failed to receive control response completion, polling..\n");
  432. for (i = 0; i < CE_COUNT; i++)
  433. ath10k_hif_send_complete_check(htc->ar, i, 1);
  434. time_left =
  435. wait_for_completion_timeout(&htc->ctl_resp,
  436. ATH10K_HTC_WAIT_TIMEOUT_HZ);
  437. if (!time_left)
  438. status = -ETIMEDOUT;
  439. }
  440. if (status < 0) {
  441. ath10k_err(ar, "ctl_resp never came in (%d)\n", status);
  442. return status;
  443. }
  444. if (htc->control_resp_len < sizeof(msg->hdr) + sizeof(msg->ready)) {
  445. ath10k_err(ar, "Invalid HTC ready msg len:%d\n",
  446. htc->control_resp_len);
  447. return -ECOMM;
  448. }
  449. msg = (struct ath10k_htc_msg *)htc->control_resp_buffer;
  450. message_id = __le16_to_cpu(msg->hdr.message_id);
  451. credit_count = __le16_to_cpu(msg->ready.credit_count);
  452. credit_size = __le16_to_cpu(msg->ready.credit_size);
  453. if (message_id != ATH10K_HTC_MSG_READY_ID) {
  454. ath10k_err(ar, "Invalid HTC ready msg: 0x%x\n", message_id);
  455. return -ECOMM;
  456. }
  457. htc->total_transmit_credits = credit_count;
  458. htc->target_credit_size = credit_size;
  459. ath10k_dbg(ar, ATH10K_DBG_HTC,
  460. "Target ready! transmit resources: %d size:%d\n",
  461. htc->total_transmit_credits,
  462. htc->target_credit_size);
  463. if ((htc->total_transmit_credits == 0) ||
  464. (htc->target_credit_size == 0)) {
  465. ath10k_err(ar, "Invalid credit size received\n");
  466. return -ECOMM;
  467. }
  468. /* setup our pseudo HTC control endpoint connection */
  469. memset(&conn_req, 0, sizeof(conn_req));
  470. memset(&conn_resp, 0, sizeof(conn_resp));
  471. conn_req.ep_ops.ep_tx_complete = ath10k_htc_control_tx_complete;
  472. conn_req.ep_ops.ep_rx_complete = ath10k_htc_control_rx_complete;
  473. conn_req.max_send_queue_depth = ATH10K_NUM_CONTROL_TX_BUFFERS;
  474. conn_req.service_id = ATH10K_HTC_SVC_ID_RSVD_CTRL;
  475. /* connect fake service */
  476. status = ath10k_htc_connect_service(htc, &conn_req, &conn_resp);
  477. if (status) {
  478. ath10k_err(ar, "could not connect to htc service (%d)\n",
  479. status);
  480. return status;
  481. }
  482. return 0;
  483. }
  484. int ath10k_htc_connect_service(struct ath10k_htc *htc,
  485. struct ath10k_htc_svc_conn_req *conn_req,
  486. struct ath10k_htc_svc_conn_resp *conn_resp)
  487. {
  488. struct ath10k *ar = htc->ar;
  489. struct ath10k_htc_msg *msg;
  490. struct ath10k_htc_conn_svc *req_msg;
  491. struct ath10k_htc_conn_svc_response resp_msg_dummy;
  492. struct ath10k_htc_conn_svc_response *resp_msg = &resp_msg_dummy;
  493. enum ath10k_htc_ep_id assigned_eid = ATH10K_HTC_EP_COUNT;
  494. struct ath10k_htc_ep *ep;
  495. struct sk_buff *skb;
  496. unsigned int max_msg_size = 0;
  497. int length, status;
  498. unsigned long time_left;
  499. bool disable_credit_flow_ctrl = false;
  500. u16 message_id, service_id, flags = 0;
  501. u8 tx_alloc = 0;
  502. /* special case for HTC pseudo control service */
  503. if (conn_req->service_id == ATH10K_HTC_SVC_ID_RSVD_CTRL) {
  504. disable_credit_flow_ctrl = true;
  505. assigned_eid = ATH10K_HTC_EP_0;
  506. max_msg_size = ATH10K_HTC_MAX_CTRL_MSG_LEN;
  507. memset(&resp_msg_dummy, 0, sizeof(resp_msg_dummy));
  508. goto setup;
  509. }
  510. tx_alloc = ath10k_htc_get_credit_allocation(htc,
  511. conn_req->service_id);
  512. if (!tx_alloc)
  513. ath10k_dbg(ar, ATH10K_DBG_BOOT,
  514. "boot htc service %s does not allocate target credits\n",
  515. htc_service_name(conn_req->service_id));
  516. skb = ath10k_htc_build_tx_ctrl_skb(htc->ar);
  517. if (!skb) {
  518. ath10k_err(ar, "Failed to allocate HTC packet\n");
  519. return -ENOMEM;
  520. }
  521. length = sizeof(msg->hdr) + sizeof(msg->connect_service);
  522. skb_put(skb, length);
  523. memset(skb->data, 0, length);
  524. msg = (struct ath10k_htc_msg *)skb->data;
  525. msg->hdr.message_id =
  526. __cpu_to_le16(ATH10K_HTC_MSG_CONNECT_SERVICE_ID);
  527. flags |= SM(tx_alloc, ATH10K_HTC_CONN_FLAGS_RECV_ALLOC);
  528. /* Only enable credit flow control for WMI ctrl service */
  529. if (conn_req->service_id != ATH10K_HTC_SVC_ID_WMI_CONTROL) {
  530. flags |= ATH10K_HTC_CONN_FLAGS_DISABLE_CREDIT_FLOW_CTRL;
  531. disable_credit_flow_ctrl = true;
  532. }
  533. req_msg = &msg->connect_service;
  534. req_msg->flags = __cpu_to_le16(flags);
  535. req_msg->service_id = __cpu_to_le16(conn_req->service_id);
  536. reinit_completion(&htc->ctl_resp);
  537. status = ath10k_htc_send(htc, ATH10K_HTC_EP_0, skb);
  538. if (status) {
  539. kfree_skb(skb);
  540. return status;
  541. }
  542. /* wait for response */
  543. time_left = wait_for_completion_timeout(&htc->ctl_resp,
  544. ATH10K_HTC_CONN_SVC_TIMEOUT_HZ);
  545. if (!time_left) {
  546. ath10k_err(ar, "Service connect timeout\n");
  547. return -ETIMEDOUT;
  548. }
  549. /* we controlled the buffer creation, it's aligned */
  550. msg = (struct ath10k_htc_msg *)htc->control_resp_buffer;
  551. resp_msg = &msg->connect_service_response;
  552. message_id = __le16_to_cpu(msg->hdr.message_id);
  553. service_id = __le16_to_cpu(resp_msg->service_id);
  554. if ((message_id != ATH10K_HTC_MSG_CONNECT_SERVICE_RESP_ID) ||
  555. (htc->control_resp_len < sizeof(msg->hdr) +
  556. sizeof(msg->connect_service_response))) {
  557. ath10k_err(ar, "Invalid resp message ID 0x%x", message_id);
  558. return -EPROTO;
  559. }
  560. ath10k_dbg(ar, ATH10K_DBG_HTC,
  561. "HTC Service %s connect response: status: 0x%x, assigned ep: 0x%x\n",
  562. htc_service_name(service_id),
  563. resp_msg->status, resp_msg->eid);
  564. conn_resp->connect_resp_code = resp_msg->status;
  565. /* check response status */
  566. if (resp_msg->status != ATH10K_HTC_CONN_SVC_STATUS_SUCCESS) {
  567. ath10k_err(ar, "HTC Service %s connect request failed: 0x%x)\n",
  568. htc_service_name(service_id),
  569. resp_msg->status);
  570. return -EPROTO;
  571. }
  572. assigned_eid = (enum ath10k_htc_ep_id)resp_msg->eid;
  573. max_msg_size = __le16_to_cpu(resp_msg->max_msg_size);
  574. setup:
  575. if (assigned_eid >= ATH10K_HTC_EP_COUNT)
  576. return -EPROTO;
  577. if (max_msg_size == 0)
  578. return -EPROTO;
  579. ep = &htc->endpoint[assigned_eid];
  580. ep->eid = assigned_eid;
  581. if (ep->service_id != ATH10K_HTC_SVC_ID_UNUSED)
  582. return -EPROTO;
  583. /* return assigned endpoint to caller */
  584. conn_resp->eid = assigned_eid;
  585. conn_resp->max_msg_len = __le16_to_cpu(resp_msg->max_msg_size);
  586. /* setup the endpoint */
  587. ep->service_id = conn_req->service_id;
  588. ep->max_tx_queue_depth = conn_req->max_send_queue_depth;
  589. ep->max_ep_message_len = __le16_to_cpu(resp_msg->max_msg_size);
  590. ep->tx_credits = tx_alloc;
  591. /* copy all the callbacks */
  592. ep->ep_ops = conn_req->ep_ops;
  593. status = ath10k_hif_map_service_to_pipe(htc->ar,
  594. ep->service_id,
  595. &ep->ul_pipe_id,
  596. &ep->dl_pipe_id);
  597. if (status)
  598. return status;
  599. ath10k_dbg(ar, ATH10K_DBG_BOOT,
  600. "boot htc service '%s' ul pipe %d dl pipe %d eid %d ready\n",
  601. htc_service_name(ep->service_id), ep->ul_pipe_id,
  602. ep->dl_pipe_id, ep->eid);
  603. if (disable_credit_flow_ctrl && ep->tx_credit_flow_enabled) {
  604. ep->tx_credit_flow_enabled = false;
  605. ath10k_dbg(ar, ATH10K_DBG_BOOT,
  606. "boot htc service '%s' eid %d TX flow control disabled\n",
  607. htc_service_name(ep->service_id), assigned_eid);
  608. }
  609. return status;
  610. }
  611. struct sk_buff *ath10k_htc_alloc_skb(struct ath10k *ar, int size)
  612. {
  613. struct sk_buff *skb;
  614. skb = dev_alloc_skb(size + sizeof(struct ath10k_htc_hdr));
  615. if (!skb)
  616. return NULL;
  617. skb_reserve(skb, sizeof(struct ath10k_htc_hdr));
  618. /* FW/HTC requires 4-byte aligned streams */
  619. if (!IS_ALIGNED((unsigned long)skb->data, 4))
  620. ath10k_warn(ar, "Unaligned HTC tx skb\n");
  621. return skb;
  622. }
  623. int ath10k_htc_start(struct ath10k_htc *htc)
  624. {
  625. struct ath10k *ar = htc->ar;
  626. struct sk_buff *skb;
  627. int status = 0;
  628. struct ath10k_htc_msg *msg;
  629. skb = ath10k_htc_build_tx_ctrl_skb(htc->ar);
  630. if (!skb)
  631. return -ENOMEM;
  632. skb_put(skb, sizeof(msg->hdr) + sizeof(msg->setup_complete_ext));
  633. memset(skb->data, 0, skb->len);
  634. msg = (struct ath10k_htc_msg *)skb->data;
  635. msg->hdr.message_id =
  636. __cpu_to_le16(ATH10K_HTC_MSG_SETUP_COMPLETE_EX_ID);
  637. ath10k_dbg(ar, ATH10K_DBG_HTC, "HTC is using TX credit flow control\n");
  638. status = ath10k_htc_send(htc, ATH10K_HTC_EP_0, skb);
  639. if (status) {
  640. kfree_skb(skb);
  641. return status;
  642. }
  643. return 0;
  644. }
  645. /* registered target arrival callback from the HIF layer */
  646. int ath10k_htc_init(struct ath10k *ar)
  647. {
  648. struct ath10k_htc_ep *ep = NULL;
  649. struct ath10k_htc *htc = &ar->htc;
  650. spin_lock_init(&htc->tx_lock);
  651. ath10k_htc_reset_endpoint_states(htc);
  652. htc->ar = ar;
  653. /* Get HIF default pipe for HTC message exchange */
  654. ep = &htc->endpoint[ATH10K_HTC_EP_0];
  655. ath10k_hif_get_default_pipe(ar, &ep->ul_pipe_id, &ep->dl_pipe_id);
  656. init_completion(&htc->ctl_resp);
  657. return 0;
  658. }