pktlog_internal.c 43 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478
  1. /*
  2. * Copyright (c) 2013-2018 The Linux Foundation. All rights reserved.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for
  5. * any purpose with or without fee is hereby granted, provided that the
  6. * above copyright notice and this permission notice appear in all
  7. * copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  10. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  11. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  12. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  13. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  14. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  15. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  16. * PERFORMANCE OF THIS SOFTWARE.
  17. */
  18. /*
  19. *
  20. * Permission to use, copy, modify, and/or distribute this software for any
  21. * purpose with or without fee is hereby granted, provided that the above
  22. * copyright notice and this permission notice appear in all copies.
  23. *
  24. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  25. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  26. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  27. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  28. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  29. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  30. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  31. */
  32. #ifndef REMOVE_PKT_LOG
  33. #include "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[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  166. i_addr1
  167. [IEEE80211_ADDR_LEN
  168. - 1]);
  169. frm_hdr.sa_tail =
  170. (wh->i_addr2[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  171. i_addr2
  172. [IEEE80211_ADDR_LEN
  173. - 1]);
  174. frm_hdr.da_tail =
  175. (wh->i_addr3[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  176. i_addr3
  177. [IEEE80211_ADDR_LEN
  178. - 1]);
  179. } else if (dir == IEEE80211_FC1_DIR_FROMDS) {
  180. frm_hdr.bssid_tail =
  181. (wh->i_addr2[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  182. i_addr2
  183. [IEEE80211_ADDR_LEN
  184. - 1]);
  185. frm_hdr.sa_tail =
  186. (wh->i_addr3[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  187. i_addr3
  188. [IEEE80211_ADDR_LEN
  189. - 1]);
  190. frm_hdr.da_tail =
  191. (wh->i_addr1[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  192. i_addr1
  193. [IEEE80211_ADDR_LEN
  194. - 1]);
  195. } else {
  196. frm_hdr.bssid_tail =
  197. (wh->i_addr3[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  198. i_addr3
  199. [IEEE80211_ADDR_LEN
  200. - 1]);
  201. frm_hdr.sa_tail =
  202. (wh->i_addr2[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  203. i_addr2
  204. [IEEE80211_ADDR_LEN
  205. - 1]);
  206. frm_hdr.da_tail =
  207. (wh->i_addr1[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
  208. i_addr1
  209. [IEEE80211_ADDR_LEN
  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 * IEEE80211_ADDR_LEN)) {
  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[IEEE80211_ADDR_LEN - 2] << 8) |
  287. (addr[IEEE80211_ADDR_LEN - 1]);
  288. frm_hdr.sa_tail =
  289. (addr[2 * IEEE80211_ADDR_LEN - 2] << 8) |
  290. (addr[2 * IEEE80211_ADDR_LEN - 1]);
  291. if (vap_addr) {
  292. frm_hdr.bssid_tail =
  293. (vap_addr[IEEE80211_ADDR_LEN - 2] << 8) |
  294. (vap_addr[IEEE80211_ADDR_LEN - 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_info = pl_dev->pl_info;
  466. if (pl_hdr.log_type == PKTLOG_TYPE_TX_FRM_HDR) {
  467. /* Valid only for the TX CTL */
  468. process_ieee_hdr(fw_data->data + sizeof(pl_hdr));
  469. }
  470. if (pl_hdr.log_type == PKTLOG_TYPE_TX_VIRT_ADDR) {
  471. uint32_t desc_id = (uint32_t) *((uint32_t *)(fw_data->data +
  472. sizeof(pl_hdr)));
  473. uint32_t vdev_id = desc_id;
  474. /* if the pkt log msg is for the bcn frame the vdev id
  475. * is piggybacked in desc_id and the MSB of the desc ID
  476. * would be set to FF
  477. */
  478. #define BCN_DESC_ID 0xFF
  479. if ((desc_id >> 24) == BCN_DESC_ID) {
  480. void *data;
  481. uint32_t buf_size;
  482. vdev_id &= 0x00FFFFFF;
  483. /* TODO: MCL specific API */
  484. data = wma_get_beacon_buffer_by_vdev_id(vdev_id,
  485. &buf_size);
  486. if (data) {
  487. /* TODO: platform specific API */
  488. process_ieee_hdr(data);
  489. qdf_mem_free(data);
  490. }
  491. } else {
  492. /*
  493. * TODO: get the hdr content for mgmt frames from
  494. * Tx mgmt desc pool
  495. */
  496. }
  497. }
  498. if (pl_hdr.log_type == PKTLOG_TYPE_TX_CTRL) {
  499. struct ath_pktlog_txctl txctl_log;
  500. size_t log_size = sizeof(txctl_log.priv);
  501. txctl_log.txdesc_hdr_ctl = (void *)pktlog_getbuf(pl_dev,
  502. pl_info,
  503. log_size,
  504. &pl_hdr);
  505. if (!txctl_log.txdesc_hdr_ctl) {
  506. printk
  507. ("failed to get buf for txctl_log.txdesc_hdr_ctl\n");
  508. return A_ERROR;
  509. }
  510. /*
  511. * frm hdr is currently Valid only for local frames
  512. * Add capability to include the fmr hdr for remote frames
  513. */
  514. txctl_log.priv.frm_hdr = frm_hdr;
  515. qdf_assert(txctl_log.priv.txdesc_ctl);
  516. qdf_assert(pl_hdr.size < sizeof(txctl_log.priv.txdesc_ctl));
  517. pl_hdr.size = (pl_hdr.size > sizeof(txctl_log.priv.txdesc_ctl))
  518. ? sizeof(txctl_log.priv.txdesc_ctl) :
  519. pl_hdr.size;
  520. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  521. qdf_assert(0);
  522. return A_ERROR;
  523. }
  524. qdf_mem_copy((void *)&txctl_log.priv.txdesc_ctl,
  525. ((void *)fw_data->data +
  526. sizeof(struct ath_pktlog_hdr)),
  527. pl_hdr.size);
  528. qdf_assert(txctl_log.txdesc_hdr_ctl);
  529. qdf_mem_copy(txctl_log.txdesc_hdr_ctl, &txctl_log.priv,
  530. sizeof(txctl_log.priv));
  531. pl_hdr.size = log_size;
  532. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  533. txctl_log.txdesc_hdr_ctl);
  534. /* Add Protocol information and HT specific information */
  535. }
  536. if (pl_hdr.log_type == PKTLOG_TYPE_TX_STAT) {
  537. struct ath_pktlog_tx_status txstat_log;
  538. size_t log_size = pl_hdr.size;
  539. txstat_log.ds_status = (void *)
  540. pktlog_getbuf(pl_dev, pl_info, log_size, &pl_hdr);
  541. qdf_assert(txstat_log.ds_status);
  542. qdf_mem_copy(txstat_log.ds_status,
  543. ((void *)fw_data->data +
  544. sizeof(struct ath_pktlog_hdr)),
  545. pl_hdr.size);
  546. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  547. txstat_log.ds_status);
  548. }
  549. if (pl_hdr.log_type == PKTLOG_TYPE_TX_MSDU_ID) {
  550. struct ath_pktlog_msdu_info pl_msdu_info;
  551. size_t log_size;
  552. qdf_mem_set(&pl_msdu_info, sizeof(pl_msdu_info), 0);
  553. log_size = sizeof(pl_msdu_info.priv);
  554. if (pl_dev->mt_pktlog_enabled == false)
  555. fill_ieee80211_hdr_data(txrx_pdev,
  556. &pl_msdu_info, fw_data->data);
  557. pl_msdu_info.ath_msdu_info = pktlog_getbuf(pl_dev, pl_info,
  558. log_size, &pl_hdr);
  559. qdf_mem_copy((void *)&pl_msdu_info.priv.msdu_id_info,
  560. ((void *)fw_data->data +
  561. sizeof(struct ath_pktlog_hdr)),
  562. sizeof(pl_msdu_info.priv.msdu_id_info));
  563. qdf_mem_copy(pl_msdu_info.ath_msdu_info, &pl_msdu_info.priv,
  564. sizeof(pl_msdu_info.priv));
  565. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  566. pl_msdu_info.ath_msdu_info);
  567. }
  568. return A_OK;
  569. }
  570. #endif
  571. /**
  572. * process_offload_pktlog() - Process full pktlog events
  573. * pdev: abstract pdev handle
  574. * data: pktlog buffer
  575. *
  576. * Return: zero on success, non-zero on failure
  577. */
  578. A_STATUS
  579. process_offload_pktlog(struct cdp_pdev *pdev, void *data)
  580. {
  581. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  582. struct ath_pktlog_info *pl_info;
  583. struct ath_pktlog_hdr pl_hdr;
  584. uint32_t *pl_tgt_hdr;
  585. void *txdesc_hdr_ctl = NULL;
  586. size_t log_size = 0;
  587. size_t tmp_log_size = 0;
  588. if (!pl_dev) {
  589. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  590. "Invalid context in %s\n", __func__);
  591. return A_ERROR;
  592. }
  593. if (!data) {
  594. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  595. "Invalid data in %s\n", __func__);
  596. return A_ERROR;
  597. }
  598. pl_tgt_hdr = (uint32_t *)data;
  599. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  600. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  601. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  602. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  603. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  604. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  605. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  606. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  607. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  608. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  609. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  610. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  611. pl_hdr.type_specific_data = *(pl_tgt_hdr
  612. + ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET);
  613. /*
  614. * Must include to process different types
  615. * TX_CTL, TX_STATUS, TX_MSDU_ID, TX_FRM_HDR
  616. */
  617. pl_info = pl_dev->pl_info;
  618. tmp_log_size = sizeof(frm_hdr) + pl_hdr.size;
  619. log_size = pl_hdr.size;
  620. txdesc_hdr_ctl =
  621. (void *)pktlog_getbuf(pl_dev, pl_info, log_size, &pl_hdr);
  622. if (!txdesc_hdr_ctl) {
  623. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  624. "Failed to allocate pktlog descriptor");
  625. return A_NO_MEMORY;
  626. }
  627. qdf_assert(txdesc_hdr_ctl);
  628. qdf_assert(pl_hdr->size < PKTLOG_MAX_TX_WORDS * sizeof(u_int32_t));
  629. qdf_mem_copy(txdesc_hdr_ctl,
  630. ((void *)data + sizeof(struct ath_pktlog_hdr)),
  631. pl_hdr.size);
  632. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, txdesc_hdr_ctl);
  633. return A_OK;
  634. }
  635. /* TODO: hardware dependent function */
  636. A_STATUS process_rx_info_remote(void *pdev, void *data)
  637. {
  638. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  639. struct ath_pktlog_info *pl_info;
  640. struct htt_host_rx_desc_base *rx_desc;
  641. struct ath_pktlog_hdr pl_hdr;
  642. struct ath_pktlog_rx_info rxstat_log;
  643. size_t log_size;
  644. struct ol_rx_remote_data *r_data = (struct ol_rx_remote_data *)data;
  645. qdf_nbuf_t msdu;
  646. if (!pdev || !r_data || !pl_dev) {
  647. qdf_print("%s: Invalid handle", __func__);
  648. return A_ERROR;
  649. }
  650. pl_info = pl_dev->pl_info;
  651. msdu = r_data->msdu;
  652. while (msdu) {
  653. rx_desc =
  654. (struct htt_host_rx_desc_base *)(qdf_nbuf_data(msdu)) - 1;
  655. log_size =
  656. sizeof(*rx_desc) - sizeof(struct htt_host_fw_desc_base);
  657. /*
  658. * Construct the pktlog header pl_hdr
  659. * Because desc is DMA'd to the host memory
  660. */
  661. pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
  662. pl_hdr.missed_cnt = 0;
  663. #if defined(HELIUMPLUS)
  664. pl_hdr.macId = r_data->mac_id;
  665. pl_hdr.log_type = PKTLOG_TYPE_RX_STAT;
  666. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  667. #else
  668. pl_hdr.log_type = PKTLOG_TYPE_RX_STAT;
  669. #endif
  670. pl_hdr.size = sizeof(*rx_desc) -
  671. sizeof(struct htt_host_fw_desc_base);
  672. #if defined(HELIUMPLUS)
  673. pl_hdr.timestamp =
  674. rx_desc->ppdu_end.rx_pkt_end.phy_timestamp_1_lower_32;
  675. pl_hdr.type_specific_data = 0xDEADAA;
  676. #else
  677. pl_hdr.timestamp = rx_desc->ppdu_end.tsf_timestamp;
  678. #endif /* !defined(HELIUMPLUS) */
  679. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  680. log_size, &pl_hdr);
  681. qdf_mem_copy(rxstat_log.rx_desc, (void *)rx_desc +
  682. sizeof(struct htt_host_fw_desc_base), pl_hdr.size);
  683. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  684. rxstat_log.rx_desc);
  685. msdu = qdf_nbuf_next(msdu);
  686. }
  687. return A_OK;
  688. }
  689. #ifdef HELIUMPLUS
  690. A_STATUS process_rx_info(void *pdev, void *data)
  691. {
  692. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  693. struct ath_pktlog_info *pl_info;
  694. struct ath_pktlog_rx_info rxstat_log;
  695. struct ath_pktlog_hdr pl_hdr;
  696. size_t log_size;
  697. uint32_t *pl_tgt_hdr;
  698. struct ol_fw_data *fw_data;
  699. uint32_t len;
  700. if (!pdev) {
  701. printk("Invalid pdev in %s", __func__);
  702. return A_ERROR;
  703. }
  704. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  705. if (!pl_dev) {
  706. printk("Invalid pl_dev in %s", __func__);
  707. return A_ERROR;
  708. }
  709. fw_data = (struct ol_fw_data *)data;
  710. len = fw_data->len;
  711. if (len < (sizeof(uint32_t) *
  712. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  713. len < (sizeof(uint32_t) *
  714. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  715. len < (sizeof(uint32_t) *
  716. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  717. len < (sizeof(uint32_t) *
  718. (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
  719. len < (sizeof(uint32_t) *
  720. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  721. len < (sizeof(uint32_t) *
  722. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  723. qdf_print("Invalid msdu len in %s", __func__);
  724. qdf_assert(0);
  725. return A_ERROR;
  726. }
  727. pl_info = pl_dev->pl_info;
  728. pl_tgt_hdr = (uint32_t *)fw_data->data;
  729. qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
  730. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  731. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  732. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  733. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  734. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  735. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  736. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  737. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  738. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  739. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  740. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  741. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  742. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  743. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  744. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  745. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  746. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  747. qdf_assert(0);
  748. return A_ERROR;
  749. }
  750. log_size = pl_hdr.size;
  751. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  752. log_size, &pl_hdr);
  753. qdf_mem_copy(rxstat_log.rx_desc,
  754. (void *)fw_data->data + sizeof(struct ath_pktlog_hdr),
  755. pl_hdr.size);
  756. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
  757. return A_OK;
  758. }
  759. #else
  760. A_STATUS process_rx_info(void *pdev, void *data)
  761. {
  762. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  763. struct ath_pktlog_info *pl_info;
  764. struct ath_pktlog_rx_info rxstat_log;
  765. struct ath_pktlog_hdr pl_hdr;
  766. size_t log_size;
  767. uint32_t *pl_tgt_hdr;
  768. struct ol_fw_data *fw_data;
  769. uint32_t len;
  770. if (!pdev) {
  771. printk("Invalid pdev in %s", __func__);
  772. return A_ERROR;
  773. }
  774. pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
  775. if (!pl_dev) {
  776. printk("Invalid pl_dev in %s", __func__);
  777. return A_ERROR;
  778. }
  779. fw_data = (struct ol_fw_data *)data;
  780. len = fw_data->len;
  781. if (len < (sizeof(uint32_t) *
  782. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  783. len < (sizeof(uint32_t) *
  784. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  785. len < (sizeof(uint32_t) *
  786. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  787. len < (sizeof(uint32_t) *
  788. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  789. len < (sizeof(uint32_t) *
  790. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  791. qdf_print("Invalid msdu len in %s", __func__);
  792. qdf_assert(0);
  793. return A_ERROR;
  794. }
  795. pl_info = pl_dev->pl_info;
  796. pl_tgt_hdr = (uint32_t *)fw_data->data;
  797. qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
  798. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  799. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  800. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  801. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  802. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  803. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  804. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  805. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  806. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  807. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  808. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  809. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  810. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  811. qdf_assert(0);
  812. return A_ERROR;
  813. }
  814. log_size = pl_hdr.size;
  815. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  816. log_size, &pl_hdr);
  817. qdf_mem_copy(rxstat_log.rx_desc,
  818. (void *)fw_data->data + sizeof(struct ath_pktlog_hdr),
  819. pl_hdr.size);
  820. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
  821. return A_OK;
  822. }
  823. #endif
  824. #ifdef HELIUMPLUS
  825. A_STATUS process_rate_find(void *pdev, void *data)
  826. {
  827. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  828. struct ath_pktlog_hdr pl_hdr;
  829. struct ath_pktlog_info *pl_info;
  830. size_t log_size;
  831. uint32_t len;
  832. struct ol_fw_data *fw_data;
  833. /*
  834. * Will be uncommented when the rate control find
  835. * for pktlog is implemented in the firmware.
  836. * Currently derived from the TX PPDU status
  837. */
  838. struct ath_pktlog_rc_find rcf_log;
  839. uint32_t *pl_tgt_hdr;
  840. if (!pdev || !data || !pl_dev) {
  841. qdf_print("%s: Invalid handle", __func__);
  842. return A_ERROR;
  843. }
  844. fw_data = (struct ol_fw_data *)data;
  845. len = fw_data->len;
  846. if (len < (sizeof(uint32_t) *
  847. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  848. len < (sizeof(uint32_t) *
  849. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  850. len < (sizeof(uint32_t) *
  851. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  852. len < (sizeof(uint32_t) *
  853. (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
  854. len < (sizeof(uint32_t) *
  855. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  856. len < (sizeof(uint32_t) *
  857. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  858. qdf_print("Invalid msdu len in %s", __func__);
  859. qdf_assert(0);
  860. return A_ERROR;
  861. }
  862. pl_tgt_hdr = (uint32_t *)fw_data->data;
  863. /*
  864. * Makes the short words (16 bits) portable b/w little endian
  865. * and big endian
  866. */
  867. qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
  868. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  869. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  870. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  871. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  872. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  873. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  874. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  875. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  876. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  877. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  878. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  879. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  880. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  881. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  882. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  883. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  884. pl_info = pl_dev->pl_info;
  885. log_size = pl_hdr.size;
  886. rcf_log.rcFind = (void *)pktlog_getbuf(pl_dev, pl_info,
  887. log_size, &pl_hdr);
  888. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  889. qdf_assert(0);
  890. return A_ERROR;
  891. }
  892. qdf_mem_copy(rcf_log.rcFind,
  893. ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
  894. pl_hdr.size);
  895. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcf_log.rcFind);
  896. return A_OK;
  897. }
  898. #else
  899. A_STATUS process_rate_find(void *pdev, void *data)
  900. {
  901. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  902. struct ath_pktlog_hdr pl_hdr;
  903. struct ath_pktlog_info *pl_info;
  904. size_t log_size;
  905. uint32_t len;
  906. struct ol_fw_data *fw_data;
  907. /*
  908. * Will be uncommented when the rate control find
  909. * for pktlog is implemented in the firmware.
  910. * Currently derived from the TX PPDU status
  911. */
  912. struct ath_pktlog_rc_find rcf_log;
  913. uint32_t *pl_tgt_hdr;
  914. if (!pdev || !data || !pl_dev) {
  915. qdf_print("%s: Invalid handle", __func__);
  916. return A_ERROR;
  917. }
  918. fw_data = (struct ol_fw_data *)data;
  919. len = fw_data->len;
  920. if (len < (sizeof(uint32_t) *
  921. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  922. len < (sizeof(uint32_t) *
  923. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  924. len < (sizeof(uint32_t) *
  925. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  926. len < (sizeof(uint32_t) *
  927. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  928. len < (sizeof(uint32_t) *
  929. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  930. qdf_print("Invalid msdu len in %s", __func__);
  931. qdf_assert(0);
  932. return A_ERROR;
  933. }
  934. pl_tgt_hdr = (uint32_t *)fw_data->data;
  935. /*
  936. * Makes the short words (16 bits) portable b/w little endian
  937. * and big endian
  938. */
  939. qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
  940. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  941. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  942. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  943. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  944. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  945. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  946. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  947. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  948. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  949. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  950. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  951. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  952. pl_info = pl_dev->pl_info;
  953. log_size = pl_hdr.size;
  954. rcf_log.rcFind = (void *)pktlog_getbuf(pl_dev, pl_info,
  955. log_size, &pl_hdr);
  956. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  957. qdf_assert(0);
  958. return A_ERROR;
  959. }
  960. qdf_mem_copy(rcf_log.rcFind,
  961. ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
  962. pl_hdr.size);
  963. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcf_log.rcFind);
  964. return A_OK;
  965. }
  966. #endif
  967. #ifdef HELIUMPLUS
  968. A_STATUS process_sw_event(void *pdev, void *data)
  969. {
  970. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  971. struct ath_pktlog_hdr pl_hdr;
  972. struct ath_pktlog_info *pl_info;
  973. size_t log_size;
  974. uint32_t len;
  975. struct ol_fw_data *fw_data;
  976. /*
  977. * Will be uncommented when the rate control find
  978. * for pktlog is implemented in the firmware.
  979. * Currently derived from the TX PPDU status
  980. */
  981. struct ath_pktlog_sw_event sw_event;
  982. uint32_t *pl_tgt_hdr;
  983. if (!pdev) {
  984. qdf_print("Invalid pdev in %s", __func__);
  985. return A_ERROR;
  986. }
  987. if (!data) {
  988. qdf_print("Invalid data in %s", __func__);
  989. return A_ERROR;
  990. }
  991. if (!pl_dev) {
  992. qdf_print("Invalid pl_dev in %s", __func__);
  993. return A_ERROR;
  994. }
  995. fw_data = (struct ol_fw_data *)data;
  996. len = fw_data->len;
  997. if (len < (sizeof(uint32_t) *
  998. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  999. len < (sizeof(uint32_t) *
  1000. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  1001. len < (sizeof(uint32_t) *
  1002. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  1003. len < (sizeof(uint32_t) *
  1004. (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
  1005. len < (sizeof(uint32_t) *
  1006. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  1007. len < (sizeof(uint32_t) *
  1008. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  1009. qdf_print("Invalid msdu len in %s", __func__);
  1010. qdf_assert(0);
  1011. return A_ERROR;
  1012. }
  1013. pl_tgt_hdr = (uint32_t *)fw_data->data;
  1014. /*
  1015. * Makes the short words (16 bits) portable b/w little endian
  1016. * and big endian
  1017. */
  1018. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  1019. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  1020. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  1021. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  1022. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  1023. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  1024. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  1025. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  1026. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  1027. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  1028. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  1029. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  1030. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  1031. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  1032. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  1033. pl_hdr.type_specific_data =
  1034. *(pl_tgt_hdr + ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET);
  1035. pl_info = pl_dev->pl_info;
  1036. log_size = pl_hdr.size;
  1037. sw_event.sw_event = (void *)pktlog_getbuf(pl_dev, pl_info,
  1038. log_size, &pl_hdr);
  1039. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  1040. qdf_assert(0);
  1041. return A_ERROR;
  1042. }
  1043. qdf_mem_copy(sw_event.sw_event,
  1044. ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
  1045. pl_hdr.size);
  1046. return A_OK;
  1047. }
  1048. #else
  1049. A_STATUS process_sw_event(void *pdev, void *data)
  1050. {
  1051. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  1052. struct ath_pktlog_hdr pl_hdr;
  1053. struct ath_pktlog_info *pl_info;
  1054. size_t log_size;
  1055. uint32_t len;
  1056. struct ol_fw_data *fw_data;
  1057. /*
  1058. * Will be uncommented when the rate control find
  1059. * for pktlog is implemented in the firmware.
  1060. * Currently derived from the TX PPDU status
  1061. */
  1062. struct ath_pktlog_sw_event sw_event;
  1063. uint32_t *pl_tgt_hdr;
  1064. if (!pdev) {
  1065. qdf_print("Invalid pdev in %s", __func__);
  1066. return A_ERROR;
  1067. }
  1068. if (!data) {
  1069. qdf_print("Invalid data in %s", __func__);
  1070. return A_ERROR;
  1071. }
  1072. if (!pl_dev) {
  1073. qdf_print("Invalid pl_dev in %s", __func__);
  1074. return A_ERROR;
  1075. }
  1076. fw_data = (struct ol_fw_data *)data;
  1077. len = fw_data->len;
  1078. if (len < (sizeof(uint32_t) *
  1079. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  1080. len < (sizeof(uint32_t) *
  1081. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  1082. len < (sizeof(uint32_t) *
  1083. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  1084. len < (sizeof(uint32_t) *
  1085. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  1086. len < (sizeof(uint32_t) *
  1087. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  1088. qdf_print("Invalid msdu len in %s", __func__);
  1089. qdf_assert(0);
  1090. return A_ERROR;
  1091. }
  1092. pl_tgt_hdr = (uint32_t *)fw_data->data;
  1093. /*
  1094. * Makes the short words (16 bits) portable b/w little endian
  1095. * and big endian
  1096. */
  1097. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  1098. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  1099. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  1100. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  1101. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  1102. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  1103. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  1104. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  1105. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  1106. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  1107. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  1108. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  1109. pl_info = pl_dev->pl_info;
  1110. log_size = pl_hdr.size;
  1111. sw_event.sw_event = (void *)pktlog_getbuf(pl_dev, pl_info,
  1112. log_size, &pl_hdr);
  1113. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  1114. qdf_assert(0);
  1115. return A_ERROR;
  1116. }
  1117. qdf_mem_copy(sw_event.sw_event,
  1118. ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
  1119. pl_hdr.size);
  1120. return A_OK;
  1121. }
  1122. #endif
  1123. #ifdef HELIUMPLUS
  1124. A_STATUS process_rate_update(void *pdev, void *data)
  1125. {
  1126. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  1127. struct ath_pktlog_hdr pl_hdr;
  1128. size_t log_size;
  1129. struct ath_pktlog_info *pl_info;
  1130. struct ath_pktlog_rc_update rcu_log;
  1131. uint32_t *pl_tgt_hdr;
  1132. struct ol_fw_data *fw_data;
  1133. uint32_t len;
  1134. if (!pdev || !data || !pl_dev) {
  1135. qdf_print("%s: Invalid handle", __func__);
  1136. return A_ERROR;
  1137. }
  1138. fw_data = (struct ol_fw_data *)data;
  1139. len = fw_data->len;
  1140. if (len < (sizeof(uint32_t) *
  1141. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  1142. len < (sizeof(uint32_t) *
  1143. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  1144. len < (sizeof(uint32_t) *
  1145. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  1146. len < (sizeof(uint32_t) *
  1147. (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
  1148. len < (sizeof(uint32_t) *
  1149. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  1150. len < (sizeof(uint32_t) *
  1151. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  1152. qdf_print("Invalid msdu len in %s", __func__);
  1153. qdf_assert(0);
  1154. return A_ERROR;
  1155. }
  1156. pl_tgt_hdr = (uint32_t *)fw_data->data;
  1157. /*
  1158. * Makes the short words (16 bits) portable b/w little endian
  1159. * and big endian
  1160. */
  1161. qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
  1162. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  1163. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  1164. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  1165. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  1166. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  1167. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  1168. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  1169. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  1170. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  1171. pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
  1172. ATH_PKTLOG_HDR_MAC_ID_MASK) >>
  1173. ATH_PKTLOG_HDR_MAC_ID_SHIFT;
  1174. pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
  1175. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  1176. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  1177. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  1178. log_size = pl_hdr.size;
  1179. pl_info = pl_dev->pl_info;
  1180. /*
  1181. * Will be uncommented when the rate control update
  1182. * for pktlog is implemented in the firmware.
  1183. * Currently derived from the TX PPDU status
  1184. */
  1185. rcu_log.txRateCtrl = (void *)pktlog_getbuf(pl_dev, pl_info,
  1186. log_size, &pl_hdr);
  1187. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  1188. qdf_assert(0);
  1189. return A_ERROR;
  1190. }
  1191. qdf_mem_copy(rcu_log.txRateCtrl,
  1192. ((char *)fw_data->data +
  1193. sizeof(struct ath_pktlog_hdr)),
  1194. pl_hdr.size);
  1195. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcu_log.txRateCtrl);
  1196. return A_OK;
  1197. }
  1198. #else
  1199. A_STATUS process_rate_update(void *pdev, void *data)
  1200. {
  1201. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  1202. struct ath_pktlog_hdr pl_hdr;
  1203. size_t log_size;
  1204. struct ath_pktlog_info *pl_info;
  1205. struct ath_pktlog_rc_update rcu_log;
  1206. uint32_t *pl_tgt_hdr;
  1207. struct ol_fw_data *fw_data;
  1208. uint32_t len;
  1209. if (!pdev || !data || !pl_dev) {
  1210. qdf_print("%s: Invalid handle", __func__);
  1211. return A_ERROR;
  1212. }
  1213. fw_data = (struct ol_fw_data *)data;
  1214. len = fw_data->len;
  1215. if (len < (sizeof(uint32_t) *
  1216. (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
  1217. len < (sizeof(uint32_t) *
  1218. (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
  1219. len < (sizeof(uint32_t) *
  1220. (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
  1221. len < (sizeof(uint32_t) *
  1222. (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
  1223. len < (sizeof(uint32_t) *
  1224. (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
  1225. qdf_print("Invalid msdu len in %s", __func__);
  1226. qdf_assert(0);
  1227. return A_ERROR;
  1228. }
  1229. pl_tgt_hdr = (uint32_t *)fw_data->data;
  1230. /*
  1231. * Makes the short words (16 bits) portable b/w little endian
  1232. * and big endian
  1233. */
  1234. qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
  1235. pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
  1236. ATH_PKTLOG_HDR_FLAGS_MASK) >>
  1237. ATH_PKTLOG_HDR_FLAGS_SHIFT;
  1238. pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
  1239. ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
  1240. ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
  1241. pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
  1242. ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
  1243. ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
  1244. pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
  1245. ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
  1246. pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
  1247. log_size = pl_hdr.size;
  1248. pl_info = pl_dev->pl_info;
  1249. /*
  1250. * Will be uncommented when the rate control update
  1251. * for pktlog is implemented in the firmware.
  1252. * Currently derived from the TX PPDU status
  1253. */
  1254. rcu_log.txRateCtrl = (void *)pktlog_getbuf(pl_dev, pl_info,
  1255. log_size, &pl_hdr);
  1256. if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
  1257. qdf_assert(0);
  1258. return A_ERROR;
  1259. }
  1260. qdf_mem_copy(rcu_log.txRateCtrl,
  1261. ((char *)fw_data->data +
  1262. sizeof(struct ath_pktlog_hdr)),
  1263. pl_hdr.size);
  1264. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcu_log.txRateCtrl);
  1265. return A_OK;
  1266. }
  1267. #endif
  1268. #if defined(QCA_WIFI_QCA6290) || defined(QCA_WIFI_QCA6390)
  1269. int process_rx_desc_remote(void *pdev, void *data)
  1270. {
  1271. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  1272. struct ath_pktlog_hdr pl_hdr;
  1273. struct ath_pktlog_rx_info rxstat_log;
  1274. size_t log_size;
  1275. struct ath_pktlog_info *pl_info;
  1276. qdf_nbuf_t log_nbuf = (qdf_nbuf_t)data;
  1277. pl_info = pl_dev->pl_info;
  1278. qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
  1279. pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
  1280. pl_hdr.missed_cnt = 0;
  1281. pl_hdr.log_type = 22; /*PKTLOG_TYPE_RX_STATBUF*/
  1282. pl_hdr.size = qdf_nbuf_len(log_nbuf);
  1283. pl_hdr.timestamp = 0;
  1284. log_size = pl_hdr.size;
  1285. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  1286. log_size, &pl_hdr);
  1287. if (rxstat_log.rx_desc == NULL) {
  1288. QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_DEBUG,
  1289. "%s: Rx descriptor is NULL", __func__);
  1290. return -EFAULT;
  1291. }
  1292. qdf_mem_copy(rxstat_log.rx_desc, qdf_nbuf_data(log_nbuf), pl_hdr.size);
  1293. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
  1294. rxstat_log.rx_desc);
  1295. return 0;
  1296. }
  1297. int
  1298. process_pktlog_lite(void *context, void *log_data, uint16_t log_type)
  1299. {
  1300. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  1301. struct ath_pktlog_info *pl_info;
  1302. struct ath_pktlog_hdr pl_hdr;
  1303. struct ath_pktlog_rx_info rxstat_log;
  1304. size_t log_size;
  1305. qdf_nbuf_t log_nbuf = (qdf_nbuf_t)log_data;
  1306. pl_info = pl_dev->pl_info;
  1307. qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
  1308. pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
  1309. pl_hdr.missed_cnt = 0;
  1310. pl_hdr.log_type = log_type;
  1311. pl_hdr.size = qdf_nbuf_len(log_nbuf);
  1312. pl_hdr.timestamp = 0;
  1313. log_size = pl_hdr.size;
  1314. rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
  1315. log_size, &pl_hdr);
  1316. if (rxstat_log.rx_desc == NULL) {
  1317. QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_DEBUG,
  1318. "%s: Rx descriptor is NULL", __func__);
  1319. return -EFAULT;
  1320. }
  1321. qdf_mem_copy(rxstat_log.rx_desc, qdf_nbuf_data(log_nbuf), pl_hdr.size);
  1322. cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
  1323. return 0;
  1324. }
  1325. #else
  1326. int process_rx_desc_remote(void *pdev, void *data)
  1327. {
  1328. return 0;
  1329. }
  1330. int
  1331. process_pktlog_lite(void *context, void *log_data, uint16_t log_type)
  1332. {
  1333. return 0;
  1334. }
  1335. #endif
  1336. #endif /*REMOVE_PKT_LOG */