pktlog_internal.c 44 KB

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