pktlog_wifi2.c 35 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196
  1. /**
  2. * Copyright (c) 2013-2020, The Linux Foundation. All rights reserved.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for any
  5. * purpose with or without fee is hereby granted, provided that the above
  6. * copyright notice and this permission notice appear in all copies.
  7. *
  8. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  9. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. */
  16. /* WIFI2 - Refers to legacy platforms */
  17. #include "pktlog_wifi2.h"
  18. #ifndef REMOVE_PKT_LOG
  19. static struct txctl_frm_hdr frm_hdr;
  20. #ifndef HELIUMPLUS
  21. /**
  22. * process_ieee_hdr(): Process ieee header from the pktlog buffer
  23. * @data: pktlog buffer
  24. *
  25. * Return: None
  26. */
  27. static void process_ieee_hdr(void *data)
  28. {
  29. uint8_t dir;
  30. struct ieee80211_frame *wh = (struct ieee80211_frame *)(data);
  31. frm_hdr.framectrl = *(uint16_t *)(wh->i_fc);
  32. frm_hdr.seqctrl = *(uint16_t *)(wh->i_seq);
  33. dir = (wh->i_fc[1] & IEEE80211_FC1_DIR_MASK);
  34. if (dir == IEEE80211_FC1_DIR_TODS) {
  35. frm_hdr.bssid_tail =
  36. (wh->i_addr1[QDF_MAC_ADDR_SIZE - 2] << 8) | (wh->
  37. i_addr1
  38. [QDF_MAC_ADDR_SIZE
  39. - 1]);
  40. frm_hdr.sa_tail =
  41. (wh->i_addr2[QDF_MAC_ADDR_SIZE - 2] << 8) | (wh->
  42. i_addr2
  43. [QDF_MAC_ADDR_SIZE
  44. - 1]);
  45. frm_hdr.da_tail =
  46. (wh->i_addr3[QDF_MAC_ADDR_SIZE - 2] << 8) | (wh->
  47. i_addr3
  48. [QDF_MAC_ADDR_SIZE
  49. - 1]);
  50. } else if (dir == IEEE80211_FC1_DIR_FROMDS) {
  51. frm_hdr.bssid_tail =
  52. (wh->i_addr2[QDF_MAC_ADDR_SIZE - 2] << 8) | (wh->
  53. i_addr2
  54. [QDF_MAC_ADDR_SIZE
  55. - 1]);
  56. frm_hdr.sa_tail =
  57. (wh->i_addr3[QDF_MAC_ADDR_SIZE - 2] << 8) | (wh->
  58. i_addr3
  59. [QDF_MAC_ADDR_SIZE
  60. - 1]);
  61. frm_hdr.da_tail =
  62. (wh->i_addr1[QDF_MAC_ADDR_SIZE - 2] << 8) | (wh->
  63. i_addr1
  64. [QDF_MAC_ADDR_SIZE
  65. - 1]);
  66. } else {
  67. frm_hdr.bssid_tail =
  68. (wh->i_addr3[QDF_MAC_ADDR_SIZE - 2] << 8) | (wh->
  69. i_addr3
  70. [QDF_MAC_ADDR_SIZE
  71. - 1]);
  72. frm_hdr.sa_tail =
  73. (wh->i_addr2[QDF_MAC_ADDR_SIZE - 2] << 8) | (wh->
  74. i_addr2
  75. [QDF_MAC_ADDR_SIZE
  76. - 1]);
  77. frm_hdr.da_tail =
  78. (wh->i_addr1[QDF_MAC_ADDR_SIZE - 2] << 8) | (wh->
  79. i_addr1
  80. [QDF_MAC_ADDR_SIZE
  81. - 1]);
  82. }
  83. }
  84. /**
  85. * fill_ieee80211_hdr_data() - fill ieee802.11 data header
  86. * @txrx_pdev: txrx pdev
  87. * @pl_msdu_info: msdu info
  88. * @data: data received from event
  89. *
  90. * Return: none
  91. */
  92. /* TODO: Platform specific function */
  93. static void
  94. fill_ieee80211_hdr_data(struct cdp_pdev *pdev,
  95. struct ath_pktlog_msdu_info *pl_msdu_info,
  96. void *data)
  97. {
  98. uint32_t i;
  99. uint32_t *htt_tx_desc;
  100. struct ol_tx_desc_t *tx_desc;
  101. uint8_t msdu_id_offset = MSDU_ID_INFO_ID_OFFSET;
  102. uint16_t tx_desc_id;
  103. uint32_t *msdu_id_info = (uint32_t *)
  104. ((void *)data + sizeof(struct ath_pktlog_hdr));
  105. uint32_t *msdu_id = (uint32_t *)((char *)msdu_id_info +
  106. msdu_id_offset);
  107. uint8_t *addr, *vap_addr;
  108. uint8_t vdev_id;
  109. qdf_nbuf_t netbuf;
  110. uint32_t len;
  111. struct ol_txrx_pdev_t *txrx_pdev = (struct ol_txrx_pdev_t *)pdev;
  112. pl_msdu_info->num_msdu = *msdu_id_info;
  113. pl_msdu_info->priv_size = sizeof(uint32_t) *
  114. pl_msdu_info->num_msdu + sizeof(uint32_t);
  115. if (pl_msdu_info->num_msdu > MAX_PKT_INFO_MSDU_ID) {
  116. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  117. "%s: Invalid num_msdu count",
  118. __func__);
  119. qdf_assert(0);
  120. return;
  121. }
  122. for (i = 0; i < pl_msdu_info->num_msdu; i++) {
  123. /*
  124. * Handle big endianness
  125. * Increment msdu_id once after retrieving
  126. * lower 16 bits and uppper 16 bits
  127. */
  128. if (!(i % 2)) {
  129. tx_desc_id = ((*msdu_id & TX_DESC_ID_LOW_MASK)
  130. >> TX_DESC_ID_LOW_SHIFT);
  131. } else {
  132. tx_desc_id = ((*msdu_id & TX_DESC_ID_HIGH_MASK)
  133. >> TX_DESC_ID_HIGH_SHIFT);
  134. msdu_id += 1;
  135. }
  136. if (tx_desc_id >= txrx_pdev->tx_desc.pool_size) {
  137. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_DEBUG,
  138. "%s: drop due to invalid msdu id = %x",
  139. __func__, tx_desc_id);
  140. return;
  141. }
  142. tx_desc = ol_tx_desc_find(txrx_pdev, tx_desc_id);
  143. qdf_assert(tx_desc);
  144. netbuf = tx_desc->netbuf;
  145. htt_tx_desc = (uint32_t *)tx_desc->htt_tx_desc;
  146. qdf_assert(htt_tx_desc);
  147. qdf_nbuf_peek_header(netbuf, &addr, &len);
  148. if (len < (2 * QDF_MAC_ADDR_SIZE)) {
  149. qdf_print("TX frame does not have a valid address");
  150. return;
  151. }
  152. /* Adding header information for the TX data frames */
  153. vdev_id = (uint8_t)(*(htt_tx_desc +
  154. HTT_TX_VDEV_ID_WORD) >>
  155. HTT_TX_VDEV_ID_SHIFT) &
  156. HTT_TX_VDEV_ID_MASK;
  157. vap_addr = wma_get_vdev_address_by_vdev_id(vdev_id);
  158. frm_hdr.da_tail = (addr[QDF_MAC_ADDR_SIZE - 2] << 8) |
  159. (addr[QDF_MAC_ADDR_SIZE - 1]);
  160. frm_hdr.sa_tail =
  161. (addr[2 * QDF_MAC_ADDR_SIZE - 2] << 8) |
  162. (addr[2 * QDF_MAC_ADDR_SIZE - 1]);
  163. if (vap_addr) {
  164. frm_hdr.bssid_tail =
  165. (vap_addr[QDF_MAC_ADDR_SIZE - 2] << 8) |
  166. (vap_addr[QDF_MAC_ADDR_SIZE - 1]);
  167. } else {
  168. frm_hdr.bssid_tail = 0x0000;
  169. }
  170. pl_msdu_info->priv.msdu_len[i] = *(htt_tx_desc +
  171. HTT_TX_MSDU_LEN_DWORD)
  172. & HTT_TX_MSDU_LEN_MASK;
  173. /*
  174. * Add more information per MSDU
  175. * e.g., protocol information
  176. */
  177. }
  178. }
  179. #endif /* HELIUMPLUS */
  180. #ifdef HELIUMPLUS
  181. A_STATUS process_tx_info(struct cdp_pdev *txrx_pdev, void *data)
  182. {
  183. /*
  184. * Must include to process different types
  185. * TX_CTL, TX_STATUS, TX_MSDU_ID, TX_FRM_HDR
  186. */
  187. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  188. struct ath_pktlog_hdr pl_hdr;
  189. struct ath_pktlog_info *pl_info;
  190. uint32_t *pl_tgt_hdr;
  191. struct ol_fw_data *fw_data;
  192. uint32_t len;
  193. if (!txrx_pdev) {
  194. qdf_info("Invalid pdev");
  195. return A_ERROR;
  196. }
  197. if (!pl_dev) {
  198. qdf_err("Invalid pktlog handle");
  199. qdf_assert(pl_dev);
  200. return A_ERROR;
  201. }
  202. qdf_assert(data);
  203. fw_data = (struct ol_fw_data *)data;
  204. len = fw_data->len;
  205. if (len < (sizeof(uint32_t) *
  206. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  207. len < (sizeof(uint32_t) *
  208. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  209. len < (sizeof(uint32_t) *
  210. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  211. len < (sizeof(uint32_t) *
  212. (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
  213. len < (sizeof(uint32_t) *
  214. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  215. len < (sizeof(uint32_t) *
  216. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  217. qdf_print("Invalid msdu len");
  218. qdf_assert(0);
  219. return A_ERROR;
  220. }
  221. pl_tgt_hdr = (uint32_t *)fw_data->data;
  222. /*
  223. * Makes the short words (16 bits) portable b/w little endian
  224. * and big endian
  225. */
  226. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  227. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  228. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  229. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  230. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  231. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  232. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  233. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  234. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  235. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  236. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  237. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  238. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  239. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  240. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  241. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  242. pl_hdr.type_specific_data =
  243. *(pl_tgt_hdr + ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET);
  244. pl_info = pl_dev->pl_info;
  245. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  246. qdf_assert(0);
  247. return A_ERROR;
  248. }
  249. if (pl_hdr.log_type == PKTLOG_TYPE_TX_CTRL) {
  250. size_t log_size = sizeof(frm_hdr) + pl_hdr.size;
  251. void *txdesc_hdr_ctl = (void *)
  252. pktlog_getbuf(pl_dev, pl_info,
  253. log_size, &pl_hdr);
  254. qdf_assert(txdesc_hdr_ctl);
  255. qdf_assert(pl_hdr.size < (370 * sizeof(u_int32_t)));
  256. qdf_mem_copy(txdesc_hdr_ctl, &frm_hdr, sizeof(frm_hdr));
  257. qdf_mem_copy((char *)txdesc_hdr_ctl + sizeof(frm_hdr),
  258. ((void *)fw_data->data +
  259. sizeof(struct ath_pktlog_hdr)),
  260. pl_hdr.size);
  261. pl_hdr.size = log_size;
  262. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  263. txdesc_hdr_ctl);
  264. }
  265. if (pl_hdr.log_type == PKTLOG_TYPE_TX_STAT) {
  266. struct ath_pktlog_tx_status txstat_log;
  267. size_t log_size = pl_hdr.size;
  268. txstat_log.ds_status = (void *)
  269. pktlog_getbuf(pl_dev, pl_info,
  270. log_size, &pl_hdr);
  271. qdf_assert(txstat_log.ds_status);
  272. qdf_mem_copy(txstat_log.ds_status,
  273. ((void *)fw_data->data +
  274. sizeof(struct ath_pktlog_hdr)),
  275. pl_hdr.size);
  276. /* TODO: MCL specific API */
  277. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  278. txstat_log.ds_status);
  279. }
  280. return A_OK;
  281. }
  282. #else
  283. A_STATUS process_tx_info(struct cdp_pdev *txrx_pdev, void *data)
  284. {
  285. /*
  286. * Must include to process different types
  287. * TX_CTL, TX_STATUS, TX_MSDU_ID, TX_FRM_HDR
  288. */
  289. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  290. struct ath_pktlog_hdr pl_hdr;
  291. struct ath_pktlog_info *pl_info;
  292. uint32_t *pl_tgt_hdr;
  293. struct ol_fw_data *fw_data;
  294. uint32_t len;
  295. if (!txrx_pdev) {
  296. qdf_print("Invalid pdev");
  297. return A_ERROR;
  298. }
  299. if (!pl_dev) {
  300. qdf_err("Invalid pktlog handle");
  301. qdf_assert(pl_dev);
  302. return A_ERROR;
  303. }
  304. qdf_assert(data);
  305. fw_data = (struct ol_fw_data *)data;
  306. len = fw_data->len;
  307. if (len < (sizeof(uint32_t) *
  308. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  309. len < (sizeof(uint32_t) *
  310. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  311. len < (sizeof(uint32_t) *
  312. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  313. len < (sizeof(uint32_t) *
  314. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  315. len < (sizeof(uint32_t) *
  316. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  317. qdf_print("Invalid msdu len");
  318. qdf_assert(0);
  319. return A_ERROR;
  320. }
  321. pl_tgt_hdr = (uint32_t *)fw_data->data;
  322. /*
  323. * Makes the short words (16 bits) portable b/w little endian
  324. * and big endian
  325. */
  326. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  327. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  328. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  329. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  330. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  331. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  332. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  333. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  334. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  335. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  336. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  337. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  338. pktlog_hdr_set_specific_data(&pl_hdr,
  339. *(pl_tgt_hdr +
  340. ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET));
  341. pl_info = pl_dev->pl_info;
  342. if (pl_hdr.log_type == PKTLOG_TYPE_TX_FRM_HDR) {
  343. /* Valid only for the TX CTL */
  344. process_ieee_hdr(fw_data->data + sizeof(pl_hdr));
  345. }
  346. if (pl_hdr.log_type == PKTLOG_TYPE_TX_VIRT_ADDR) {
  347. uint32_t desc_id = (uint32_t)*((uint32_t *)(fw_data->data +
  348. sizeof(pl_hdr)));
  349. uint32_t vdev_id = desc_id;
  350. /* if the pkt log msg is for the bcn frame the vdev id
  351. * is piggybacked in desc_id and the MSB of the desc ID
  352. * would be set to FF
  353. */
  354. #define BCN_DESC_ID 0xFF
  355. if ((desc_id >> 24) == BCN_DESC_ID) {
  356. void *data;
  357. uint32_t buf_size;
  358. vdev_id &= 0x00FFFFFF;
  359. /* TODO: MCL specific API */
  360. data = wma_get_beacon_buffer_by_vdev_id(vdev_id,
  361. &buf_size);
  362. if (data) {
  363. /* TODO: platform specific API */
  364. process_ieee_hdr(data);
  365. qdf_mem_free(data);
  366. }
  367. } else {
  368. /*
  369. * TODO: get the hdr content for mgmt frames from
  370. * Tx mgmt desc pool
  371. */
  372. }
  373. }
  374. if (pl_hdr.log_type == PKTLOG_TYPE_TX_CTRL) {
  375. struct ath_pktlog_txctl txctl_log;
  376. size_t log_size = sizeof(txctl_log.priv);
  377. txctl_log.txdesc_hdr_ctl = (void *)pktlog_getbuf(pl_dev,
  378. pl_info,
  379. log_size,
  380. &pl_hdr);
  381. if (!txctl_log.txdesc_hdr_ctl) {
  382. qdf_nofl_info
  383. ("failed to get txctl_log.txdesc_hdr_ctl buf");
  384. return A_ERROR;
  385. }
  386. /*
  387. * frm hdr is currently Valid only for local frames
  388. * Add capability to include the fmr hdr for remote frames
  389. */
  390. txctl_log.priv.frm_hdr = frm_hdr;
  391. qdf_assert(txctl_log.priv.txdesc_ctl);
  392. qdf_assert(pl_hdr.size < sizeof(txctl_log.priv.txdesc_ctl));
  393. pl_hdr.size = (pl_hdr.size > sizeof(txctl_log.priv.txdesc_ctl))
  394. ? sizeof(txctl_log.priv.txdesc_ctl) :
  395. pl_hdr.size;
  396. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  397. qdf_assert(0);
  398. return A_ERROR;
  399. }
  400. qdf_mem_copy((void *)&txctl_log.priv.txdesc_ctl,
  401. ((void *)fw_data->data +
  402. sizeof(struct ath_pktlog_hdr)),
  403. pl_hdr.size);
  404. qdf_assert(txctl_log.txdesc_hdr_ctl);
  405. qdf_mem_copy(txctl_log.txdesc_hdr_ctl, &txctl_log.priv,
  406. sizeof(txctl_log.priv));
  407. pl_hdr.size = log_size;
  408. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  409. txctl_log.txdesc_hdr_ctl);
  410. /* Add Protocol information and HT specific information */
  411. }
  412. if (pl_hdr.log_type == PKTLOG_TYPE_TX_STAT) {
  413. struct ath_pktlog_tx_status txstat_log;
  414. size_t log_size = pl_hdr.size;
  415. txstat_log.ds_status = (void *)
  416. pktlog_getbuf(pl_dev, pl_info,
  417. log_size, &pl_hdr);
  418. qdf_assert(txstat_log.ds_status);
  419. qdf_mem_copy(txstat_log.ds_status,
  420. ((void *)fw_data->data +
  421. sizeof(struct ath_pktlog_hdr)),
  422. pl_hdr.size);
  423. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  424. txstat_log.ds_status);
  425. }
  426. if (pl_hdr.log_type == PKTLOG_TYPE_TX_MSDU_ID) {
  427. struct ath_pktlog_msdu_info pl_msdu_info;
  428. size_t log_size;
  429. qdf_mem_zero(&pl_msdu_info, sizeof(pl_msdu_info));
  430. log_size = sizeof(pl_msdu_info.priv);
  431. if (pl_dev->mt_pktlog_enabled == false)
  432. fill_ieee80211_hdr_data(txrx_pdev,
  433. &pl_msdu_info, fw_data->data);
  434. pl_msdu_info.ath_msdu_info = pktlog_getbuf(pl_dev, pl_info,
  435. log_size, &pl_hdr);
  436. qdf_mem_copy((void *)&pl_msdu_info.priv.msdu_id_info,
  437. ((void *)fw_data->data +
  438. sizeof(struct ath_pktlog_hdr)),
  439. sizeof(pl_msdu_info.priv.msdu_id_info));
  440. qdf_mem_copy(pl_msdu_info.ath_msdu_info, &pl_msdu_info.priv,
  441. sizeof(pl_msdu_info.priv));
  442. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  443. pl_msdu_info.ath_msdu_info);
  444. }
  445. return A_OK;
  446. }
  447. #endif /* HELIUMPLUS */
  448. A_STATUS process_rx_info_remote(void *pdev, void *data)
  449. {
  450. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  451. struct ath_pktlog_info *pl_info;
  452. struct htt_host_rx_desc_base *rx_desc;
  453. struct ath_pktlog_hdr pl_hdr;
  454. struct ath_pktlog_rx_info rxstat_log;
  455. size_t log_size;
  456. struct ol_rx_remote_data *r_data = (struct ol_rx_remote_data *)data;
  457. qdf_nbuf_t msdu;
  458. if (!pdev || !r_data || !pl_dev) {
  459. qdf_print("Invalid handle");
  460. return A_ERROR;
  461. }
  462. pl_info = pl_dev->pl_info;
  463. msdu = r_data->msdu;
  464. while (msdu) {
  465. rx_desc =
  466. (struct htt_host_rx_desc_base *)(qdf_nbuf_data(msdu)) - 1;
  467. log_size =
  468. sizeof(*rx_desc) - sizeof(struct htt_host_fw_desc_base);
  469. /*
  470. * Construct the pktlog header pl_hdr
  471. * Because desc is DMA'd to the host memory
  472. */
  473. pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
  474. pl_hdr.missed_cnt = 0;
  475. #if defined(HELIUMPLUS)
  476. pl_hdr.macId = r_data->mac_id;
  477. pl_hdr.log_type = PKTLOG_TYPE_RX_STAT;
  478. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  479. #else
  480. pl_hdr.log_type = PKTLOG_TYPE_RX_STAT;
  481. #endif
  482. pl_hdr.size = sizeof(*rx_desc) -
  483. sizeof(struct htt_host_fw_desc_base);
  484. #if defined(HELIUMPLUS)
  485. pl_hdr.timestamp =
  486. rx_desc->ppdu_end.rx_pkt_end.phy_timestamp_1_lower_32;
  487. pl_hdr.type_specific_data = 0xDEADAA;
  488. #else
  489. pl_hdr.timestamp = rx_desc->ppdu_end.tsf_timestamp;
  490. #endif /* !defined(HELIUMPLUS) */
  491. pktlog_hdr_set_specific_data(&pl_hdr, 0xDEADAA);
  492. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  493. log_size, &pl_hdr);
  494. qdf_mem_copy(rxstat_log.rx_desc, (void *)rx_desc +
  495. sizeof(struct htt_host_fw_desc_base), pl_hdr.size);
  496. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  497. rxstat_log.rx_desc);
  498. msdu = qdf_nbuf_next(msdu);
  499. }
  500. return A_OK;
  501. }
  502. #ifdef HELIUMPLUS
  503. A_STATUS process_rx_info(void *pdev, void *data)
  504. {
  505. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  506. struct ath_pktlog_info *pl_info;
  507. struct ath_pktlog_rx_info rxstat_log;
  508. struct ath_pktlog_hdr pl_hdr;
  509. size_t log_size;
  510. uint32_t *pl_tgt_hdr;
  511. struct ol_fw_data *fw_data;
  512. uint32_t len;
  513. if (!pdev) {
  514. qdf_info("Invalid pdev");
  515. return A_ERROR;
  516. }
  517. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  518. if (!pl_dev) {
  519. qdf_info("Invalid pl_dev");
  520. return A_ERROR;
  521. }
  522. fw_data = (struct ol_fw_data *)data;
  523. len = fw_data->len;
  524. if (len < (sizeof(uint32_t) *
  525. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  526. len < (sizeof(uint32_t) *
  527. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  528. len < (sizeof(uint32_t) *
  529. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  530. len < (sizeof(uint32_t) *
  531. (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
  532. len < (sizeof(uint32_t) *
  533. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  534. len < (sizeof(uint32_t) *
  535. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  536. qdf_print("Invalid msdu len");
  537. qdf_assert(0);
  538. return A_ERROR;
  539. }
  540. pl_info = pl_dev->pl_info;
  541. pl_tgt_hdr = (uint32_t *)fw_data->data;
  542. qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
  543. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  544. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  545. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  546. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  547. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  548. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  549. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  550. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  551. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  552. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  553. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  554. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  555. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  556. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  557. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  558. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  559. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  560. qdf_assert(0);
  561. return A_ERROR;
  562. }
  563. log_size = pl_hdr.size;
  564. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  565. log_size, &pl_hdr);
  566. qdf_mem_copy(rxstat_log.rx_desc,
  567. (void *)fw_data->data + sizeof(struct ath_pktlog_hdr),
  568. pl_hdr.size);
  569. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
  570. return A_OK;
  571. }
  572. #else
  573. A_STATUS process_rx_info(void *pdev, void *data)
  574. {
  575. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  576. struct ath_pktlog_info *pl_info;
  577. struct ath_pktlog_rx_info rxstat_log;
  578. struct ath_pktlog_hdr pl_hdr;
  579. size_t log_size;
  580. uint32_t *pl_tgt_hdr;
  581. struct ol_fw_data *fw_data;
  582. uint32_t len;
  583. if (!pdev) {
  584. qdf_info("Invalid pdev");
  585. return A_ERROR;
  586. }
  587. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  588. if (!pl_dev) {
  589. qdf_info("Invalid pl_dev");
  590. return A_ERROR;
  591. }
  592. fw_data = (struct ol_fw_data *)data;
  593. len = fw_data->len;
  594. if (len < (sizeof(uint32_t) *
  595. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  596. len < (sizeof(uint32_t) *
  597. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  598. len < (sizeof(uint32_t) *
  599. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  600. len < (sizeof(uint32_t) *
  601. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  602. len < (sizeof(uint32_t) *
  603. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  604. qdf_print("Invalid msdu len");
  605. qdf_assert(0);
  606. return A_ERROR;
  607. }
  608. pl_info = pl_dev->pl_info;
  609. pl_tgt_hdr = (uint32_t *)fw_data->data;
  610. qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
  611. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  612. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  613. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  614. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  615. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  616. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  617. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  618. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  619. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  620. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  621. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  622. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  623. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  624. qdf_assert(0);
  625. return A_ERROR;
  626. }
  627. log_size = pl_hdr.size;
  628. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  629. log_size, &pl_hdr);
  630. qdf_mem_copy(rxstat_log.rx_desc,
  631. (void *)fw_data->data + sizeof(struct ath_pktlog_hdr),
  632. pl_hdr.size);
  633. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
  634. return A_OK;
  635. }
  636. #endif /* HELIUMPLUS */
  637. #ifdef HELIUMPLUS
  638. A_STATUS process_rate_find(void *pdev, void *data)
  639. {
  640. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  641. struct ath_pktlog_hdr pl_hdr;
  642. struct ath_pktlog_info *pl_info;
  643. size_t log_size;
  644. uint32_t len;
  645. struct ol_fw_data *fw_data;
  646. /*
  647. * Will be uncommented when the rate control find
  648. * for pktlog is implemented in the firmware.
  649. * Currently derived from the TX PPDU status
  650. */
  651. struct ath_pktlog_rc_find rcf_log;
  652. uint32_t *pl_tgt_hdr;
  653. if (!pdev || !data || !pl_dev) {
  654. qdf_print("Invalid handle");
  655. return A_ERROR;
  656. }
  657. fw_data = (struct ol_fw_data *)data;
  658. len = fw_data->len;
  659. if (len < (sizeof(uint32_t) *
  660. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  661. len < (sizeof(uint32_t) *
  662. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  663. len < (sizeof(uint32_t) *
  664. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  665. len < (sizeof(uint32_t) *
  666. (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
  667. len < (sizeof(uint32_t) *
  668. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  669. len < (sizeof(uint32_t) *
  670. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  671. qdf_print("Invalid msdu len");
  672. qdf_assert(0);
  673. return A_ERROR;
  674. }
  675. pl_tgt_hdr = (uint32_t *)fw_data->data;
  676. /*
  677. * Makes the short words (16 bits) portable b/w little endian
  678. * and big endian
  679. */
  680. qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
  681. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  682. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  683. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  684. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  685. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  686. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  687. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  688. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  689. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  690. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  691. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  692. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  693. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  694. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  695. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  696. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  697. pl_info = pl_dev->pl_info;
  698. log_size = pl_hdr.size;
  699. rcf_log.rcFind = (void *)pktlog_getbuf(pl_dev, pl_info,
  700. log_size, &pl_hdr);
  701. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  702. qdf_assert(0);
  703. return A_ERROR;
  704. }
  705. qdf_mem_copy(rcf_log.rcFind,
  706. ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
  707. pl_hdr.size);
  708. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcf_log.rcFind);
  709. return A_OK;
  710. }
  711. #else
  712. A_STATUS process_rate_find(void *pdev, void *data)
  713. {
  714. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  715. struct ath_pktlog_hdr pl_hdr;
  716. struct ath_pktlog_info *pl_info;
  717. size_t log_size;
  718. uint32_t len;
  719. struct ol_fw_data *fw_data;
  720. /*
  721. * Will be uncommented when the rate control find
  722. * for pktlog is implemented in the firmware.
  723. * Currently derived from the TX PPDU status
  724. */
  725. struct ath_pktlog_rc_find rcf_log;
  726. uint32_t *pl_tgt_hdr;
  727. if (!pdev || !data || !pl_dev) {
  728. qdf_print("Invalid handle");
  729. return A_ERROR;
  730. }
  731. fw_data = (struct ol_fw_data *)data;
  732. len = fw_data->len;
  733. if (len < (sizeof(uint32_t) *
  734. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  735. len < (sizeof(uint32_t) *
  736. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  737. len < (sizeof(uint32_t) *
  738. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  739. len < (sizeof(uint32_t) *
  740. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  741. len < (sizeof(uint32_t) *
  742. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  743. qdf_print("Invalid msdu len");
  744. qdf_assert(0);
  745. return A_ERROR;
  746. }
  747. pl_tgt_hdr = (uint32_t *)fw_data->data;
  748. /*
  749. * Makes the short words (16 bits) portable b/w little endian
  750. * and big endian
  751. */
  752. qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
  753. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  754. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  755. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  756. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  757. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  758. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  759. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  760. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  761. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  762. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  763. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  764. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  765. pl_info = pl_dev->pl_info;
  766. log_size = pl_hdr.size;
  767. rcf_log.rcFind = (void *)pktlog_getbuf(pl_dev, pl_info,
  768. log_size, &pl_hdr);
  769. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  770. qdf_assert(0);
  771. return A_ERROR;
  772. }
  773. qdf_mem_copy(rcf_log.rcFind,
  774. ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
  775. pl_hdr.size);
  776. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcf_log.rcFind);
  777. return A_OK;
  778. }
  779. #endif
  780. #ifdef HELIUMPLUS
  781. A_STATUS process_rate_update(void *pdev, void *data)
  782. {
  783. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  784. struct ath_pktlog_hdr pl_hdr;
  785. size_t log_size;
  786. struct ath_pktlog_info *pl_info;
  787. struct ath_pktlog_rc_update rcu_log;
  788. uint32_t *pl_tgt_hdr;
  789. struct ol_fw_data *fw_data;
  790. uint32_t len;
  791. if (!pdev || !data || !pl_dev) {
  792. qdf_print("Invalid handle");
  793. return A_ERROR;
  794. }
  795. fw_data = (struct ol_fw_data *)data;
  796. len = fw_data->len;
  797. if (len < (sizeof(uint32_t) *
  798. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  799. len < (sizeof(uint32_t) *
  800. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  801. len < (sizeof(uint32_t) *
  802. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  803. len < (sizeof(uint32_t) *
  804. (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
  805. len < (sizeof(uint32_t) *
  806. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  807. len < (sizeof(uint32_t) *
  808. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  809. qdf_print("Invalid msdu len");
  810. qdf_assert(0);
  811. return A_ERROR;
  812. }
  813. pl_tgt_hdr = (uint32_t *)fw_data->data;
  814. /*
  815. * Makes the short words (16 bits) portable b/w little endian
  816. * and big endian
  817. */
  818. qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
  819. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  820. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  821. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  822. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  823. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  824. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  825. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  826. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  827. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  828. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  829. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  830. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  831. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  832. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  833. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  834. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  835. log_size = pl_hdr.size;
  836. pl_info = pl_dev->pl_info;
  837. /*
  838. * Will be uncommented when the rate control update
  839. * for pktlog is implemented in the firmware.
  840. * Currently derived from the TX PPDU status
  841. */
  842. rcu_log.txRateCtrl = (void *)pktlog_getbuf(pl_dev, pl_info,
  843. log_size, &pl_hdr);
  844. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  845. qdf_assert(0);
  846. return A_ERROR;
  847. }
  848. qdf_mem_copy(rcu_log.txRateCtrl,
  849. ((char *)fw_data->data +
  850. sizeof(struct ath_pktlog_hdr)),
  851. pl_hdr.size);
  852. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcu_log.txRateCtrl);
  853. return A_OK;
  854. }
  855. #else
  856. A_STATUS process_rate_update(void *pdev, void *data)
  857. {
  858. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  859. struct ath_pktlog_hdr pl_hdr;
  860. size_t log_size;
  861. struct ath_pktlog_info *pl_info;
  862. struct ath_pktlog_rc_update rcu_log;
  863. uint32_t *pl_tgt_hdr;
  864. struct ol_fw_data *fw_data;
  865. uint32_t len;
  866. if (!pdev || !data || !pl_dev) {
  867. qdf_print("Invalid handle");
  868. return A_ERROR;
  869. }
  870. fw_data = (struct ol_fw_data *)data;
  871. len = fw_data->len;
  872. if (len < (sizeof(uint32_t) *
  873. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  874. len < (sizeof(uint32_t) *
  875. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  876. len < (sizeof(uint32_t) *
  877. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  878. len < (sizeof(uint32_t) *
  879. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  880. len < (sizeof(uint32_t) *
  881. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  882. qdf_print("Invalid msdu len");
  883. qdf_assert(0);
  884. return A_ERROR;
  885. }
  886. pl_tgt_hdr = (uint32_t *)fw_data->data;
  887. /*
  888. * Makes the short words (16 bits) portable b/w little endian
  889. * and big endian
  890. */
  891. qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
  892. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  893. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  894. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  895. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  896. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  897. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  898. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  899. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  900. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  901. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  902. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  903. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  904. log_size = pl_hdr.size;
  905. pl_info = pl_dev->pl_info;
  906. /*
  907. * Will be uncommented when the rate control update
  908. * for pktlog is implemented in the firmware.
  909. * Currently derived from the TX PPDU status
  910. */
  911. rcu_log.txRateCtrl = (void *)pktlog_getbuf(pl_dev, pl_info,
  912. log_size, &pl_hdr);
  913. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  914. qdf_assert(0);
  915. return A_ERROR;
  916. }
  917. qdf_mem_copy(rcu_log.txRateCtrl,
  918. ((char *)fw_data->data +
  919. sizeof(struct ath_pktlog_hdr)),
  920. pl_hdr.size);
  921. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcu_log.txRateCtrl);
  922. return A_OK;
  923. }
  924. #endif /* HELIUMPLUS */
  925. #ifdef HELIUMPLUS
  926. A_STATUS process_sw_event(void *pdev, void *data)
  927. {
  928. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  929. struct ath_pktlog_hdr pl_hdr;
  930. struct ath_pktlog_info *pl_info;
  931. size_t log_size;
  932. uint32_t len;
  933. struct ol_fw_data *fw_data;
  934. /*
  935. * Will be uncommented when the rate control find
  936. * for pktlog is implemented in the firmware.
  937. * Currently derived from the TX PPDU status
  938. */
  939. struct ath_pktlog_sw_event sw_event;
  940. uint32_t *pl_tgt_hdr;
  941. if (!pdev) {
  942. qdf_print("Invalid pdev");
  943. return A_ERROR;
  944. }
  945. if (!data) {
  946. qdf_print("Invalid data");
  947. return A_ERROR;
  948. }
  949. if (!pl_dev) {
  950. qdf_print("Invalid pl_dev");
  951. return A_ERROR;
  952. }
  953. fw_data = (struct ol_fw_data *)data;
  954. len = fw_data->len;
  955. if (len < (sizeof(uint32_t) *
  956. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  957. len < (sizeof(uint32_t) *
  958. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  959. len < (sizeof(uint32_t) *
  960. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  961. len < (sizeof(uint32_t) *
  962. (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
  963. len < (sizeof(uint32_t) *
  964. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  965. len < (sizeof(uint32_t) *
  966. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  967. qdf_print("Invalid msdu len");
  968. qdf_assert(0);
  969. return A_ERROR;
  970. }
  971. pl_tgt_hdr = (uint32_t *)fw_data->data;
  972. /*
  973. * Makes the short words (16 bits) portable b/w little endian
  974. * and big endian
  975. */
  976. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  977. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  978. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  979. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  980. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  981. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  982. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  983. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  984. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  985. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  986. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  987. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  988. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  989. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  990. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  991. pl_hdr.type_specific_data =
  992. *(pl_tgt_hdr + ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET);
  993. pl_info = pl_dev->pl_info;
  994. log_size = pl_hdr.size;
  995. sw_event.sw_event = (void *)pktlog_getbuf(pl_dev, pl_info,
  996. log_size, &pl_hdr);
  997. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  998. qdf_assert(0);
  999. return A_ERROR;
  1000. }
  1001. qdf_mem_copy(sw_event.sw_event,
  1002. ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
  1003. pl_hdr.size);
  1004. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, sw_event.sw_event);
  1005. return A_OK;
  1006. }
  1007. #else
  1008. A_STATUS process_sw_event(void *pdev, void *data)
  1009. {
  1010. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  1011. struct ath_pktlog_hdr pl_hdr;
  1012. struct ath_pktlog_info *pl_info;
  1013. size_t log_size;
  1014. uint32_t len;
  1015. struct ol_fw_data *fw_data;
  1016. /*
  1017. * Will be uncommented when the rate control find
  1018. * for pktlog is implemented in the firmware.
  1019. * Currently derived from the TX PPDU status
  1020. */
  1021. struct ath_pktlog_sw_event sw_event;
  1022. uint32_t *pl_tgt_hdr;
  1023. if (!pdev) {
  1024. qdf_print("Invalid pdev");
  1025. return A_ERROR;
  1026. }
  1027. if (!data) {
  1028. qdf_print("Invalid data");
  1029. return A_ERROR;
  1030. }
  1031. if (!pl_dev) {
  1032. qdf_print("Invalid pl_dev");
  1033. return A_ERROR;
  1034. }
  1035. fw_data = (struct ol_fw_data *)data;
  1036. len = fw_data->len;
  1037. if (len < (sizeof(uint32_t) *
  1038. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  1039. len < (sizeof(uint32_t) *
  1040. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  1041. len < (sizeof(uint32_t) *
  1042. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  1043. len < (sizeof(uint32_t) *
  1044. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  1045. len < (sizeof(uint32_t) *
  1046. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  1047. qdf_print("Invalid msdu len");
  1048. qdf_assert(0);
  1049. return A_ERROR;
  1050. }
  1051. pl_tgt_hdr = (uint32_t *)fw_data->data;
  1052. /*
  1053. * Makes the short words (16 bits) portable b/w little endian
  1054. * and big endian
  1055. */
  1056. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  1057. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  1058. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  1059. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  1060. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  1061. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  1062. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  1063. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  1064. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  1065. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  1066. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  1067. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  1068. pktlog_hdr_set_specific_data(&pl_hdr,
  1069. *(pl_tgt_hdr +
  1070. ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET));
  1071. pl_info = pl_dev->pl_info;
  1072. log_size = pl_hdr.size;
  1073. sw_event.sw_event = (void *)pktlog_getbuf(pl_dev, pl_info,
  1074. log_size, &pl_hdr);
  1075. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  1076. qdf_assert(0);
  1077. return A_ERROR;
  1078. }
  1079. qdf_mem_copy(sw_event.sw_event,
  1080. ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
  1081. pl_hdr.size);
  1082. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, sw_event.sw_event);
  1083. return A_OK;
  1084. }
  1085. #endif /* HELIUMPLUS */
  1086. #endif /* REMOVE_PKT_LOG */