pktlog_internal.c 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877
  1. /*
  2. * Copyright (c) 2013-2017 The Linux Foundation. All rights reserved.
  3. *
  4. * Previously licensed under the ISC license by Qualcomm Atheros, Inc.
  5. *
  6. *
  7. * Permission to use, copy, modify, and/or distribute this software for
  8. * any purpose with or without fee is hereby granted, provided that the
  9. * above copyright notice and this permission notice appear in all
  10. * copies.
  11. *
  12. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  13. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  14. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  15. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  16. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  17. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  18. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  19. * PERFORMANCE OF THIS SOFTWARE.
  20. */
  21. /*
  22. * This file was originally distributed by Qualcomm Atheros, Inc.
  23. * under proprietary terms before Copyright ownership was assigned
  24. * to the Linux Foundation.
  25. */
  26. /*
  27. *
  28. * Permission to use, copy, modify, and/or distribute this software for any
  29. * purpose with or without fee is hereby granted, provided that the above
  30. * copyright notice and this permission notice appear in all copies.
  31. *
  32. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  33. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  34. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  35. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  36. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  37. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  38. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  39. */
  40. #ifndef REMOVE_PKT_LOG
  41. #include "ol_txrx_types.h"
  42. #include "ol_htt_tx_api.h"
  43. #include "ol_tx_desc.h"
  44. #include "qdf_mem.h"
  45. #include "htt.h"
  46. #include "htt_internal.h"
  47. #include "pktlog_ac_i.h"
  48. #include "wma_api.h"
  49. #include "wlan_logging_sock_svc.h"
  50. #define TX_DESC_ID_LOW_MASK 0xffff
  51. #define TX_DESC_ID_LOW_SHIFT 0
  52. #define TX_DESC_ID_HIGH_MASK 0xffff0000
  53. #define TX_DESC_ID_HIGH_SHIFT 16
  54. void pktlog_getbuf_intsafe(struct ath_pktlog_arg *plarg)
  55. {
  56. struct ath_pktlog_buf *log_buf;
  57. int32_t buf_size;
  58. struct ath_pktlog_hdr *log_hdr;
  59. int32_t cur_wr_offset;
  60. char *log_ptr;
  61. struct ath_pktlog_info *pl_info;
  62. uint16_t log_type;
  63. size_t log_size;
  64. uint32_t flags;
  65. #ifdef HELIUMPLUS
  66. uint8_t mac_id;
  67. #endif
  68. if (!plarg) {
  69. printk("Invalid parg in %s\n", __func__);
  70. return;
  71. }
  72. pl_info = plarg->pl_info;
  73. #ifdef HELIUMPLUS
  74. mac_id = plarg->macId;
  75. log_type = plarg->log_type;
  76. #else
  77. log_type = plarg->log_type;
  78. #endif
  79. log_size = plarg->log_size;
  80. log_buf = pl_info->buf;
  81. flags = plarg->flags;
  82. if (!log_buf) {
  83. printk("Invalid log_buf in %s\n", __func__);
  84. return;
  85. }
  86. buf_size = pl_info->buf_size;
  87. cur_wr_offset = log_buf->wr_offset;
  88. /* Move read offset to the next entry if there is a buffer overlap */
  89. if (log_buf->rd_offset >= 0) {
  90. if ((cur_wr_offset <= log_buf->rd_offset)
  91. && (cur_wr_offset + sizeof(struct ath_pktlog_hdr)) >
  92. log_buf->rd_offset) {
  93. PKTLOG_MOV_RD_IDX(log_buf->rd_offset, log_buf,
  94. buf_size);
  95. }
  96. } else {
  97. log_buf->rd_offset = cur_wr_offset;
  98. }
  99. log_hdr = (struct ath_pktlog_hdr *)(log_buf->log_data + cur_wr_offset);
  100. log_hdr->flags = flags;
  101. #ifdef HELIUMPLUS
  102. log_hdr->macId = mac_id;
  103. log_hdr->log_type = log_type;
  104. #else
  105. log_hdr->log_type = log_type;
  106. #endif
  107. log_hdr->size = (uint16_t) log_size;
  108. log_hdr->missed_cnt = plarg->missed_cnt;
  109. log_hdr->timestamp = plarg->timestamp;
  110. #ifdef HELIUMPLUS
  111. log_hdr->type_specific_data = plarg->type_specific_data;
  112. #endif
  113. cur_wr_offset += sizeof(*log_hdr);
  114. if ((buf_size - cur_wr_offset) < log_size) {
  115. while ((cur_wr_offset <= log_buf->rd_offset)
  116. && (log_buf->rd_offset < buf_size)) {
  117. PKTLOG_MOV_RD_IDX(log_buf->rd_offset, log_buf,
  118. buf_size);
  119. }
  120. cur_wr_offset = 0;
  121. }
  122. while ((cur_wr_offset <= log_buf->rd_offset)
  123. && (cur_wr_offset + log_size) > log_buf->rd_offset) {
  124. PKTLOG_MOV_RD_IDX(log_buf->rd_offset, log_buf, buf_size);
  125. }
  126. log_ptr = &(log_buf->log_data[cur_wr_offset]);
  127. cur_wr_offset += log_hdr->size;
  128. log_buf->wr_offset = ((buf_size - cur_wr_offset) >=
  129. sizeof(struct ath_pktlog_hdr)) ? cur_wr_offset :
  130. 0;
  131. plarg->buf = log_ptr;
  132. }
  133. char *pktlog_getbuf(struct ol_pktlog_dev_t *pl_dev,
  134. struct ath_pktlog_info *pl_info,
  135. size_t log_size, struct ath_pktlog_hdr *pl_hdr)
  136. {
  137. struct ath_pktlog_arg plarg = { 0, };
  138. uint8_t flags = 0;
  139. plarg.pl_info = pl_info;
  140. #ifdef HELIUMPLUS
  141. plarg.macId = pl_hdr->macId;
  142. plarg.log_type = pl_hdr->log_type;
  143. #else
  144. plarg.log_type = pl_hdr->log_type;
  145. #endif
  146. plarg.log_size = log_size;
  147. plarg.flags = pl_hdr->flags;
  148. plarg.missed_cnt = pl_hdr->missed_cnt;
  149. plarg.timestamp = pl_hdr->timestamp;
  150. #ifdef HELIUMPLUS
  151. plarg.type_specific_data = pl_hdr->type_specific_data;
  152. #endif
  153. if (flags & PHFLAGS_INTERRUPT_CONTEXT) {
  154. /*
  155. * We are already in interupt context, no need to make it
  156. * intsafe. call the function directly.
  157. */
  158. pktlog_getbuf_intsafe(&plarg);
  159. } else {
  160. PKTLOG_LOCK(pl_info);
  161. pktlog_getbuf_intsafe(&plarg);
  162. PKTLOG_UNLOCK(pl_info);
  163. }
  164. return plarg.buf;
  165. }
  166. static struct txctl_frm_hdr frm_hdr;
  167. #ifndef HELIUMPLUS
  168. static void process_ieee_hdr(void *data)
  169. {
  170. uint8_t dir;
  171. struct ieee80211_frame *wh = (struct ieee80211_frame *)(data);
  172. frm_hdr.framectrl = *(uint16_t *) (wh->i_fc);
  173. frm_hdr.seqctrl = *(uint16_t *) (wh->i_seq);
  174. dir = (wh->i_fc[1] & IEEE80211_FC1_DIR_MASK);
  175. if (dir == IEEE80211_FC1_DIR_TODS) {
  176. frm_hdr.bssid_tail =
  177. (wh->i_addr1[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  178. i_addr1
  179. [IEEE80211_ADDR_LEN
  180. - 1]);
  181. frm_hdr.sa_tail =
  182. (wh->i_addr2[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  183. i_addr2
  184. [IEEE80211_ADDR_LEN
  185. - 1]);
  186. frm_hdr.da_tail =
  187. (wh->i_addr3[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  188. i_addr3
  189. [IEEE80211_ADDR_LEN
  190. - 1]);
  191. } else if (dir == IEEE80211_FC1_DIR_FROMDS) {
  192. frm_hdr.bssid_tail =
  193. (wh->i_addr2[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  194. i_addr2
  195. [IEEE80211_ADDR_LEN
  196. - 1]);
  197. frm_hdr.sa_tail =
  198. (wh->i_addr3[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  199. i_addr3
  200. [IEEE80211_ADDR_LEN
  201. - 1]);
  202. frm_hdr.da_tail =
  203. (wh->i_addr1[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  204. i_addr1
  205. [IEEE80211_ADDR_LEN
  206. - 1]);
  207. } else {
  208. frm_hdr.bssid_tail =
  209. (wh->i_addr3[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  210. i_addr3
  211. [IEEE80211_ADDR_LEN
  212. - 1]);
  213. frm_hdr.sa_tail =
  214. (wh->i_addr2[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  215. i_addr2
  216. [IEEE80211_ADDR_LEN
  217. - 1]);
  218. frm_hdr.da_tail =
  219. (wh->i_addr1[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  220. i_addr1
  221. [IEEE80211_ADDR_LEN
  222. - 1]);
  223. }
  224. }
  225. /**
  226. * fill_ieee80211_hdr_data() - fill ieee802.11 data header
  227. * @txrx_pdev: txrx pdev
  228. * @pl_msdu_info: msdu info
  229. * @data: data received from event
  230. *
  231. * Return: none
  232. */
  233. static void
  234. fill_ieee80211_hdr_data(struct ol_txrx_pdev_t *txrx_pdev,
  235. struct ath_pktlog_msdu_info *pl_msdu_info, void *data)
  236. {
  237. uint32_t i;
  238. uint32_t *htt_tx_desc;
  239. struct ol_tx_desc_t *tx_desc;
  240. uint8_t msdu_id_offset = MSDU_ID_INFO_ID_OFFSET;
  241. uint16_t tx_desc_id;
  242. uint32_t *msdu_id_info = (uint32_t *)
  243. ((void *)data + sizeof(struct ath_pktlog_hdr));
  244. uint32_t *msdu_id = (uint32_t *) ((char *)msdu_id_info +
  245. msdu_id_offset);
  246. uint8_t *addr, *vap_addr;
  247. uint8_t vdev_id;
  248. qdf_nbuf_t netbuf;
  249. uint32_t len;
  250. pl_msdu_info->num_msdu = *msdu_id_info;
  251. pl_msdu_info->priv_size = sizeof(uint32_t) *
  252. pl_msdu_info->num_msdu + sizeof(uint32_t);
  253. for (i = 0; i < pl_msdu_info->num_msdu; i++) {
  254. /*
  255. * Handle big endianness
  256. * Increment msdu_id once after retrieving
  257. * lower 16 bits and uppper 16 bits
  258. */
  259. if (!(i % 2)) {
  260. tx_desc_id = ((*msdu_id & TX_DESC_ID_LOW_MASK)
  261. >> TX_DESC_ID_LOW_SHIFT);
  262. } else {
  263. tx_desc_id = ((*msdu_id & TX_DESC_ID_HIGH_MASK)
  264. >> TX_DESC_ID_HIGH_SHIFT);
  265. msdu_id += 1;
  266. }
  267. if (tx_desc_id >= txrx_pdev->tx_desc.pool_size) {
  268. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_DEBUG,
  269. "%s: drop due to invalid msdu id = %x\n",
  270. __func__, tx_desc_id);
  271. return;
  272. }
  273. tx_desc = ol_tx_desc_find(txrx_pdev, tx_desc_id);
  274. qdf_assert(tx_desc);
  275. netbuf = tx_desc->netbuf;
  276. htt_tx_desc = (uint32_t *) tx_desc->htt_tx_desc;
  277. qdf_assert(htt_tx_desc);
  278. qdf_nbuf_peek_header(netbuf, &addr, &len);
  279. if (len < (2 * IEEE80211_ADDR_LEN)) {
  280. qdf_print("TX frame does not have a valid address\n");
  281. return;
  282. }
  283. /* Adding header information for the TX data frames */
  284. vdev_id = (uint8_t) (*(htt_tx_desc +
  285. HTT_TX_VDEV_ID_WORD) >>
  286. HTT_TX_VDEV_ID_SHIFT) &
  287. HTT_TX_VDEV_ID_MASK;
  288. vap_addr = wma_get_vdev_address_by_vdev_id(vdev_id);
  289. frm_hdr.da_tail = (addr[IEEE80211_ADDR_LEN - 2] << 8) |
  290. (addr[IEEE80211_ADDR_LEN - 1]);
  291. frm_hdr.sa_tail =
  292. (addr[2 * IEEE80211_ADDR_LEN - 2] << 8) |
  293. (addr[2 * IEEE80211_ADDR_LEN - 1]);
  294. if (vap_addr) {
  295. frm_hdr.bssid_tail =
  296. (vap_addr[IEEE80211_ADDR_LEN - 2] << 8) |
  297. (vap_addr[IEEE80211_ADDR_LEN - 1]);
  298. } else {
  299. frm_hdr.bssid_tail = 0x0000;
  300. }
  301. pl_msdu_info->priv.msdu_len[i] = *(htt_tx_desc +
  302. HTT_TX_MSDU_LEN_DWORD)
  303. & HTT_TX_MSDU_LEN_MASK;
  304. /*
  305. * Add more information per MSDU
  306. * e.g., protocol information
  307. */
  308. }
  309. }
  310. #endif
  311. #ifdef HELIUMPLUS
  312. A_STATUS process_tx_info(struct ol_txrx_pdev_t *txrx_pdev, void *data)
  313. {
  314. /*
  315. * Must include to process different types
  316. * TX_CTL, TX_STATUS, TX_MSDU_ID, TX_FRM_HDR
  317. */
  318. struct ol_pktlog_dev_t *pl_dev;
  319. struct ath_pktlog_hdr pl_hdr;
  320. struct ath_pktlog_info *pl_info;
  321. uint32_t *pl_tgt_hdr;
  322. if (!txrx_pdev) {
  323. printk("Invalid pdev in %s\n", __func__);
  324. return A_ERROR;
  325. }
  326. qdf_assert(txrx_pdev->pl_dev);
  327. qdf_assert(data);
  328. pl_dev = txrx_pdev->pl_dev;
  329. pl_tgt_hdr = (uint32_t *) data;
  330. /*
  331. * Makes the short words (16 bits) portable b/w little endian
  332. * and big endian
  333. */
  334. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  335. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  336. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  337. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  338. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  339. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  340. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  341. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  342. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  343. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  344. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  345. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  346. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  347. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  348. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  349. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  350. pl_hdr.type_specific_data =
  351. *(pl_tgt_hdr + ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET);
  352. pl_info = pl_dev->pl_info;
  353. if (pl_hdr.log_type == PKTLOG_TYPE_TX_CTRL) {
  354. size_t log_size = sizeof(frm_hdr) + pl_hdr.size;
  355. void *txdesc_hdr_ctl = (void *)
  356. pktlog_getbuf(pl_dev, pl_info, log_size, &pl_hdr);
  357. qdf_assert(txdesc_hdr_ctl);
  358. qdf_assert(pl_hdr.size < (370 * sizeof(u_int32_t)));
  359. qdf_mem_copy(txdesc_hdr_ctl, &frm_hdr, sizeof(frm_hdr));
  360. qdf_mem_copy((char *)txdesc_hdr_ctl + sizeof(frm_hdr),
  361. ((void *)data +
  362. sizeof(struct ath_pktlog_hdr)),
  363. pl_hdr.size);
  364. pl_hdr.size = log_size;
  365. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  366. txdesc_hdr_ctl);
  367. }
  368. if (pl_hdr.log_type == PKTLOG_TYPE_TX_STAT) {
  369. struct ath_pktlog_tx_status txstat_log;
  370. size_t log_size = pl_hdr.size;
  371. txstat_log.ds_status = (void *)
  372. pktlog_getbuf(pl_dev, pl_info,
  373. log_size, &pl_hdr);
  374. qdf_assert(txstat_log.ds_status);
  375. qdf_mem_copy(txstat_log.ds_status,
  376. ((void *)data + sizeof(struct ath_pktlog_hdr)),
  377. pl_hdr.size);
  378. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  379. txstat_log.ds_status);
  380. }
  381. return A_OK;
  382. }
  383. #else
  384. A_STATUS process_tx_info(struct ol_txrx_pdev_t *txrx_pdev, void *data)
  385. {
  386. /*
  387. * Must include to process different types
  388. * TX_CTL, TX_STATUS, TX_MSDU_ID, TX_FRM_HDR
  389. */
  390. struct ol_pktlog_dev_t *pl_dev;
  391. struct ath_pktlog_hdr pl_hdr;
  392. struct ath_pktlog_info *pl_info;
  393. uint32_t *pl_tgt_hdr;
  394. if (!txrx_pdev) {
  395. qdf_print("Invalid pdev in %s\n", __func__);
  396. return A_ERROR;
  397. }
  398. qdf_assert(txrx_pdev->pl_dev);
  399. qdf_assert(data);
  400. pl_dev = txrx_pdev->pl_dev;
  401. pl_tgt_hdr = (uint32_t *) data;
  402. /*
  403. * Makes the short words (16 bits) portable b/w little endian
  404. * and big endian
  405. */
  406. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  407. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  408. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  409. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  410. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  411. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  412. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  413. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  414. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  415. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  416. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  417. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  418. pl_info = pl_dev->pl_info;
  419. if (pl_hdr.log_type == PKTLOG_TYPE_TX_FRM_HDR) {
  420. /* Valid only for the TX CTL */
  421. process_ieee_hdr(data + sizeof(pl_hdr));
  422. }
  423. if (pl_hdr.log_type == PKTLOG_TYPE_TX_VIRT_ADDR) {
  424. A_UINT32 desc_id = (A_UINT32)
  425. *((A_UINT32 *) (data + sizeof(pl_hdr)));
  426. A_UINT32 vdev_id = desc_id;
  427. /* if the pkt log msg is for the bcn frame the vdev id
  428. * is piggybacked in desc_id and the MSB of the desc ID
  429. * would be set to FF
  430. */
  431. #define BCN_DESC_ID 0xFF
  432. if ((desc_id >> 24) == BCN_DESC_ID) {
  433. void *data;
  434. A_UINT32 buf_size;
  435. vdev_id &= 0x00FFFFFF;
  436. data = wma_get_beacon_buffer_by_vdev_id(vdev_id,
  437. &buf_size);
  438. if (data) {
  439. process_ieee_hdr(data);
  440. qdf_mem_free(data);
  441. }
  442. } else {
  443. /*
  444. * TODO: get the hdr content for mgmt frames from
  445. * Tx mgmt desc pool
  446. */
  447. }
  448. }
  449. if (pl_hdr.log_type == PKTLOG_TYPE_TX_CTRL) {
  450. struct ath_pktlog_txctl txctl_log;
  451. size_t log_size = sizeof(txctl_log.priv);
  452. txctl_log.txdesc_hdr_ctl = (void *)pktlog_getbuf(pl_dev,
  453. pl_info,
  454. log_size,
  455. &pl_hdr);
  456. if (!txctl_log.txdesc_hdr_ctl) {
  457. printk
  458. ("failed to get buf for txctl_log.txdesc_hdr_ctl\n");
  459. return A_ERROR;
  460. }
  461. /*
  462. * frm hdr is currently Valid only for local frames
  463. * Add capability to include the fmr hdr for remote frames
  464. */
  465. txctl_log.priv.frm_hdr = frm_hdr;
  466. qdf_assert(txctl_log.priv.txdesc_ctl);
  467. qdf_mem_copy((void *)&txctl_log.priv.txdesc_ctl,
  468. ((void *)data + sizeof(struct ath_pktlog_hdr)),
  469. pl_hdr.size);
  470. qdf_assert(txctl_log.txdesc_hdr_ctl);
  471. qdf_mem_copy(txctl_log.txdesc_hdr_ctl, &txctl_log.priv,
  472. sizeof(txctl_log.priv));
  473. pl_hdr.size = log_size;
  474. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  475. txctl_log.txdesc_hdr_ctl);
  476. /* Add Protocol information and HT specific information */
  477. }
  478. if (pl_hdr.log_type == PKTLOG_TYPE_TX_STAT) {
  479. struct ath_pktlog_tx_status txstat_log;
  480. size_t log_size = pl_hdr.size;
  481. txstat_log.ds_status = (void *)
  482. pktlog_getbuf(pl_dev, pl_info, log_size, &pl_hdr);
  483. qdf_assert(txstat_log.ds_status);
  484. qdf_mem_copy(txstat_log.ds_status,
  485. ((void *)data + sizeof(struct ath_pktlog_hdr)),
  486. pl_hdr.size);
  487. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  488. txstat_log.ds_status);
  489. }
  490. if (pl_hdr.log_type == PKTLOG_TYPE_TX_MSDU_ID) {
  491. struct ath_pktlog_msdu_info pl_msdu_info;
  492. size_t log_size;
  493. qdf_mem_set(&pl_msdu_info, sizeof(pl_msdu_info), 0);
  494. log_size = sizeof(pl_msdu_info.priv);
  495. if (pl_dev->mt_pktlog_enabled == false)
  496. fill_ieee80211_hdr_data(txrx_pdev, &pl_msdu_info, data);
  497. pl_msdu_info.ath_msdu_info = pktlog_getbuf(pl_dev, pl_info,
  498. log_size, &pl_hdr);
  499. qdf_mem_copy((void *)&pl_msdu_info.priv.msdu_id_info,
  500. ((void *)data + sizeof(struct ath_pktlog_hdr)),
  501. sizeof(pl_msdu_info.priv.msdu_id_info));
  502. qdf_mem_copy(pl_msdu_info.ath_msdu_info, &pl_msdu_info.priv,
  503. sizeof(pl_msdu_info.priv));
  504. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  505. pl_msdu_info.ath_msdu_info);
  506. }
  507. return A_OK;
  508. }
  509. #endif
  510. A_STATUS process_rx_info_remote(void *pdev, void *data)
  511. {
  512. struct ol_pktlog_dev_t *pl_dev;
  513. struct ath_pktlog_info *pl_info;
  514. struct htt_host_rx_desc_base *rx_desc;
  515. struct ath_pktlog_hdr pl_hdr;
  516. struct ath_pktlog_rx_info rxstat_log;
  517. size_t log_size;
  518. struct ol_rx_remote_data *r_data = (struct ol_rx_remote_data *)data;
  519. qdf_nbuf_t msdu;
  520. if (!pdev) {
  521. printk("Invalid pdev in %s\n", __func__);
  522. return A_ERROR;
  523. }
  524. if (!r_data) {
  525. printk("Invalid data in %s\n", __func__);
  526. return A_ERROR;
  527. }
  528. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  529. pl_info = pl_dev->pl_info;
  530. msdu = r_data->msdu;
  531. while (msdu) {
  532. rx_desc =
  533. (struct htt_host_rx_desc_base *)(qdf_nbuf_data(msdu)) - 1;
  534. log_size =
  535. sizeof(*rx_desc) - sizeof(struct htt_host_fw_desc_base);
  536. /*
  537. * Construct the pktlog header pl_hdr
  538. * Because desc is DMA'd to the host memory
  539. */
  540. pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
  541. pl_hdr.missed_cnt = 0;
  542. #if defined(HELIUMPLUS)
  543. pl_hdr.macId = r_data->mac_id;
  544. pl_hdr.log_type = PKTLOG_TYPE_RX_STAT;
  545. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  546. #else
  547. pl_hdr.log_type = PKTLOG_TYPE_RX_STAT;
  548. #endif
  549. pl_hdr.size = sizeof(*rx_desc) -
  550. sizeof(struct htt_host_fw_desc_base);
  551. #if defined(HELIUMPLUS)
  552. pl_hdr.timestamp =
  553. rx_desc->ppdu_end.rx_pkt_end.phy_timestamp_1_lower_32;
  554. pl_hdr.type_specific_data = 0xDEADAA;
  555. #else
  556. pl_hdr.timestamp = rx_desc->ppdu_end.tsf_timestamp;
  557. #endif /* !defined(HELIUMPLUS) */
  558. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  559. log_size, &pl_hdr);
  560. qdf_mem_copy(rxstat_log.rx_desc, (void *)rx_desc +
  561. sizeof(struct htt_host_fw_desc_base), pl_hdr.size);
  562. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  563. rxstat_log.rx_desc);
  564. msdu = qdf_nbuf_next(msdu);
  565. }
  566. return A_OK;
  567. }
  568. A_STATUS process_rx_info(void *pdev, void *data)
  569. {
  570. struct ol_pktlog_dev_t *pl_dev;
  571. struct ath_pktlog_info *pl_info;
  572. struct ath_pktlog_rx_info rxstat_log;
  573. struct ath_pktlog_hdr pl_hdr;
  574. size_t log_size;
  575. uint32_t *pl_tgt_hdr;
  576. if (!pdev) {
  577. printk("Invalid pdev in %s", __func__);
  578. return A_ERROR;
  579. }
  580. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  581. pl_info = pl_dev->pl_info;
  582. pl_tgt_hdr = (uint32_t *) data;
  583. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  584. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  585. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  586. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  587. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  588. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  589. #ifdef HELIUMPLUS
  590. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  591. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  592. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  593. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  594. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  595. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  596. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  597. #else
  598. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  599. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  600. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  601. #endif
  602. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  603. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  604. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  605. log_size = pl_hdr.size;
  606. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  607. log_size, &pl_hdr);
  608. qdf_mem_copy(rxstat_log.rx_desc,
  609. (void *)data + sizeof(struct ath_pktlog_hdr), pl_hdr.size);
  610. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
  611. return A_OK;
  612. }
  613. A_STATUS process_rate_find(void *pdev, void *data)
  614. {
  615. struct ol_pktlog_dev_t *pl_dev;
  616. struct ath_pktlog_hdr pl_hdr;
  617. struct ath_pktlog_info *pl_info;
  618. size_t log_size;
  619. /*
  620. * Will be uncommented when the rate control find
  621. * for pktlog is implemented in the firmware.
  622. * Currently derived from the TX PPDU status
  623. */
  624. struct ath_pktlog_rc_find rcf_log;
  625. uint32_t *pl_tgt_hdr;
  626. if (!pdev) {
  627. qdf_print("Invalid pdev in %s\n", __func__);
  628. return A_ERROR;
  629. }
  630. if (!data) {
  631. qdf_print("Invalid data in %s\n", __func__);
  632. return A_ERROR;
  633. }
  634. pl_tgt_hdr = (uint32_t *) data;
  635. /*
  636. * Makes the short words (16 bits) portable b/w little endian
  637. * and big endian
  638. */
  639. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  640. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  641. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  642. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  643. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  644. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  645. #ifdef HELIUMPLUS
  646. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  647. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  648. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  649. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  650. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  651. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  652. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  653. #else
  654. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  655. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  656. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  657. #endif
  658. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  659. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  660. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  661. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  662. pl_info = pl_dev->pl_info;
  663. log_size = pl_hdr.size;
  664. rcf_log.rcFind = (void *)pktlog_getbuf(pl_dev, pl_info,
  665. log_size, &pl_hdr);
  666. qdf_mem_copy(rcf_log.rcFind,
  667. ((char *)data + sizeof(struct ath_pktlog_hdr)),
  668. pl_hdr.size);
  669. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcf_log.rcFind);
  670. return A_OK;
  671. }
  672. A_STATUS process_sw_event(void *pdev, void *data)
  673. {
  674. struct ol_pktlog_dev_t *pl_dev;
  675. struct ath_pktlog_hdr pl_hdr;
  676. struct ath_pktlog_info *pl_info;
  677. size_t log_size;
  678. /*
  679. * Will be uncommented when the rate control find
  680. * for pktlog is implemented in the firmware.
  681. * Currently derived from the TX PPDU status
  682. */
  683. struct ath_pktlog_sw_event sw_event;
  684. uint32_t *pl_tgt_hdr;
  685. if (!pdev) {
  686. qdf_print("Invalid pdev in %s\n", __func__);
  687. return A_ERROR;
  688. }
  689. if (!data) {
  690. qdf_print("Invalid data in %s\n", __func__);
  691. return A_ERROR;
  692. }
  693. pl_tgt_hdr = (uint32_t *) data;
  694. /*
  695. * Makes the short words (16 bits) portable b/w little endian
  696. * and big endian
  697. */
  698. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  699. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  700. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  701. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  702. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  703. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  704. #ifdef HELIUMPLUS
  705. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  706. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  707. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  708. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  709. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  710. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  711. #else
  712. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  713. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  714. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  715. #endif
  716. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  717. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  718. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  719. #ifdef HELIUMPLUS
  720. pl_hdr.type_specific_data =
  721. *(pl_tgt_hdr + ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET);
  722. #endif
  723. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  724. pl_info = pl_dev->pl_info;
  725. log_size = pl_hdr.size;
  726. sw_event.sw_event = (void *)pktlog_getbuf(pl_dev, pl_info,
  727. log_size, &pl_hdr);
  728. qdf_mem_copy(sw_event.sw_event,
  729. ((char *)data + sizeof(struct ath_pktlog_hdr)),
  730. pl_hdr.size);
  731. return A_OK;
  732. }
  733. A_STATUS process_rate_update(void *pdev, void *data)
  734. {
  735. struct ol_pktlog_dev_t *pl_dev;
  736. struct ath_pktlog_hdr pl_hdr;
  737. size_t log_size;
  738. struct ath_pktlog_info *pl_info;
  739. struct ath_pktlog_rc_update rcu_log;
  740. uint32_t *pl_tgt_hdr;
  741. if (!pdev) {
  742. printk("Invalid pdev in %s\n", __func__);
  743. return A_ERROR;
  744. }
  745. if (!data) {
  746. printk("Invalid data in %s\n", __func__);
  747. return A_ERROR;
  748. }
  749. pl_tgt_hdr = (uint32_t *) data;
  750. /*
  751. * Makes the short words (16 bits) portable b/w little endian
  752. * and big endian
  753. */
  754. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  755. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  756. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  757. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  758. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  759. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  760. #ifdef HELIUMPLUS
  761. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  762. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  763. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  764. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  765. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  766. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  767. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  768. #else
  769. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  770. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  771. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  772. #endif
  773. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  774. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  775. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  776. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  777. log_size = pl_hdr.size;
  778. pl_info = pl_dev->pl_info;
  779. /*
  780. * Will be uncommented when the rate control update
  781. * for pktlog is implemented in the firmware.
  782. * Currently derived from the TX PPDU status
  783. */
  784. rcu_log.txRateCtrl = (void *)pktlog_getbuf(pl_dev, pl_info,
  785. log_size, &pl_hdr);
  786. qdf_mem_copy(rcu_log.txRateCtrl,
  787. ((char *)data + sizeof(struct ath_pktlog_hdr)),
  788. pl_hdr.size);
  789. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcu_log.txRateCtrl);
  790. return A_OK;
  791. }
  792. #endif /*REMOVE_PKT_LOG */