pktlog_internal.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871
  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. tx_desc = ol_tx_desc_find(txrx_pdev, tx_desc_id);
  268. qdf_assert(tx_desc);
  269. netbuf = tx_desc->netbuf;
  270. htt_tx_desc = (uint32_t *) tx_desc->htt_tx_desc;
  271. qdf_assert(htt_tx_desc);
  272. qdf_nbuf_peek_header(netbuf, &addr, &len);
  273. if (len < (2 * IEEE80211_ADDR_LEN)) {
  274. qdf_print("TX frame does not have a valid address\n");
  275. return;
  276. }
  277. /* Adding header information for the TX data frames */
  278. vdev_id = (uint8_t) (*(htt_tx_desc +
  279. HTT_TX_VDEV_ID_WORD) >>
  280. HTT_TX_VDEV_ID_SHIFT) &
  281. HTT_TX_VDEV_ID_MASK;
  282. vap_addr = wma_get_vdev_address_by_vdev_id(vdev_id);
  283. frm_hdr.da_tail = (addr[IEEE80211_ADDR_LEN - 2] << 8) |
  284. (addr[IEEE80211_ADDR_LEN - 1]);
  285. frm_hdr.sa_tail =
  286. (addr[2 * IEEE80211_ADDR_LEN - 2] << 8) |
  287. (addr[2 * IEEE80211_ADDR_LEN - 1]);
  288. if (vap_addr) {
  289. frm_hdr.bssid_tail =
  290. (vap_addr[IEEE80211_ADDR_LEN - 2] << 8) |
  291. (vap_addr[IEEE80211_ADDR_LEN - 1]);
  292. } else {
  293. frm_hdr.bssid_tail = 0x0000;
  294. }
  295. pl_msdu_info->priv.msdu_len[i] = *(htt_tx_desc +
  296. HTT_TX_MSDU_LEN_DWORD)
  297. & HTT_TX_MSDU_LEN_MASK;
  298. /*
  299. * Add more information per MSDU
  300. * e.g., protocol information
  301. */
  302. }
  303. }
  304. #endif
  305. #ifdef HELIUMPLUS
  306. A_STATUS process_tx_info(struct ol_txrx_pdev_t *txrx_pdev, void *data)
  307. {
  308. /*
  309. * Must include to process different types
  310. * TX_CTL, TX_STATUS, TX_MSDU_ID, TX_FRM_HDR
  311. */
  312. struct ol_pktlog_dev_t *pl_dev;
  313. struct ath_pktlog_hdr pl_hdr;
  314. struct ath_pktlog_info *pl_info;
  315. uint32_t *pl_tgt_hdr;
  316. if (!txrx_pdev) {
  317. printk("Invalid pdev in %s\n", __func__);
  318. return A_ERROR;
  319. }
  320. qdf_assert(txrx_pdev->pl_dev);
  321. qdf_assert(data);
  322. pl_dev = txrx_pdev->pl_dev;
  323. pl_tgt_hdr = (uint32_t *) data;
  324. /*
  325. * Makes the short words (16 bits) portable b/w little endian
  326. * and big endian
  327. */
  328. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  329. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  330. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  331. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  332. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  333. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  334. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  335. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  336. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  337. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  338. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  339. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  340. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  341. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  342. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  343. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  344. pl_hdr.type_specific_data =
  345. *(pl_tgt_hdr + ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET);
  346. pl_info = pl_dev->pl_info;
  347. if (pl_hdr.log_type == PKTLOG_TYPE_TX_CTRL) {
  348. size_t log_size = sizeof(frm_hdr) + pl_hdr.size;
  349. void *txdesc_hdr_ctl = (void *)
  350. pktlog_getbuf(pl_dev, pl_info, log_size, &pl_hdr);
  351. qdf_assert(txdesc_hdr_ctl);
  352. qdf_assert(pl_hdr.size < (370 * sizeof(u_int32_t)));
  353. qdf_mem_copy(txdesc_hdr_ctl, &frm_hdr, sizeof(frm_hdr));
  354. qdf_mem_copy((char *)txdesc_hdr_ctl + sizeof(frm_hdr),
  355. ((void *)data +
  356. sizeof(struct ath_pktlog_hdr)),
  357. pl_hdr.size);
  358. pl_hdr.size = log_size;
  359. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  360. txdesc_hdr_ctl);
  361. }
  362. if (pl_hdr.log_type == PKTLOG_TYPE_TX_STAT) {
  363. struct ath_pktlog_tx_status txstat_log;
  364. size_t log_size = pl_hdr.size;
  365. txstat_log.ds_status = (void *)
  366. pktlog_getbuf(pl_dev, pl_info,
  367. log_size, &pl_hdr);
  368. qdf_assert(txstat_log.ds_status);
  369. qdf_mem_copy(txstat_log.ds_status,
  370. ((void *)data + sizeof(struct ath_pktlog_hdr)),
  371. pl_hdr.size);
  372. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  373. txstat_log.ds_status);
  374. }
  375. return A_OK;
  376. }
  377. #else
  378. A_STATUS process_tx_info(struct ol_txrx_pdev_t *txrx_pdev, void *data)
  379. {
  380. /*
  381. * Must include to process different types
  382. * TX_CTL, TX_STATUS, TX_MSDU_ID, TX_FRM_HDR
  383. */
  384. struct ol_pktlog_dev_t *pl_dev;
  385. struct ath_pktlog_hdr pl_hdr;
  386. struct ath_pktlog_info *pl_info;
  387. uint32_t *pl_tgt_hdr;
  388. if (!txrx_pdev) {
  389. qdf_print("Invalid pdev in %s\n", __func__);
  390. return A_ERROR;
  391. }
  392. qdf_assert(txrx_pdev->pl_dev);
  393. qdf_assert(data);
  394. pl_dev = txrx_pdev->pl_dev;
  395. pl_tgt_hdr = (uint32_t *) data;
  396. /*
  397. * Makes the short words (16 bits) portable b/w little endian
  398. * and big endian
  399. */
  400. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  401. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  402. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  403. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  404. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  405. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  406. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  407. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  408. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  409. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  410. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  411. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  412. pl_info = pl_dev->pl_info;
  413. if (pl_hdr.log_type == PKTLOG_TYPE_TX_FRM_HDR) {
  414. /* Valid only for the TX CTL */
  415. process_ieee_hdr(data + sizeof(pl_hdr));
  416. }
  417. if (pl_hdr.log_type == PKTLOG_TYPE_TX_VIRT_ADDR) {
  418. A_UINT32 desc_id = (A_UINT32)
  419. *((A_UINT32 *) (data + sizeof(pl_hdr)));
  420. A_UINT32 vdev_id = desc_id;
  421. /* if the pkt log msg is for the bcn frame the vdev id
  422. * is piggybacked in desc_id and the MSB of the desc ID
  423. * would be set to FF
  424. */
  425. #define BCN_DESC_ID 0xFF
  426. if ((desc_id >> 24) == BCN_DESC_ID) {
  427. void *data;
  428. A_UINT32 buf_size;
  429. vdev_id &= 0x00FFFFFF;
  430. data = wma_get_beacon_buffer_by_vdev_id(vdev_id,
  431. &buf_size);
  432. if (data) {
  433. process_ieee_hdr(data);
  434. qdf_mem_free(data);
  435. }
  436. } else {
  437. /*
  438. * TODO: get the hdr content for mgmt frames from
  439. * Tx mgmt desc pool
  440. */
  441. }
  442. }
  443. if (pl_hdr.log_type == PKTLOG_TYPE_TX_CTRL) {
  444. struct ath_pktlog_txctl txctl_log;
  445. size_t log_size = sizeof(txctl_log.priv);
  446. txctl_log.txdesc_hdr_ctl = (void *)pktlog_getbuf(pl_dev,
  447. pl_info,
  448. log_size,
  449. &pl_hdr);
  450. if (!txctl_log.txdesc_hdr_ctl) {
  451. printk
  452. ("failed to get buf for txctl_log.txdesc_hdr_ctl\n");
  453. return A_ERROR;
  454. }
  455. /*
  456. * frm hdr is currently Valid only for local frames
  457. * Add capability to include the fmr hdr for remote frames
  458. */
  459. txctl_log.priv.frm_hdr = frm_hdr;
  460. qdf_assert(txctl_log.priv.txdesc_ctl);
  461. qdf_mem_copy((void *)&txctl_log.priv.txdesc_ctl,
  462. ((void *)data + sizeof(struct ath_pktlog_hdr)),
  463. pl_hdr.size);
  464. qdf_assert(txctl_log.txdesc_hdr_ctl);
  465. qdf_mem_copy(txctl_log.txdesc_hdr_ctl, &txctl_log.priv,
  466. sizeof(txctl_log.priv));
  467. pl_hdr.size = log_size;
  468. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  469. txctl_log.txdesc_hdr_ctl);
  470. /* Add Protocol information and HT specific information */
  471. }
  472. if (pl_hdr.log_type == PKTLOG_TYPE_TX_STAT) {
  473. struct ath_pktlog_tx_status txstat_log;
  474. size_t log_size = pl_hdr.size;
  475. txstat_log.ds_status = (void *)
  476. pktlog_getbuf(pl_dev, pl_info, log_size, &pl_hdr);
  477. qdf_assert(txstat_log.ds_status);
  478. qdf_mem_copy(txstat_log.ds_status,
  479. ((void *)data + sizeof(struct ath_pktlog_hdr)),
  480. pl_hdr.size);
  481. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  482. txstat_log.ds_status);
  483. }
  484. if (pl_hdr.log_type == PKTLOG_TYPE_TX_MSDU_ID) {
  485. struct ath_pktlog_msdu_info pl_msdu_info;
  486. size_t log_size;
  487. qdf_mem_set(&pl_msdu_info, sizeof(pl_msdu_info), 0);
  488. log_size = sizeof(pl_msdu_info.priv);
  489. if (pl_dev->mt_pktlog_enabled == false)
  490. fill_ieee80211_hdr_data(txrx_pdev, &pl_msdu_info, data);
  491. pl_msdu_info.ath_msdu_info = pktlog_getbuf(pl_dev, pl_info,
  492. log_size, &pl_hdr);
  493. qdf_mem_copy((void *)&pl_msdu_info.priv.msdu_id_info,
  494. ((void *)data + sizeof(struct ath_pktlog_hdr)),
  495. sizeof(pl_msdu_info.priv.msdu_id_info));
  496. qdf_mem_copy(pl_msdu_info.ath_msdu_info, &pl_msdu_info.priv,
  497. sizeof(pl_msdu_info.priv));
  498. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  499. pl_msdu_info.ath_msdu_info);
  500. }
  501. return A_OK;
  502. }
  503. #endif
  504. A_STATUS process_rx_info_remote(void *pdev, void *data)
  505. {
  506. struct ol_pktlog_dev_t *pl_dev;
  507. struct ath_pktlog_info *pl_info;
  508. struct htt_host_rx_desc_base *rx_desc;
  509. struct ath_pktlog_hdr pl_hdr;
  510. struct ath_pktlog_rx_info rxstat_log;
  511. size_t log_size;
  512. struct ol_rx_remote_data *r_data = (struct ol_rx_remote_data *)data;
  513. qdf_nbuf_t msdu;
  514. if (!pdev) {
  515. printk("Invalid pdev in %s\n", __func__);
  516. return A_ERROR;
  517. }
  518. if (!r_data) {
  519. printk("Invalid data in %s\n", __func__);
  520. return A_ERROR;
  521. }
  522. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  523. pl_info = pl_dev->pl_info;
  524. msdu = r_data->msdu;
  525. while (msdu) {
  526. rx_desc =
  527. (struct htt_host_rx_desc_base *)(qdf_nbuf_data(msdu)) - 1;
  528. log_size =
  529. sizeof(*rx_desc) - sizeof(struct htt_host_fw_desc_base);
  530. /*
  531. * Construct the pktlog header pl_hdr
  532. * Because desc is DMA'd to the host memory
  533. */
  534. pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
  535. pl_hdr.missed_cnt = 0;
  536. #if defined(HELIUMPLUS)
  537. pl_hdr.macId = r_data->mac_id;
  538. pl_hdr.log_type = PKTLOG_TYPE_RX_STAT;
  539. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  540. #else
  541. pl_hdr.log_type = PKTLOG_TYPE_RX_STAT;
  542. #endif
  543. pl_hdr.size = sizeof(*rx_desc) -
  544. sizeof(struct htt_host_fw_desc_base);
  545. #if defined(HELIUMPLUS)
  546. pl_hdr.timestamp =
  547. rx_desc->ppdu_end.rx_pkt_end.phy_timestamp_1_lower_32;
  548. pl_hdr.type_specific_data = 0xDEADAA;
  549. #else
  550. pl_hdr.timestamp = rx_desc->ppdu_end.tsf_timestamp;
  551. #endif /* !defined(HELIUMPLUS) */
  552. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  553. log_size, &pl_hdr);
  554. qdf_mem_copy(rxstat_log.rx_desc, (void *)rx_desc +
  555. sizeof(struct htt_host_fw_desc_base), pl_hdr.size);
  556. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  557. rxstat_log.rx_desc);
  558. msdu = qdf_nbuf_next(msdu);
  559. }
  560. return A_OK;
  561. }
  562. A_STATUS process_rx_info(void *pdev, void *data)
  563. {
  564. struct ol_pktlog_dev_t *pl_dev;
  565. struct ath_pktlog_info *pl_info;
  566. struct ath_pktlog_rx_info rxstat_log;
  567. struct ath_pktlog_hdr pl_hdr;
  568. size_t log_size;
  569. uint32_t *pl_tgt_hdr;
  570. if (!pdev) {
  571. printk("Invalid pdev in %s", __func__);
  572. return A_ERROR;
  573. }
  574. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  575. pl_info = pl_dev->pl_info;
  576. pl_tgt_hdr = (uint32_t *) data;
  577. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  578. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  579. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  580. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  581. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  582. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  583. #ifdef HELIUMPLUS
  584. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  585. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  586. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  587. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  588. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  589. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  590. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  591. #else
  592. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  593. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  594. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  595. #endif
  596. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  597. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  598. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  599. log_size = pl_hdr.size;
  600. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  601. log_size, &pl_hdr);
  602. qdf_mem_copy(rxstat_log.rx_desc,
  603. (void *)data + sizeof(struct ath_pktlog_hdr), pl_hdr.size);
  604. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
  605. return A_OK;
  606. }
  607. A_STATUS process_rate_find(void *pdev, void *data)
  608. {
  609. struct ol_pktlog_dev_t *pl_dev;
  610. struct ath_pktlog_hdr pl_hdr;
  611. struct ath_pktlog_info *pl_info;
  612. size_t log_size;
  613. /*
  614. * Will be uncommented when the rate control find
  615. * for pktlog is implemented in the firmware.
  616. * Currently derived from the TX PPDU status
  617. */
  618. struct ath_pktlog_rc_find rcf_log;
  619. uint32_t *pl_tgt_hdr;
  620. if (!pdev) {
  621. qdf_print("Invalid pdev in %s\n", __func__);
  622. return A_ERROR;
  623. }
  624. if (!data) {
  625. qdf_print("Invalid data in %s\n", __func__);
  626. return A_ERROR;
  627. }
  628. pl_tgt_hdr = (uint32_t *) data;
  629. /*
  630. * Makes the short words (16 bits) portable b/w little endian
  631. * and big endian
  632. */
  633. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  634. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  635. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  636. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  637. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  638. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  639. #ifdef HELIUMPLUS
  640. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  641. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  642. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  643. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  644. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  645. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  646. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  647. #else
  648. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  649. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  650. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  651. #endif
  652. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  653. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  654. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  655. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  656. pl_info = pl_dev->pl_info;
  657. log_size = pl_hdr.size;
  658. rcf_log.rcFind = (void *)pktlog_getbuf(pl_dev, pl_info,
  659. log_size, &pl_hdr);
  660. qdf_mem_copy(rcf_log.rcFind,
  661. ((char *)data + sizeof(struct ath_pktlog_hdr)),
  662. pl_hdr.size);
  663. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcf_log.rcFind);
  664. return A_OK;
  665. }
  666. A_STATUS process_sw_event(void *pdev, void *data)
  667. {
  668. struct ol_pktlog_dev_t *pl_dev;
  669. struct ath_pktlog_hdr pl_hdr;
  670. struct ath_pktlog_info *pl_info;
  671. size_t log_size;
  672. /*
  673. * Will be uncommented when the rate control find
  674. * for pktlog is implemented in the firmware.
  675. * Currently derived from the TX PPDU status
  676. */
  677. struct ath_pktlog_sw_event sw_event;
  678. uint32_t *pl_tgt_hdr;
  679. if (!pdev) {
  680. qdf_print("Invalid pdev in %s\n", __func__);
  681. return A_ERROR;
  682. }
  683. if (!data) {
  684. qdf_print("Invalid data in %s\n", __func__);
  685. return A_ERROR;
  686. }
  687. pl_tgt_hdr = (uint32_t *) data;
  688. /*
  689. * Makes the short words (16 bits) portable b/w little endian
  690. * and big endian
  691. */
  692. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  693. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  694. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  695. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  696. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  697. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  698. #ifdef HELIUMPLUS
  699. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  700. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  701. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  702. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  703. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  704. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  705. #else
  706. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  707. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  708. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  709. #endif
  710. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  711. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  712. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  713. #ifdef HELIUMPLUS
  714. pl_hdr.type_specific_data =
  715. *(pl_tgt_hdr + ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET);
  716. #endif
  717. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  718. pl_info = pl_dev->pl_info;
  719. log_size = pl_hdr.size;
  720. sw_event.sw_event = (void *)pktlog_getbuf(pl_dev, pl_info,
  721. log_size, &pl_hdr);
  722. qdf_mem_copy(sw_event.sw_event,
  723. ((char *)data + sizeof(struct ath_pktlog_hdr)),
  724. pl_hdr.size);
  725. return A_OK;
  726. }
  727. A_STATUS process_rate_update(void *pdev, void *data)
  728. {
  729. struct ol_pktlog_dev_t *pl_dev;
  730. struct ath_pktlog_hdr pl_hdr;
  731. size_t log_size;
  732. struct ath_pktlog_info *pl_info;
  733. struct ath_pktlog_rc_update rcu_log;
  734. uint32_t *pl_tgt_hdr;
  735. if (!pdev) {
  736. printk("Invalid pdev in %s\n", __func__);
  737. return A_ERROR;
  738. }
  739. if (!data) {
  740. printk("Invalid data in %s\n", __func__);
  741. return A_ERROR;
  742. }
  743. pl_tgt_hdr = (uint32_t *) data;
  744. /*
  745. * Makes the short words (16 bits) portable b/w little endian
  746. * and big endian
  747. */
  748. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  749. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  750. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  751. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  752. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  753. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  754. #ifdef HELIUMPLUS
  755. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  756. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  757. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  758. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  759. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  760. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  761. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  762. #else
  763. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  764. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  765. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  766. #endif
  767. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  768. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  769. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  770. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  771. log_size = pl_hdr.size;
  772. pl_info = pl_dev->pl_info;
  773. /*
  774. * Will be uncommented when the rate control update
  775. * for pktlog is implemented in the firmware.
  776. * Currently derived from the TX PPDU status
  777. */
  778. rcu_log.txRateCtrl = (void *)pktlog_getbuf(pl_dev, pl_info,
  779. log_size, &pl_hdr);
  780. qdf_mem_copy(rcu_log.txRateCtrl,
  781. ((char *)data + sizeof(struct ath_pktlog_hdr)),
  782. pl_hdr.size);
  783. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcu_log.txRateCtrl);
  784. return A_OK;
  785. }
  786. #endif /*REMOVE_PKT_LOG */