pktlog_ac.c 27 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079
  1. /*
  2. * Copyright (c) 2012-2018 The Linux Foundation. All rights reserved.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for
  5. * any purpose with or without fee is hereby granted, provided that the
  6. * above copyright notice and this permission notice appear in all
  7. * copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  10. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  11. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  12. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  13. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  14. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  15. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  16. * PERFORMANCE OF THIS SOFTWARE.
  17. */
  18. /*
  19. *
  20. * Permission to use, copy, modify, and/or distribute this software for any
  21. * purpose with or without fee is hereby granted, provided that the above
  22. * copyright notice and this permission notice appear in all copies.
  23. *
  24. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  25. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  26. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  27. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  28. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  29. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  30. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  31. */
  32. #ifndef REMOVE_PKT_LOG
  33. #include "qdf_mem.h"
  34. #include "athdefs.h"
  35. #include "pktlog_ac_i.h"
  36. #include "cds_api.h"
  37. #include "wma_types.h"
  38. #include "htc.h"
  39. #include <cdp_txrx_cmn_struct.h>
  40. #include <cdp_txrx_ctrl.h>
  41. wdi_event_subscribe PKTLOG_TX_SUBSCRIBER;
  42. wdi_event_subscribe PKTLOG_RX_SUBSCRIBER;
  43. wdi_event_subscribe PKTLOG_RX_REMOTE_SUBSCRIBER;
  44. wdi_event_subscribe PKTLOG_RCFIND_SUBSCRIBER;
  45. wdi_event_subscribe PKTLOG_RCUPDATE_SUBSCRIBER;
  46. wdi_event_subscribe PKTLOG_SW_EVENT_SUBSCRIBER;
  47. wdi_event_subscribe PKTLOG_LITE_T2H_SUBSCRIBER;
  48. wdi_event_subscribe PKTLOG_LITE_RX_SUBSCRIBER;
  49. struct ol_pl_arch_dep_funcs ol_pl_funcs = {
  50. .pktlog_init = pktlog_init,
  51. .pktlog_enable = pktlog_enable,
  52. .pktlog_setsize = pktlog_setsize,
  53. .pktlog_disable = pktlog_disable, /* valid for f/w disable */
  54. };
  55. struct pktlog_dev_t pl_dev = {
  56. .pl_funcs = &ol_pl_funcs,
  57. };
  58. void pktlog_sethandle(struct pktlog_dev_t **pl_handle,
  59. struct hif_opaque_softc *scn)
  60. {
  61. pl_dev.scn = (ol_ath_generic_softc_handle) scn;
  62. *pl_handle = &pl_dev;
  63. }
  64. void pktlog_set_callback_regtype(
  65. enum pktlog_callback_regtype callback_type)
  66. {
  67. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  68. if (!pl_dev) {
  69. qdf_print("Invalid pl_dev");
  70. return;
  71. }
  72. pl_dev->callback_type = callback_type;
  73. }
  74. #ifdef CONFIG_MCL
  75. struct pktlog_dev_t *get_pktlog_handle(void)
  76. {
  77. struct cdp_pdev *pdev_txrx_handle =
  78. cds_get_context(QDF_MODULE_ID_TXRX);
  79. void *soc = cds_get_context(QDF_MODULE_ID_SOC);
  80. return cdp_get_pldev(soc, pdev_txrx_handle);
  81. }
  82. /*
  83. * Get current txrx context
  84. */
  85. void *get_txrx_context(void)
  86. {
  87. return cds_get_context(QDF_MODULE_ID_TXRX);
  88. }
  89. #else
  90. /* TODO: Need to use WIN implementation to return pktlog_dev handle */
  91. static inline struct pktlog_dev_t *get_pktlog_handle(void)
  92. {
  93. return NULL;
  94. }
  95. static struct pktlog_dev_t *get_txrx_context(void) { }
  96. #endif
  97. static A_STATUS pktlog_wma_post_msg(WMI_PKTLOG_EVENT event_types,
  98. WMI_CMD_ID cmd_id, bool ini_triggered,
  99. uint8_t user_triggered)
  100. {
  101. struct scheduler_msg msg = { 0 };
  102. QDF_STATUS status;
  103. struct ath_pktlog_wmi_params *param;
  104. param = qdf_mem_malloc(sizeof(struct ath_pktlog_wmi_params));
  105. if (!param)
  106. return A_NO_MEMORY;
  107. param->cmd_id = cmd_id;
  108. param->pktlog_event = event_types;
  109. param->ini_triggered = ini_triggered;
  110. param->user_triggered = user_triggered;
  111. msg.type = WMA_PKTLOG_ENABLE_REQ;
  112. msg.bodyptr = param;
  113. msg.bodyval = 0;
  114. status = scheduler_post_msg(QDF_MODULE_ID_WMA, &msg);
  115. if (status != QDF_STATUS_SUCCESS) {
  116. qdf_mem_free(param);
  117. return A_ERROR;
  118. }
  119. return A_OK;
  120. }
  121. static inline A_STATUS
  122. pktlog_enable_tgt(struct hif_opaque_softc *_scn, uint32_t log_state,
  123. bool ini_triggered, uint8_t user_triggered)
  124. {
  125. uint32_t types = 0;
  126. if (log_state & ATH_PKTLOG_TX)
  127. types |= WMI_PKTLOG_EVENT_TX;
  128. if (log_state & ATH_PKTLOG_RX)
  129. types |= WMI_PKTLOG_EVENT_RX;
  130. if (log_state & ATH_PKTLOG_RCFIND)
  131. types |= WMI_PKTLOG_EVENT_RCF;
  132. if (log_state & ATH_PKTLOG_RCUPDATE)
  133. types |= WMI_PKTLOG_EVENT_RCU;
  134. if (log_state & ATH_PKTLOG_SW_EVENT)
  135. types |= WMI_PKTLOG_EVENT_SW;
  136. return pktlog_wma_post_msg(types, WMI_PDEV_PKTLOG_ENABLE_CMDID,
  137. ini_triggered, user_triggered);
  138. }
  139. static inline A_STATUS
  140. wdi_pktlog_subscribe(struct cdp_pdev *cdp_pdev, int32_t log_state)
  141. {
  142. #ifdef CONFIG_MCL
  143. void *soc = cds_get_context(QDF_MODULE_ID_SOC);
  144. #else
  145. /*TODO: WIN implementation to get soc */
  146. #endif
  147. if (!cdp_pdev) {
  148. qdf_print("Invalid pdev in %s\n", __func__);
  149. return A_ERROR;
  150. }
  151. if (log_state & ATH_PKTLOG_TX) {
  152. if (cdp_wdi_event_sub(soc, cdp_pdev, &PKTLOG_TX_SUBSCRIBER,
  153. WDI_EVENT_TX_STATUS)) {
  154. return A_ERROR;
  155. }
  156. }
  157. if (log_state & ATH_PKTLOG_RX) {
  158. if (cdp_wdi_event_sub(soc, cdp_pdev, &PKTLOG_RX_SUBSCRIBER,
  159. WDI_EVENT_RX_DESC)) {
  160. return A_ERROR;
  161. }
  162. if (cdp_wdi_event_sub(soc, cdp_pdev,
  163. &PKTLOG_RX_REMOTE_SUBSCRIBER,
  164. WDI_EVENT_RX_DESC_REMOTE)) {
  165. return A_ERROR;
  166. }
  167. }
  168. if (log_state & ATH_PKTLOG_RCFIND) {
  169. if (cdp_wdi_event_sub(soc, cdp_pdev,
  170. &PKTLOG_RCFIND_SUBSCRIBER,
  171. WDI_EVENT_RATE_FIND)) {
  172. return A_ERROR;
  173. }
  174. }
  175. if (log_state & ATH_PKTLOG_RCUPDATE) {
  176. if (cdp_wdi_event_sub(soc, cdp_pdev,
  177. &PKTLOG_RCUPDATE_SUBSCRIBER,
  178. WDI_EVENT_RATE_UPDATE)) {
  179. return A_ERROR;
  180. }
  181. }
  182. if (log_state & ATH_PKTLOG_SW_EVENT) {
  183. if (cdp_wdi_event_sub(soc, cdp_pdev,
  184. &PKTLOG_SW_EVENT_SUBSCRIBER,
  185. WDI_EVENT_SW_EVENT)) {
  186. return A_ERROR;
  187. }
  188. }
  189. if (log_state & ATH_PKTLOG_LITE_T2H) {
  190. if (cdp_wdi_event_sub(soc, cdp_pdev,
  191. &PKTLOG_LITE_T2H_SUBSCRIBER,
  192. WDI_EVENT_LITE_T2H)) {
  193. return A_ERROR;
  194. }
  195. }
  196. if (log_state & ATH_PKTLOG_LITE_RX) {
  197. if (cdp_wdi_event_sub(soc, cdp_pdev,
  198. &PKTLOG_LITE_RX_SUBSCRIBER,
  199. WDI_EVENT_LITE_RX)) {
  200. return A_ERROR;
  201. }
  202. }
  203. return A_OK;
  204. }
  205. void pktlog_callback(void *pdev, enum WDI_EVENT event, void *log_data,
  206. u_int16_t peer_id, uint32_t status)
  207. {
  208. switch (event) {
  209. case WDI_EVENT_TX_STATUS:
  210. {
  211. /*
  212. * process TX message
  213. */
  214. if (process_tx_info(pdev, log_data)) {
  215. qdf_print("Unable to process TX info\n");
  216. return;
  217. }
  218. break;
  219. }
  220. case WDI_EVENT_RX_DESC:
  221. {
  222. /*
  223. * process RX message for local frames
  224. */
  225. if (process_rx_info(pdev, log_data)) {
  226. qdf_print("Unable to process RX info\n");
  227. return;
  228. }
  229. break;
  230. }
  231. case WDI_EVENT_RX_DESC_REMOTE:
  232. {
  233. /*
  234. * process RX message for remote frames
  235. */
  236. if (process_rx_info_remote(pdev, log_data)) {
  237. qdf_print("Unable to process RX info\n");
  238. return;
  239. }
  240. break;
  241. }
  242. case WDI_EVENT_RATE_FIND:
  243. {
  244. /*
  245. * process RATE_FIND message
  246. */
  247. if (process_rate_find(pdev, log_data)) {
  248. qdf_print("Unable to process RC_FIND info\n");
  249. return;
  250. }
  251. break;
  252. }
  253. case WDI_EVENT_RATE_UPDATE:
  254. {
  255. /*
  256. * process RATE_UPDATE message
  257. */
  258. if (process_rate_update(pdev, log_data)) {
  259. qdf_print("Unable to process RC_UPDATE\n");
  260. return;
  261. }
  262. break;
  263. }
  264. case WDI_EVENT_SW_EVENT:
  265. {
  266. /*
  267. * process SW EVENT message
  268. */
  269. if (process_sw_event(pdev, log_data)) {
  270. qdf_print("Unable to process SW_EVENT\n");
  271. return;
  272. }
  273. break;
  274. }
  275. default:
  276. break;
  277. }
  278. }
  279. void
  280. lit_pktlog_callback(void *context, enum WDI_EVENT event, void *log_data,
  281. u_int16_t peer_id, uint32_t status)
  282. {
  283. switch (event) {
  284. case WDI_EVENT_RX_DESC:
  285. {
  286. if (process_rx_desc_remote(context, log_data)) {
  287. qdf_print("Unable to process RX info\n");
  288. return;
  289. }
  290. break;
  291. }
  292. case WDI_EVENT_LITE_T2H:
  293. {
  294. if (process_pktlog_lite(context, log_data,
  295. PKTLOG_TYPE_LITE_T2H)) {
  296. qdf_print("Unable to process lite_t2h\n");
  297. return;
  298. }
  299. break;
  300. }
  301. case WDI_EVENT_LITE_RX:
  302. {
  303. if (process_pktlog_lite(context, log_data,
  304. PKTLOG_TYPE_LITE_RX)) {
  305. qdf_print("Unable to process lite_rx\n");
  306. return;
  307. }
  308. break;
  309. }
  310. default:
  311. break;
  312. }
  313. }
  314. A_STATUS
  315. wdi_pktlog_unsubscribe(struct cdp_pdev *pdev, uint32_t log_state)
  316. {
  317. #ifdef CONFIG_MCL
  318. void *soc = cds_get_context(QDF_MODULE_ID_SOC);
  319. #else
  320. /* TODO: WIN implementation to get soc */
  321. #endif
  322. if (log_state & ATH_PKTLOG_TX) {
  323. if (cdp_wdi_event_unsub(soc, pdev,
  324. &PKTLOG_TX_SUBSCRIBER,
  325. WDI_EVENT_TX_STATUS)) {
  326. return A_ERROR;
  327. }
  328. }
  329. if (log_state & ATH_PKTLOG_RX) {
  330. if (cdp_wdi_event_unsub(soc, pdev,
  331. &PKTLOG_RX_SUBSCRIBER, WDI_EVENT_RX_DESC)) {
  332. return A_ERROR;
  333. }
  334. if (cdp_wdi_event_unsub(soc, pdev,
  335. &PKTLOG_RX_REMOTE_SUBSCRIBER,
  336. WDI_EVENT_RX_DESC_REMOTE)) {
  337. return A_ERROR;
  338. }
  339. }
  340. if (log_state & ATH_PKTLOG_RCFIND) {
  341. if (cdp_wdi_event_unsub(soc, pdev,
  342. &PKTLOG_RCFIND_SUBSCRIBER,
  343. WDI_EVENT_RATE_FIND)) {
  344. return A_ERROR;
  345. }
  346. }
  347. if (log_state & ATH_PKTLOG_RCUPDATE) {
  348. if (cdp_wdi_event_unsub(soc, pdev,
  349. &PKTLOG_RCUPDATE_SUBSCRIBER,
  350. WDI_EVENT_RATE_UPDATE)) {
  351. return A_ERROR;
  352. }
  353. }
  354. if (log_state & ATH_PKTLOG_RCUPDATE) {
  355. if (cdp_wdi_event_unsub(soc, pdev,
  356. &PKTLOG_SW_EVENT_SUBSCRIBER,
  357. WDI_EVENT_SW_EVENT)) {
  358. return A_ERROR;
  359. }
  360. }
  361. if (log_state & ATH_PKTLOG_LITE_T2H) {
  362. if (cdp_wdi_event_unsub(soc, pdev,
  363. &PKTLOG_LITE_T2H_SUBSCRIBER,
  364. WDI_EVENT_LITE_T2H)) {
  365. return A_ERROR;
  366. }
  367. }
  368. if (log_state & ATH_PKTLOG_LITE_RX) {
  369. if (cdp_wdi_event_unsub(soc, pdev,
  370. &PKTLOG_LITE_RX_SUBSCRIBER,
  371. WDI_EVENT_LITE_RX)) {
  372. return A_ERROR;
  373. }
  374. }
  375. return A_OK;
  376. }
  377. int pktlog_disable(struct hif_opaque_softc *scn)
  378. {
  379. struct pktlog_dev_t *pl_dev;
  380. struct ath_pktlog_info *pl_info;
  381. uint8_t save_pktlog_state;
  382. struct cdp_pdev *txrx_pdev = get_txrx_context();
  383. pl_dev = get_pktlog_handle();
  384. if (!pl_dev) {
  385. qdf_print("Invalid pl_dev");
  386. return -EINVAL;
  387. }
  388. pl_info = pl_dev->pl_info;
  389. if (!pl_dev->pl_info) {
  390. qdf_print("Invalid pl_info");
  391. return -EINVAL;
  392. }
  393. if (!txrx_pdev) {
  394. qdf_print("Invalid cdp_pdev");
  395. return -EINVAL;
  396. }
  397. if (pl_info->curr_pkt_state == PKTLOG_OPR_IN_PROGRESS ||
  398. pl_info->curr_pkt_state ==
  399. PKTLOG_OPR_IN_PROGRESS_READ_START_PKTLOG_DISABLED ||
  400. pl_info->curr_pkt_state == PKTLOG_OPR_IN_PROGRESS_READ_COMPLETE ||
  401. pl_info->curr_pkt_state ==
  402. PKTLOG_OPR_IN_PROGRESS_CLEARBUFF_COMPLETE)
  403. return -EBUSY;
  404. save_pktlog_state = pl_info->curr_pkt_state;
  405. pl_info->curr_pkt_state = PKTLOG_OPR_IN_PROGRESS;
  406. if (pktlog_wma_post_msg(0, WMI_PDEV_PKTLOG_DISABLE_CMDID, 0, 0)) {
  407. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  408. qdf_print("Failed to disable pktlog in target\n");
  409. return -EINVAL;
  410. }
  411. if (pl_dev->is_pktlog_cb_subscribed &&
  412. wdi_pktlog_unsubscribe(txrx_pdev, pl_info->log_state)) {
  413. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  414. qdf_print("Cannot unsubscribe pktlog from the WDI\n");
  415. return -EINVAL;
  416. }
  417. pl_dev->is_pktlog_cb_subscribed = false;
  418. if (save_pktlog_state == PKTLOG_OPR_IN_PROGRESS_READ_START)
  419. pl_info->curr_pkt_state =
  420. PKTLOG_OPR_IN_PROGRESS_READ_START_PKTLOG_DISABLED;
  421. else
  422. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  423. return 0;
  424. }
  425. void pktlog_init(struct hif_opaque_softc *scn)
  426. {
  427. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  428. struct ath_pktlog_info *pl_info;
  429. if (pl_dev == NULL || pl_dev->pl_info == NULL) {
  430. qdf_print("pl_dev or pl_info is invalid\n");
  431. return;
  432. }
  433. pl_info = pl_dev->pl_info;
  434. OS_MEMZERO(pl_info, sizeof(*pl_info));
  435. PKTLOG_LOCK_INIT(pl_info);
  436. mutex_init(&pl_info->pktlog_mutex);
  437. pl_info->buf_size = PKTLOG_DEFAULT_BUFSIZE;
  438. pl_info->buf = NULL;
  439. pl_info->log_state = 0;
  440. pl_info->init_saved_state = 0;
  441. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  442. pl_info->sack_thr = PKTLOG_DEFAULT_SACK_THR;
  443. pl_info->tail_length = PKTLOG_DEFAULT_TAIL_LENGTH;
  444. pl_info->thruput_thresh = PKTLOG_DEFAULT_THRUPUT_THRESH;
  445. pl_info->per_thresh = PKTLOG_DEFAULT_PER_THRESH;
  446. pl_info->phyerr_thresh = PKTLOG_DEFAULT_PHYERR_THRESH;
  447. pl_info->trigger_interval = PKTLOG_DEFAULT_TRIGGER_INTERVAL;
  448. pl_info->pktlen = 0;
  449. pl_info->start_time_thruput = 0;
  450. pl_info->start_time_per = 0;
  451. pl_dev->vendor_cmd_send = false;
  452. if (pl_dev->callback_type == PKTLOG_DEFAULT_CALLBACK_REGISTRATION) {
  453. PKTLOG_TX_SUBSCRIBER.callback = pktlog_callback;
  454. PKTLOG_RX_SUBSCRIBER.callback = pktlog_callback;
  455. PKTLOG_RX_REMOTE_SUBSCRIBER.callback = pktlog_callback;
  456. PKTLOG_RCFIND_SUBSCRIBER.callback = pktlog_callback;
  457. PKTLOG_RCUPDATE_SUBSCRIBER.callback = pktlog_callback;
  458. PKTLOG_SW_EVENT_SUBSCRIBER.callback = pktlog_callback;
  459. } else if (pl_dev->callback_type == PKTLOG_LITE_CALLBACK_REGISTRATION) {
  460. PKTLOG_LITE_T2H_SUBSCRIBER.callback = lit_pktlog_callback;
  461. PKTLOG_LITE_RX_SUBSCRIBER.callback = lit_pktlog_callback;
  462. }
  463. }
  464. static int __pktlog_enable(struct hif_opaque_softc *scn, int32_t log_state,
  465. bool ini_triggered, uint8_t user_triggered,
  466. uint32_t is_iwpriv_command)
  467. {
  468. struct pktlog_dev_t *pl_dev;
  469. struct ath_pktlog_info *pl_info;
  470. struct cdp_pdev *cdp_pdev;
  471. int error;
  472. if (!scn) {
  473. qdf_print("%s: Invalid scn context\n", __func__);
  474. ASSERT(0);
  475. return -EINVAL;
  476. }
  477. pl_dev = get_pktlog_handle();
  478. if (!pl_dev) {
  479. qdf_print("%s: Invalid pktlog context\n", __func__);
  480. ASSERT(0);
  481. return -EINVAL;
  482. }
  483. cdp_pdev = get_txrx_context();
  484. if (!cdp_pdev) {
  485. qdf_print("%s: Invalid txrx context\n", __func__);
  486. ASSERT(0);
  487. return -EINVAL;
  488. }
  489. pl_info = pl_dev->pl_info;
  490. if (!pl_info) {
  491. qdf_print("%s: Invalid pl_info context\n", __func__);
  492. ASSERT(0);
  493. return -EINVAL;
  494. }
  495. if (pl_info->curr_pkt_state < PKTLOG_OPR_IN_PROGRESS_CLEARBUFF_COMPLETE)
  496. return -EBUSY;
  497. pl_info->curr_pkt_state = PKTLOG_OPR_IN_PROGRESS;
  498. /* is_iwpriv_command : 0 indicates its a vendor command
  499. * log_state: 0 indicates pktlog disable command
  500. * vendor_cmd_send flag; false means no vendor pktlog enable
  501. * command was sent previously
  502. */
  503. if (is_iwpriv_command == 0 && log_state == 0 &&
  504. pl_dev->vendor_cmd_send == false) {
  505. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  506. qdf_print("%s: pktlog operation not in progress\n", __func__);
  507. return 0;
  508. }
  509. if (!pl_dev->tgt_pktlog_alloced) {
  510. if (pl_info->buf == NULL) {
  511. error = pktlog_alloc_buf(scn);
  512. if (error != 0) {
  513. pl_info->curr_pkt_state =
  514. PKTLOG_OPR_NOT_IN_PROGRESS;
  515. qdf_print("%s: pktlog buff alloc failed\n",
  516. __func__);
  517. return -ENOMEM;
  518. }
  519. if (!pl_info->buf) {
  520. pl_info->curr_pkt_state =
  521. PKTLOG_OPR_NOT_IN_PROGRESS;
  522. qdf_print("%s: pktlog buf alloc failed\n",
  523. __func__);
  524. ASSERT(0);
  525. return -ENOMEM;
  526. }
  527. }
  528. spin_lock_bh(&pl_info->log_lock);
  529. pl_info->buf->bufhdr.version = CUR_PKTLOG_VER;
  530. pl_info->buf->bufhdr.magic_num = PKTLOG_MAGIC_NUM;
  531. pl_info->buf->wr_offset = 0;
  532. pl_info->buf->rd_offset = -1;
  533. /* These below variables are used by per packet stats*/
  534. pl_info->buf->bytes_written = 0;
  535. pl_info->buf->msg_index = 1;
  536. pl_info->buf->offset = PKTLOG_READ_OFFSET;
  537. spin_unlock_bh(&pl_info->log_lock);
  538. pl_info->start_time_thruput = os_get_timestamp();
  539. pl_info->start_time_per = pl_info->start_time_thruput;
  540. pl_dev->tgt_pktlog_alloced = true;
  541. }
  542. if (log_state != 0) {
  543. /* WDI subscribe */
  544. if (!pl_dev->is_pktlog_cb_subscribed) {
  545. error = wdi_pktlog_subscribe(cdp_pdev, log_state);
  546. if (error) {
  547. pl_info->curr_pkt_state =
  548. PKTLOG_OPR_NOT_IN_PROGRESS;
  549. qdf_print("Unable to subscribe to the WDI %s\n",
  550. __func__);
  551. return -EINVAL;
  552. }
  553. } else {
  554. qdf_print("Unable to subscribe %d to the WDI %s\n",
  555. log_state, __func__);
  556. return -EINVAL;
  557. }
  558. /* WMI command to enable pktlog on the firmware */
  559. if (pktlog_enable_tgt(scn, log_state, ini_triggered,
  560. user_triggered)) {
  561. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  562. qdf_print("Device cannot be enabled, %s\n", __func__);
  563. return -EINVAL;
  564. }
  565. pl_dev->is_pktlog_cb_subscribed = true;
  566. if (is_iwpriv_command == 0)
  567. pl_dev->vendor_cmd_send = true;
  568. } else {
  569. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  570. pl_dev->pl_funcs->pktlog_disable(scn);
  571. if (is_iwpriv_command == 0)
  572. pl_dev->vendor_cmd_send = false;
  573. }
  574. pl_info->log_state = log_state;
  575. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  576. return 0;
  577. }
  578. int pktlog_enable(struct hif_opaque_softc *scn, int32_t log_state,
  579. bool ini_triggered, uint8_t user_triggered,
  580. uint32_t is_iwpriv_command)
  581. {
  582. struct pktlog_dev_t *pl_dev;
  583. struct ath_pktlog_info *pl_info;
  584. int err;
  585. pl_dev = get_pktlog_handle();
  586. if (!pl_dev) {
  587. qdf_print("%s: invalid pl_dev handle", __func__);
  588. return -EINVAL;
  589. }
  590. pl_info = pl_dev->pl_info;
  591. if (!pl_info) {
  592. qdf_print("%s: invalid pl_info handle", __func__);
  593. return -EINVAL;
  594. }
  595. mutex_lock(&pl_info->pktlog_mutex);
  596. err = __pktlog_enable(scn, log_state, ini_triggered,
  597. user_triggered, is_iwpriv_command);
  598. mutex_unlock(&pl_info->pktlog_mutex);
  599. return err;
  600. }
  601. #define ONE_MEGABYTE (1024 * 1024)
  602. #define MAX_ALLOWED_PKTLOG_SIZE (16 * ONE_MEGABYTE)
  603. static int __pktlog_setsize(struct hif_opaque_softc *scn, int32_t size)
  604. {
  605. struct pktlog_dev_t *pl_dev;
  606. struct ath_pktlog_info *pl_info;
  607. struct cdp_pdev *pdev;
  608. pl_dev = get_pktlog_handle();
  609. if (!pl_dev) {
  610. qdf_print("%s: invalid pl_dev handle", __func__);
  611. return -EINVAL;
  612. }
  613. pl_info = pl_dev->pl_info;
  614. if (!pl_info) {
  615. qdf_print("%s: invalid pl_dev handle", __func__);
  616. return -EINVAL;
  617. }
  618. pdev = get_txrx_context();
  619. if (!pdev) {
  620. qdf_print("%s: invalid pdev handle", __func__);
  621. return -EINVAL;
  622. }
  623. if (pl_info->curr_pkt_state < PKTLOG_OPR_NOT_IN_PROGRESS) {
  624. qdf_print("%s: pktlog is not configured", __func__);
  625. return -EBUSY;
  626. }
  627. pl_info->curr_pkt_state = PKTLOG_OPR_IN_PROGRESS;
  628. if (size < ONE_MEGABYTE || size > MAX_ALLOWED_PKTLOG_SIZE) {
  629. qdf_print("%s: Cannot Set Pktlog Buffer size of %d bytes."
  630. "Min required is %d MB and Max allowed is %d MB.\n",
  631. __func__, size, (ONE_MEGABYTE/ONE_MEGABYTE),
  632. (MAX_ALLOWED_PKTLOG_SIZE/ONE_MEGABYTE));
  633. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  634. qdf_print("%s: Invalid requested buff size", __func__);
  635. return -EINVAL;
  636. }
  637. if (size == pl_info->buf_size) {
  638. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  639. qdf_print("%s: Pktlog Buff Size is already of same size.",
  640. __func__);
  641. return 0;
  642. }
  643. if (pl_info->log_state) {
  644. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  645. qdf_print("%s: Logging should be disabled before changing"
  646. "buffer size.", __func__);
  647. return -EINVAL;
  648. }
  649. spin_lock_bh(&pl_info->log_lock);
  650. if (pl_info->buf != NULL) {
  651. if (pl_dev->is_pktlog_cb_subscribed &&
  652. wdi_pktlog_unsubscribe(pdev, pl_info->log_state)) {
  653. pl_info->curr_pkt_state =
  654. PKTLOG_OPR_NOT_IN_PROGRESS;
  655. qdf_print("Cannot unsubscribe pktlog from the WDI\n");
  656. spin_unlock_bh(&pl_info->log_lock);
  657. return -EFAULT;
  658. }
  659. pktlog_release_buf(scn);
  660. pl_dev->is_pktlog_cb_subscribed = false;
  661. pl_dev->tgt_pktlog_alloced = false;
  662. }
  663. if (size != 0) {
  664. qdf_print("%s: New Pktlog Buff Size is %d\n", __func__, size);
  665. pl_info->buf_size = size;
  666. }
  667. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  668. spin_unlock_bh(&pl_info->log_lock);
  669. return 0;
  670. }
  671. int pktlog_setsize(struct hif_opaque_softc *scn, int32_t size)
  672. {
  673. struct pktlog_dev_t *pl_dev;
  674. struct ath_pktlog_info *pl_info;
  675. int status;
  676. pl_dev = get_pktlog_handle();
  677. if (!pl_dev) {
  678. qdf_print("%s: invalid pl_dev handle", __func__);
  679. return -EINVAL;
  680. }
  681. pl_info = pl_dev->pl_info;
  682. if (!pl_info) {
  683. qdf_print("%s: invalid pl_dev handle", __func__);
  684. return -EINVAL;
  685. }
  686. mutex_lock(&pl_info->pktlog_mutex);
  687. status = __pktlog_setsize(scn, size);
  688. mutex_unlock(&pl_info->pktlog_mutex);
  689. return status;
  690. }
  691. int pktlog_clearbuff(struct hif_opaque_softc *scn, bool clear_buff)
  692. {
  693. struct pktlog_dev_t *pl_dev;
  694. struct ath_pktlog_info *pl_info;
  695. uint8_t save_pktlog_state;
  696. pl_dev = get_pktlog_handle();
  697. if (!pl_dev) {
  698. qdf_print("%s: invalid pl_dev handle", __func__);
  699. return -EINVAL;
  700. }
  701. pl_info = pl_dev->pl_info;
  702. if (!pl_info) {
  703. qdf_print("%s: invalid pl_dev handle", __func__);
  704. return -EINVAL;
  705. }
  706. if (!clear_buff)
  707. return -EINVAL;
  708. if (pl_info->curr_pkt_state < PKTLOG_OPR_IN_PROGRESS_READ_COMPLETE ||
  709. pl_info->curr_pkt_state ==
  710. PKTLOG_OPR_IN_PROGRESS_CLEARBUFF_COMPLETE)
  711. return -EBUSY;
  712. save_pktlog_state = pl_info->curr_pkt_state;
  713. pl_info->curr_pkt_state = PKTLOG_OPR_IN_PROGRESS;
  714. if (pl_info->log_state) {
  715. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  716. qdf_print("%s: Logging should be disabled before clearing "
  717. "pktlog buffer.", __func__);
  718. return -EINVAL;
  719. }
  720. if (pl_info->buf != NULL) {
  721. if (pl_info->buf_size > 0) {
  722. qdf_print("%s: pktlog buffer is cleared.", __func__);
  723. memset(pl_info->buf, 0, pl_info->buf_size);
  724. pl_dev->is_pktlog_cb_subscribed = false;
  725. pl_dev->tgt_pktlog_alloced = false;
  726. pl_info->buf->rd_offset = -1;
  727. } else {
  728. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  729. qdf_print("%s: pktlog buffer size is not proper. "
  730. "Existing Buf size %d", __func__,
  731. pl_info->buf_size);
  732. return -EFAULT;
  733. }
  734. } else {
  735. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  736. qdf_print("%s: pktlog buff is NULL", __func__);
  737. return -EFAULT;
  738. }
  739. if (save_pktlog_state == PKTLOG_OPR_IN_PROGRESS_READ_COMPLETE)
  740. pl_info->curr_pkt_state =
  741. PKTLOG_OPR_IN_PROGRESS_CLEARBUFF_COMPLETE;
  742. else
  743. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  744. return 0;
  745. }
  746. /**
  747. * pktlog_process_fw_msg() - process packetlog message
  748. * @buff: buffer
  749. *
  750. * Return: None
  751. */
  752. void pktlog_process_fw_msg(uint32_t *buff, uint32_t len)
  753. {
  754. uint32_t *pl_hdr;
  755. uint32_t log_type;
  756. struct cdp_pdev *pdev = get_txrx_context();
  757. struct ol_fw_data pl_fw_data;
  758. if (!pdev) {
  759. qdf_print("%s: txrx_pdev is NULL", __func__);
  760. return;
  761. }
  762. pl_hdr = buff;
  763. pl_fw_data.data = pl_hdr;
  764. pl_fw_data.len = len;
  765. log_type =
  766. (*(pl_hdr + 1) & ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  767. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  768. if ((log_type == PKTLOG_TYPE_TX_CTRL)
  769. || (log_type == PKTLOG_TYPE_TX_STAT)
  770. || (log_type == PKTLOG_TYPE_TX_MSDU_ID)
  771. || (log_type == PKTLOG_TYPE_TX_FRM_HDR)
  772. || (log_type == PKTLOG_TYPE_TX_VIRT_ADDR))
  773. wdi_event_handler(WDI_EVENT_TX_STATUS,
  774. pdev, &pl_fw_data);
  775. else if (log_type == PKTLOG_TYPE_RC_FIND)
  776. wdi_event_handler(WDI_EVENT_RATE_FIND,
  777. pdev, &pl_fw_data);
  778. else if (log_type == PKTLOG_TYPE_RC_UPDATE)
  779. wdi_event_handler(WDI_EVENT_RATE_UPDATE,
  780. pdev, &pl_fw_data);
  781. else if (log_type == PKTLOG_TYPE_RX_STAT)
  782. wdi_event_handler(WDI_EVENT_RX_DESC,
  783. pdev, &pl_fw_data);
  784. else if (log_type == PKTLOG_TYPE_SW_EVENT)
  785. wdi_event_handler(WDI_EVENT_SW_EVENT,
  786. pdev, &pl_fw_data);
  787. }
  788. #if defined(QCA_WIFI_3_0_ADRASTEA)
  789. static inline int pktlog_nbuf_check_sanity(qdf_nbuf_t nbuf)
  790. {
  791. int rc = 0; /* sane */
  792. if ((!nbuf) ||
  793. (nbuf->data < nbuf->head) ||
  794. ((nbuf->data + skb_headlen(nbuf)) > skb_end_pointer(nbuf)))
  795. rc = -EINVAL;
  796. return rc;
  797. }
  798. /**
  799. * pktlog_t2h_msg_handler() - Target to host message handler
  800. * @context: pdev context
  801. * @pkt: HTC packet
  802. *
  803. * Return: None
  804. */
  805. static void pktlog_t2h_msg_handler(void *context, HTC_PACKET *pkt)
  806. {
  807. struct pktlog_dev_t *pdev = (struct pktlog_dev_t *)context;
  808. qdf_nbuf_t pktlog_t2h_msg = (qdf_nbuf_t) pkt->pPktContext;
  809. uint32_t *msg_word;
  810. uint32_t msg_len;
  811. /* check for sanity of the packet, have seen corrupted pkts */
  812. if (pktlog_nbuf_check_sanity(pktlog_t2h_msg)) {
  813. qdf_print("%s: packet 0x%pK corrupted? Leaking...",
  814. __func__, pktlog_t2h_msg);
  815. /* do not free; may crash! */
  816. QDF_ASSERT(0);
  817. return;
  818. }
  819. /* check for successful message reception */
  820. if (pkt->Status != QDF_STATUS_SUCCESS) {
  821. if (pkt->Status != QDF_STATUS_E_CANCELED)
  822. pdev->htc_err_cnt++;
  823. qdf_nbuf_free(pktlog_t2h_msg);
  824. return;
  825. }
  826. /* confirm alignment */
  827. qdf_assert((((unsigned long)qdf_nbuf_data(pktlog_t2h_msg)) & 0x3) == 0);
  828. msg_word = (uint32_t *) qdf_nbuf_data(pktlog_t2h_msg);
  829. msg_len = qdf_nbuf_len(pktlog_t2h_msg);
  830. pktlog_process_fw_msg(msg_word, msg_len);
  831. qdf_nbuf_free(pktlog_t2h_msg);
  832. }
  833. /**
  834. * pktlog_tx_resume_handler() - resume callback
  835. * @context: pdev context
  836. *
  837. * Return: None
  838. */
  839. static void pktlog_tx_resume_handler(void *context)
  840. {
  841. qdf_print("%s: Not expected", __func__);
  842. qdf_assert(0);
  843. }
  844. /**
  845. * pktlog_h2t_send_complete() - send complete indication
  846. * @context: pdev context
  847. * @htc_pkt: HTC packet
  848. *
  849. * Return: None
  850. */
  851. static void pktlog_h2t_send_complete(void *context, HTC_PACKET *htc_pkt)
  852. {
  853. qdf_print("%s: Not expected", __func__);
  854. qdf_assert(0);
  855. }
  856. /**
  857. * pktlog_h2t_full() - queue full indication
  858. * @context: pdev context
  859. * @pkt: HTC packet
  860. *
  861. * Return: HTC action
  862. */
  863. static enum htc_send_full_action pktlog_h2t_full(void *context, HTC_PACKET *pkt)
  864. {
  865. return HTC_SEND_FULL_KEEP;
  866. }
  867. /**
  868. * pktlog_htc_connect_service() - create new endpoint for packetlog
  869. * @pdev - pktlog pdev
  870. *
  871. * Return: 0 for success/failure
  872. */
  873. static int pktlog_htc_connect_service(struct pktlog_dev_t *pdev)
  874. {
  875. struct htc_service_connect_req connect;
  876. struct htc_service_connect_resp response;
  877. QDF_STATUS status;
  878. qdf_mem_set(&connect, sizeof(connect), 0);
  879. qdf_mem_set(&response, sizeof(response), 0);
  880. connect.pMetaData = NULL;
  881. connect.MetaDataLength = 0;
  882. connect.EpCallbacks.pContext = pdev;
  883. connect.EpCallbacks.EpTxComplete = pktlog_h2t_send_complete;
  884. connect.EpCallbacks.EpTxCompleteMultiple = NULL;
  885. connect.EpCallbacks.EpRecv = pktlog_t2h_msg_handler;
  886. connect.EpCallbacks.ep_resume_tx_queue = pktlog_tx_resume_handler;
  887. /* rx buffers currently are provided by HIF, not by EpRecvRefill */
  888. connect.EpCallbacks.EpRecvRefill = NULL;
  889. connect.EpCallbacks.RecvRefillWaterMark = 1;
  890. /* N/A, fill is done by HIF */
  891. connect.EpCallbacks.EpSendFull = pktlog_h2t_full;
  892. /*
  893. * Specify how deep to let a queue get before htc_send_pkt will
  894. * call the EpSendFull function due to excessive send queue depth.
  895. */
  896. connect.MaxSendQueueDepth = PKTLOG_MAX_SEND_QUEUE_DEPTH;
  897. /* disable flow control for HTT data message service */
  898. connect.ConnectionFlags |= HTC_CONNECT_FLAGS_DISABLE_CREDIT_FLOW_CTRL;
  899. /* connect to control service */
  900. connect.service_id = PACKET_LOG_SVC;
  901. status = htc_connect_service(pdev->htc_pdev, &connect, &response);
  902. if (status != QDF_STATUS_SUCCESS) {
  903. pdev->mt_pktlog_enabled = false;
  904. return -EIO; /* failure */
  905. }
  906. pdev->htc_endpoint = response.Endpoint;
  907. pdev->mt_pktlog_enabled = true;
  908. return 0; /* success */
  909. }
  910. /**
  911. * pktlog_htc_attach() - attach pktlog HTC service
  912. *
  913. * Return: 0 for success/failure
  914. */
  915. int pktlog_htc_attach(void)
  916. {
  917. struct pktlog_dev_t *pl_pdev = get_pktlog_handle();
  918. void *htc_pdev = cds_get_context(QDF_MODULE_ID_HTC);
  919. if ((!pl_pdev) || (!htc_pdev)) {
  920. qdf_print("Invalid pl_dev or htc_pdev handle");
  921. return -EINVAL;
  922. }
  923. pl_pdev->htc_pdev = htc_pdev;
  924. return pktlog_htc_connect_service(pl_pdev);
  925. }
  926. #else
  927. int pktlog_htc_attach(void)
  928. {
  929. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  930. if (!pl_dev) {
  931. qdf_print("Invalid pl_dev handle");
  932. return -EINVAL;
  933. }
  934. pl_dev->mt_pktlog_enabled = false;
  935. return 0;
  936. }
  937. #endif
  938. #endif /* REMOVE_PKT_LOG */