123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365 |
- /*
- * Copyright (c) 2017 The Linux Foundation. All rights reserved.
- *
- * Permission to use, copy, modify, and/or distribute this software for
- * any purpose with or without fee is hereby granted, provided that the
- * above copyright notice and this permission notice appear in all
- * copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
- * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
- * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
- * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
- * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
- * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
- * PERFORMANCE OF THIS SOFTWARE.
- */
- #include "dp_types.h"
- #include "dp_rx.h"
- #include "dp_peer.h"
- #include "hal_api.h"
- #include "qdf_trace.h"
- #include "qdf_nbuf.h"
- #include "dp_rx_defrag.h"
- #include <enet.h> /* LLC_SNAP_HDR_LEN */
- #include "dp_rx_defrag.h"
- const struct dp_rx_defrag_cipher dp_f_ccmp = {
- "AES-CCM",
- IEEE80211_WEP_IVLEN + IEEE80211_WEP_KIDLEN + IEEE80211_WEP_EXTIVLEN,
- IEEE80211_WEP_MICLEN,
- 0,
- };
- const struct dp_rx_defrag_cipher dp_f_tkip = {
- "TKIP",
- IEEE80211_WEP_IVLEN + IEEE80211_WEP_KIDLEN + IEEE80211_WEP_EXTIVLEN,
- IEEE80211_WEP_CRCLEN,
- IEEE80211_WEP_MICLEN,
- };
- const struct dp_rx_defrag_cipher dp_f_wep = {
- "WEP",
- IEEE80211_WEP_IVLEN + IEEE80211_WEP_KIDLEN,
- IEEE80211_WEP_CRCLEN,
- 0,
- };
- /*
- * dp_rx_defrag_frames_free(): Free fragment chain
- * @frames: Fragment chain
- *
- * Iterates through the fragment chain and frees them
- * Returns: None
- */
- static void dp_rx_defrag_frames_free(qdf_nbuf_t frames)
- {
- qdf_nbuf_t next, frag = frames;
- while (frag) {
- next = qdf_nbuf_next(frag);
- qdf_nbuf_free(frag);
- frag = next;
- }
- }
- /*
- * dp_rx_clear_saved_desc_info(): Clears descriptor info
- * @peer: Pointer to the peer data structure
- * @tid: Transmit ID (TID)
- *
- * Saves MPDU descriptor info and MSDU link pointer from REO
- * ring descriptor. The cache is created per peer, per TID
- *
- * Returns: None
- */
- static void dp_rx_clear_saved_desc_info(struct dp_peer *peer, unsigned tid)
- {
- hal_rx_clear_mpdu_desc_info(
- &peer->rx_tid[tid].transcap_rx_mpdu_desc_info);
- hal_rx_clear_msdu_link_ptr(
- &peer->rx_tid[tid].transcap_msdu_link_ptr[0],
- HAL_RX_MAX_SAVED_RING_DESC);
- }
- /*
- * dp_rx_defrag_waitlist_add(): Update per-PDEV defrag wait list
- * @peer: Pointer to the peer data structure
- * @tid: Transmit ID (TID)
- *
- * Appends per-tid fragments to global fragment wait list
- *
- * Returns: None
- */
- static void dp_rx_defrag_waitlist_add(struct dp_peer *peer, unsigned tid)
- {
- struct dp_soc *psoc = peer->vdev->pdev->soc;
- struct dp_rx_tid *rx_reorder = &peer->rx_tid[tid];
- /* TODO: use LIST macros instead of TAIL macros */
- TAILQ_INSERT_TAIL(&psoc->rx.defrag.waitlist, rx_reorder,
- defrag_waitlist_elem);
- }
- /*
- * dp_rx_defrag_waitlist_remove(): Remove fragments from waitlist
- * @peer: Pointer to the peer data structure
- * @tid: Transmit ID (TID)
- *
- * Remove fragments from waitlist
- *
- * Returns: None
- */
- static void dp_rx_defrag_waitlist_remove(struct dp_peer *peer, unsigned tid)
- {
- struct dp_pdev *pdev = peer->vdev->pdev;
- struct dp_soc *soc = pdev->soc;
- struct dp_rx_tid *rx_reorder;
- if (tid > DP_MAX_TIDS) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "TID out of bounds: %d", tid);
- qdf_assert(0);
- return;
- }
- rx_reorder = &peer->rx_tid[tid];
- if (rx_reorder->defrag_waitlist_elem.tqe_next != NULL) {
- TAILQ_REMOVE(&soc->rx.defrag.waitlist, rx_reorder,
- defrag_waitlist_elem);
- rx_reorder->defrag_waitlist_elem.tqe_next = NULL;
- rx_reorder->defrag_waitlist_elem.tqe_prev = NULL;
- } else if (rx_reorder->defrag_waitlist_elem.tqe_prev == NULL) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "waitlist->tqe_prev is NULL");
- rx_reorder->defrag_waitlist_elem.tqe_next = NULL;
- qdf_assert(0);
- }
- }
- /*
- * dp_rx_defrag_fraglist_insert(): Create a per-sequence fragment list
- * @peer: Pointer to the peer data structure
- * @tid: Transmit ID (TID)
- * @head_addr: Pointer to head list
- * @tail_addr: Pointer to tail list
- * @frag: Incoming fragment
- * @all_frag_present: Flag to indicate whether all fragments are received
- *
- * Build a per-tid, per-sequence fragment list.
- *
- * Returns: None
- */
- static void dp_rx_defrag_fraglist_insert(struct dp_peer *peer, unsigned tid,
- qdf_nbuf_t *head_addr, qdf_nbuf_t *tail_addr, qdf_nbuf_t frag,
- uint8_t *all_frag_present)
- {
- qdf_nbuf_t next;
- qdf_nbuf_t prev = NULL;
- qdf_nbuf_t cur;
- uint16_t head_fragno, cur_fragno, next_fragno;
- uint8_t last_morefrag = 1, count = 0;
- struct dp_rx_tid *rx_tid = &peer->rx_tid[tid];
- uint8_t *rx_desc_info;
- qdf_assert(frag);
- qdf_assert(head_addr);
- qdf_assert(tail_addr);
- rx_desc_info = qdf_nbuf_data(frag);
- cur_fragno = dp_rx_frag_get_mpdu_frag_number(rx_desc_info);
- /* If this is the first fragment */
- if (!(*head_addr)) {
- *head_addr = *tail_addr = frag;
- qdf_nbuf_set_next(*tail_addr, NULL);
- rx_tid->curr_frag_num = cur_fragno;
- goto end;
- }
- /* In sequence fragment */
- if (cur_fragno > rx_tid->curr_frag_num) {
- qdf_nbuf_set_next(*tail_addr, frag);
- *tail_addr = frag;
- qdf_nbuf_set_next(*tail_addr, NULL);
- rx_tid->curr_frag_num = cur_fragno;
- } else {
- /* Out of sequence fragment */
- cur = *head_addr;
- rx_desc_info = qdf_nbuf_data(cur);
- head_fragno = dp_rx_frag_get_mpdu_frag_number(rx_desc_info);
- if (cur_fragno == head_fragno) {
- qdf_nbuf_free(frag);
- *all_frag_present = 0;
- } else if (head_fragno > cur_fragno) {
- qdf_nbuf_set_next(frag, cur);
- cur = frag;
- *head_addr = frag; /* head pointer to be updated */
- } else {
- while ((cur_fragno > head_fragno) && cur != NULL) {
- prev = cur;
- cur = qdf_nbuf_next(cur);
- rx_desc_info = qdf_nbuf_data(cur);
- head_fragno =
- dp_rx_frag_get_mpdu_frag_number(
- rx_desc_info);
- }
- qdf_nbuf_set_next(prev, frag);
- qdf_nbuf_set_next(frag, cur);
- }
- }
- next = qdf_nbuf_next(*head_addr);
- rx_desc_info = qdf_nbuf_data(*tail_addr);
- last_morefrag = hal_rx_get_rx_more_frag_bit(rx_desc_info);
- /* TODO: optimize the loop */
- if (!last_morefrag) {
- /* Check if all fragments are present */
- do {
- rx_desc_info = qdf_nbuf_data(next);
- next_fragno =
- dp_rx_frag_get_mpdu_frag_number(rx_desc_info);
- count++;
- if (next_fragno != count)
- break;
- next = qdf_nbuf_next(next);
- } while (next);
- if (!next) {
- *all_frag_present = 1;
- return;
- }
- }
- end:
- *all_frag_present = 0;
- }
- /*
- * dp_rx_defrag_tkip_decap(): decap tkip encrypted fragment
- * @msdu: Pointer to the fragment
- * @hdrlen: 802.11 header length (mostly useful in 4 addr frames)
- *
- * decap tkip encrypted fragment
- *
- * Returns: QDF_STATUS
- */
- static QDF_STATUS dp_rx_defrag_tkip_decap(qdf_nbuf_t msdu, uint16_t hdrlen)
- {
- uint8_t *ivp, *orig_hdr;
- int rx_desc_len = sizeof(struct rx_pkt_tlvs);
- /* start of 802.11 header info */
- orig_hdr = (uint8_t *)(qdf_nbuf_data(msdu) + rx_desc_len);
- /* TKIP header is located post 802.11 header */
- ivp = orig_hdr + hdrlen;
- if (!(ivp[IEEE80211_WEP_IVLEN] & IEEE80211_WEP_EXTIV)) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "IEEE80211_WEP_EXTIV is missing in TKIP fragment");
- return QDF_STATUS_E_DEFRAG_ERROR;
- }
- qdf_mem_move(orig_hdr + dp_f_tkip.ic_header, orig_hdr, hdrlen);
- qdf_nbuf_pull_head(msdu, dp_f_tkip.ic_header);
- qdf_nbuf_trim_tail(msdu, dp_f_tkip.ic_trailer);
- return QDF_STATUS_SUCCESS;
- }
- /*
- * dp_rx_defrag_ccmp_demic(): Remove MIC information from CCMP fragment
- * @nbuf: Pointer to the fragment buffer
- * @hdrlen: 802.11 header length (mostly useful in 4 addr frames)
- *
- * Remove MIC information from CCMP fragment
- *
- * Returns: QDF_STATUS
- */
- static QDF_STATUS dp_rx_defrag_ccmp_demic(qdf_nbuf_t nbuf, uint16_t hdrlen)
- {
- uint8_t *ivp, *orig_hdr;
- int rx_desc_len = sizeof(struct rx_pkt_tlvs);
- /* start of the 802.11 header */
- orig_hdr = (uint8_t *)(qdf_nbuf_data(nbuf) + rx_desc_len);
- /* CCMP header is located after 802.11 header */
- ivp = orig_hdr + hdrlen;
- if (!(ivp[IEEE80211_WEP_IVLEN] & IEEE80211_WEP_EXTIV))
- return QDF_STATUS_E_DEFRAG_ERROR;
- qdf_nbuf_trim_tail(nbuf, dp_f_ccmp.ic_trailer);
- return QDF_STATUS_SUCCESS;
- }
- /*
- * dp_rx_defrag_ccmp_decap(): decap CCMP encrypted fragment
- * @nbuf: Pointer to the fragment
- * @hdrlen: length of the header information
- *
- * decap CCMP encrypted fragment
- *
- * Returns: QDF_STATUS
- */
- static QDF_STATUS dp_rx_defrag_ccmp_decap(qdf_nbuf_t nbuf, uint16_t hdrlen)
- {
- uint8_t *ivp, *origHdr;
- int rx_desc_len = sizeof(struct rx_pkt_tlvs);
- origHdr = (uint8_t *) (qdf_nbuf_data(nbuf) + rx_desc_len);
- ivp = origHdr + hdrlen;
- if (!(ivp[IEEE80211_WEP_IVLEN] & IEEE80211_WEP_EXTIV))
- return QDF_STATUS_E_DEFRAG_ERROR;
- qdf_mem_move(origHdr + dp_f_ccmp.ic_header, origHdr, hdrlen);
- qdf_nbuf_pull_head(nbuf, dp_f_ccmp.ic_header);
- return QDF_STATUS_SUCCESS;
- }
- /*
- * dp_rx_defrag_wep_decap(): decap WEP encrypted fragment
- * @msdu: Pointer to the fragment
- * @hdrlen: length of the header information
- *
- * decap WEP encrypted fragment
- *
- * Returns: QDF_STATUS
- */
- static QDF_STATUS dp_rx_defrag_wep_decap(qdf_nbuf_t msdu, uint16_t hdrlen)
- {
- uint8_t *origHdr;
- int rx_desc_len = sizeof(struct rx_pkt_tlvs);
- origHdr = (uint8_t *) (qdf_nbuf_data(msdu) + rx_desc_len);
- qdf_mem_move(origHdr + dp_f_wep.ic_header, origHdr, hdrlen);
- qdf_nbuf_pull_head(msdu, dp_f_wep.ic_header);
- qdf_nbuf_trim_tail(msdu, dp_f_wep.ic_trailer);
- return QDF_STATUS_SUCCESS;
- }
- /*
- * dp_rx_defrag_hdrsize(): Calculate the header size of the received fragment
- * @nbuf: Pointer to the fragment
- *
- * Calculate the header size of the received fragment
- *
- * Returns: header size (uint16_t)
- */
- static uint16_t dp_rx_defrag_hdrsize(qdf_nbuf_t nbuf)
- {
- uint8_t *rx_tlv_hdr = qdf_nbuf_data(nbuf);
- uint16_t size = sizeof(struct ieee80211_frame);
- uint16_t fc = 0;
- uint32_t to_ds, fr_ds;
- uint8_t frm_ctrl_valid;
- uint16_t frm_ctrl_field;
- to_ds = hal_rx_mpdu_get_to_ds(rx_tlv_hdr);
- fr_ds = hal_rx_mpdu_get_fr_ds(rx_tlv_hdr);
- frm_ctrl_valid = hal_rx_get_mpdu_frame_control_valid(rx_tlv_hdr);
- frm_ctrl_field = hal_rx_get_frame_ctrl_field(rx_tlv_hdr);
- if (to_ds && fr_ds)
- size += IEEE80211_ADDR_LEN;
- if (frm_ctrl_valid) {
- fc = frm_ctrl_field;
- /* use 1-st byte for validation */
- if (DP_RX_DEFRAG_IEEE80211_QOS_HAS_SEQ(fc & 0xff)) {
- size += sizeof(uint16_t);
- /* use 2-nd byte for validation */
- if (((fc & 0xff00) >> 8) & IEEE80211_FC1_ORDER)
- size += sizeof(struct ieee80211_htc);
- }
- }
- return size;
- }
- /*
- * dp_rx_defrag_michdr(): Calculate a psuedo MIC header
- * @wh0: Pointer to the wireless header of the fragment
- * @hdr: Array to hold the psuedo header
- *
- * Calculate a psuedo MIC header
- *
- * Returns: None
- */
- static void dp_rx_defrag_michdr(const struct ieee80211_frame *wh0,
- uint8_t hdr[])
- {
- const struct ieee80211_frame_addr4 *wh =
- (const struct ieee80211_frame_addr4 *)wh0;
- switch (wh->i_fc[1] & IEEE80211_FC1_DIR_MASK) {
- case IEEE80211_FC1_DIR_NODS:
- DP_RX_DEFRAG_IEEE80211_ADDR_COPY(hdr, wh->i_addr1); /* DA */
- DP_RX_DEFRAG_IEEE80211_ADDR_COPY(hdr + IEEE80211_ADDR_LEN,
- wh->i_addr2);
- break;
- case IEEE80211_FC1_DIR_TODS:
- DP_RX_DEFRAG_IEEE80211_ADDR_COPY(hdr, wh->i_addr3); /* DA */
- DP_RX_DEFRAG_IEEE80211_ADDR_COPY(hdr + IEEE80211_ADDR_LEN,
- wh->i_addr2);
- break;
- case IEEE80211_FC1_DIR_FROMDS:
- DP_RX_DEFRAG_IEEE80211_ADDR_COPY(hdr, wh->i_addr1); /* DA */
- DP_RX_DEFRAG_IEEE80211_ADDR_COPY(hdr + IEEE80211_ADDR_LEN,
- wh->i_addr3);
- break;
- case IEEE80211_FC1_DIR_DSTODS:
- DP_RX_DEFRAG_IEEE80211_ADDR_COPY(hdr, wh->i_addr3); /* DA */
- DP_RX_DEFRAG_IEEE80211_ADDR_COPY(hdr + IEEE80211_ADDR_LEN,
- wh->i_addr4);
- break;
- }
- /*
- * Bit 7 is IEEE80211_FC0_SUBTYPE_QOS for data frame, but
- * it could also be set for deauth, disassoc, action, etc. for
- * a mgt type frame. It comes into picture for MFP.
- */
- if (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_QOS) {
- const struct ieee80211_qosframe *qwh =
- (const struct ieee80211_qosframe *)wh;
- hdr[12] = qwh->i_qos[0] & IEEE80211_QOS_TID;
- } else {
- hdr[12] = 0;
- }
- hdr[13] = hdr[14] = hdr[15] = 0; /* reserved */
- }
- /*
- * dp_rx_defrag_mic(): Calculate MIC header
- * @key: Pointer to the key
- * @wbuf: fragment buffer
- * @off: Offset
- * @data_len: Data lengh
- * @mic: Array to hold MIC
- *
- * Calculate a psuedo MIC header
- *
- * Returns: QDF_STATUS
- */
- static QDF_STATUS dp_rx_defrag_mic(const uint8_t *key, qdf_nbuf_t wbuf,
- uint16_t off, uint16_t data_len, uint8_t mic[])
- {
- uint8_t hdr[16] = { 0, };
- uint32_t l, r;
- const uint8_t *data;
- uint32_t space;
- int rx_desc_len = sizeof(struct rx_pkt_tlvs);
- dp_rx_defrag_michdr((struct ieee80211_frame *)(qdf_nbuf_data(wbuf)
- + rx_desc_len), hdr);
- l = dp_rx_get_le32(key);
- r = dp_rx_get_le32(key + 4);
- /* Michael MIC pseudo header: DA, SA, 3 x 0, Priority */
- l ^= dp_rx_get_le32(hdr);
- dp_rx_michael_block(l, r);
- l ^= dp_rx_get_le32(&hdr[4]);
- dp_rx_michael_block(l, r);
- l ^= dp_rx_get_le32(&hdr[8]);
- dp_rx_michael_block(l, r);
- l ^= dp_rx_get_le32(&hdr[12]);
- dp_rx_michael_block(l, r);
- /* first buffer has special handling */
- data = (uint8_t *) qdf_nbuf_data(wbuf) + rx_desc_len + off;
- space = qdf_nbuf_len(wbuf) - rx_desc_len - off;
- for (;; ) {
- if (space > data_len)
- space = data_len;
- /* collect 32-bit blocks from current buffer */
- while (space >= sizeof(uint32_t)) {
- l ^= dp_rx_get_le32(data);
- dp_rx_michael_block(l, r);
- data += sizeof(uint32_t);
- space -= sizeof(uint32_t);
- data_len -= sizeof(uint32_t);
- }
- if (data_len < sizeof(uint32_t))
- break;
- wbuf = qdf_nbuf_next(wbuf);
- if (wbuf == NULL)
- return QDF_STATUS_E_DEFRAG_ERROR;
- if (space != 0) {
- const uint8_t *data_next;
- /*
- * Block straddles buffers, split references.
- */
- data_next =
- (uint8_t *) qdf_nbuf_data(wbuf) + rx_desc_len;
- if ((qdf_nbuf_len(wbuf) - rx_desc_len) <
- sizeof(uint32_t) - space) {
- return QDF_STATUS_E_DEFRAG_ERROR;
- }
- switch (space) {
- case 1:
- l ^= dp_rx_get_le32_split(data[0],
- data_next[0], data_next[1],
- data_next[2]);
- data = data_next + 3;
- space = (qdf_nbuf_len(wbuf) - rx_desc_len)
- - 3;
- break;
- case 2:
- l ^= dp_rx_get_le32_split(data[0], data[1],
- data_next[0], data_next[1]);
- data = data_next + 2;
- space = (qdf_nbuf_len(wbuf) - rx_desc_len)
- - 2;
- break;
- case 3:
- l ^= dp_rx_get_le32_split(data[0], data[1],
- data[2], data_next[0]);
- data = data_next + 1;
- space = (qdf_nbuf_len(wbuf) - rx_desc_len)
- - 1;
- break;
- }
- dp_rx_michael_block(l, r);
- data_len -= sizeof(uint32_t);
- } else {
- /*
- * Setup for next buffer.
- */
- data = (uint8_t *) qdf_nbuf_data(wbuf) + rx_desc_len;
- space = qdf_nbuf_len(wbuf) - rx_desc_len;
- }
- }
- /* Last block and padding (0x5a, 4..7 x 0) */
- switch (data_len) {
- case 0:
- l ^= dp_rx_get_le32_split(0x5a, 0, 0, 0);
- break;
- case 1:
- l ^= dp_rx_get_le32_split(data[0], 0x5a, 0, 0);
- break;
- case 2:
- l ^= dp_rx_get_le32_split(data[0], data[1], 0x5a, 0);
- break;
- case 3:
- l ^= dp_rx_get_le32_split(data[0], data[1], data[2], 0x5a);
- break;
- }
- dp_rx_michael_block(l, r);
- dp_rx_michael_block(l, r);
- dp_rx_put_le32(mic, l);
- dp_rx_put_le32(mic + 4, r);
- return QDF_STATUS_SUCCESS;
- }
- /*
- * dp_rx_defrag_tkip_demic(): Remove MIC header from the TKIP frame
- * @key: Pointer to the key
- * @msdu: fragment buffer
- * @hdrlen: Length of the header information
- *
- * Remove MIC information from the TKIP frame
- *
- * Returns: QDF_STATUS
- */
- static QDF_STATUS dp_rx_defrag_tkip_demic(const uint8_t *key,
- qdf_nbuf_t msdu, uint16_t hdrlen)
- {
- QDF_STATUS status;
- uint32_t pktlen;
- uint8_t mic[IEEE80211_WEP_MICLEN];
- uint8_t mic0[IEEE80211_WEP_MICLEN];
- int rx_desc_len = sizeof(struct rx_pkt_tlvs);
- pktlen = qdf_nbuf_len(msdu) - rx_desc_len;
- status = dp_rx_defrag_mic(key, msdu, hdrlen,
- pktlen - (hdrlen + dp_f_tkip.ic_miclen), mic);
- if (QDF_IS_STATUS_ERROR(status))
- return status;
- qdf_nbuf_copy_bits(msdu, pktlen - dp_f_tkip.ic_miclen + rx_desc_len,
- dp_f_tkip.ic_miclen, (caddr_t)mic0);
- if (!qdf_mem_cmp(mic, mic0, dp_f_tkip.ic_miclen))
- return QDF_STATUS_E_DEFRAG_ERROR;
- qdf_nbuf_trim_tail(msdu, dp_f_tkip.ic_miclen);
- return QDF_STATUS_SUCCESS;
- }
- /*
- * dp_rx_defrag_decap_recombine(): Recombine the fragments
- * @peer: Pointer to the peer
- * @frag_list: list of fragments
- * @tid: Transmit identifier
- * @hdrsize: Header size
- *
- * Recombine fragments
- *
- * Returns: QDF_STATUS
- */
- static QDF_STATUS dp_rx_defrag_decap_recombine(struct dp_peer *peer,
- qdf_nbuf_t head_msdu, unsigned tid, uint16_t hdrsize)
- {
- qdf_nbuf_t msdu = head_msdu;
- uint8_t i;
- uint8_t num_ring_desc_saved = peer->rx_tid[tid].curr_ring_desc_idx;
- uint8_t num_msdus;
- /* Stitch fragments together */
- for (i = 0; (i < num_ring_desc_saved) && msdu; i++) {
- struct hal_rx_msdu_link_ptr_info *msdu_link_ptr_info =
- &peer->rx_tid[tid].transcap_msdu_link_ptr[i];
- struct hal_rx_mpdu_desc_info *mpdu_desc_info =
- &peer->rx_tid[tid].transcap_rx_mpdu_desc_info;
- num_msdus = hal_rx_chain_msdu_links(msdu, msdu_link_ptr_info,
- mpdu_desc_info);
- msdu = qdf_nbuf_next(msdu);
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * dp_rx_defrag_err() - rx err handler
- * @pdev: handle to pdev object
- * @vdev_id: vdev id
- * @peer_mac_addr: peer mac address
- * @tid: TID
- * @tsf32: TSF
- * @err_type: error type
- * @rx_frame: rx frame
- * @pn: PN Number
- * @key_id: key id
- *
- * This function handles rx error and send MIC error notification
- *
- * Return: None
- */
- static void dp_rx_defrag_err(uint8_t vdev_id, uint8_t *peer_mac_addr,
- int tid, uint32_t tsf32, uint32_t err_type, qdf_nbuf_t rx_frame,
- uint64_t *pn, uint8_t key_id)
- {
- /* TODO: Who needs to know about the TKIP MIC error */
- }
- /*
- * dp_rx_defrag_qos_decap(): Remove QOS header from the frame
- * @nbuf: Pointer to the frame buffer
- * @hdrlen: Length of the header information
- *
- * Recombine fragments
- *
- * Returns: None
- */
- static void dp_rx_defrag_qos_decap(qdf_nbuf_t nbuf, uint16_t hdrlen)
- {
- struct ieee80211_frame *wh;
- uint16_t qoslen;
- int pkt_tlv_size = sizeof(struct rx_pkt_tlvs); /* pkt TLV hdr size */
- uint16_t fc = 0;
- uint8_t *rx_tlv_hdr = qdf_nbuf_data(nbuf);
- /* Get the frame control field if it is valid */
- if (hal_rx_get_mpdu_frame_control_valid(rx_tlv_hdr))
- fc = hal_rx_get_frame_ctrl_field(rx_tlv_hdr);
- wh = (struct ieee80211_frame *)(qdf_nbuf_data(nbuf) + pkt_tlv_size);
- if (DP_RX_DEFRAG_IEEE80211_QOS_HAS_SEQ(fc & 0xff)) {
- qoslen = sizeof(struct ieee80211_qoscntl);
- /* Qos frame with Order bit set indicates a HTC frame */
- if (((fc & 0xff00) >> 8) & IEEE80211_FC1_ORDER)
- qoslen += sizeof(struct ieee80211_htc);
- /* remove QoS field from header */
- hdrlen -= qoslen;
- qdf_mem_move((uint8_t *)wh + qoslen, wh, hdrlen);
- wh = (struct ieee80211_frame *)qdf_nbuf_pull_head(nbuf,
- pkt_tlv_size +
- qoslen);
- /* clear QoS bit */
- if (wh)
- wh->i_fc[0] &= ~IEEE80211_FC0_SUBTYPE_QOS;
- }
- }
- /*
- * dp_rx_defrag_nwifi_to_8023(): Transcap 802.11 to 802.3
- * @msdu: Pointer to the fragment buffer
- *
- * Transcap the fragment from 802.11 to 802.3
- *
- * Returns: None
- */
- static void dp_rx_defrag_nwifi_to_8023(qdf_nbuf_t msdu)
- {
- struct ieee80211_frame wh;
- uint32_t hdrsize;
- struct llc_snap_hdr_t llchdr;
- struct ethernet_hdr_t *eth_hdr;
- int rx_desc_len = sizeof(struct rx_pkt_tlvs);
- struct ieee80211_frame *wh_ptr;
- wh_ptr = (struct ieee80211_frame *)(qdf_nbuf_data(msdu) +
- rx_desc_len);
- qdf_mem_copy(&wh, wh_ptr, sizeof(wh));
- hdrsize = sizeof(struct ieee80211_frame);
- qdf_mem_copy(&llchdr, ((uint8_t *) (qdf_nbuf_data(msdu) +
- rx_desc_len)) + hdrsize,
- sizeof(struct llc_snap_hdr_t));
- /*
- * Now move the data pointer to the beginning of the mac header :
- * new-header = old-hdr + (wifihdrsize + llchdrsize - ethhdrsize)
- */
- qdf_nbuf_pull_head(msdu, (rx_desc_len + hdrsize +
- sizeof(struct llc_snap_hdr_t) -
- sizeof(struct ethernet_hdr_t)));
- eth_hdr = (struct ethernet_hdr_t *)(qdf_nbuf_data(msdu));
- switch (wh.i_fc[1] & IEEE80211_FC1_DIR_MASK) {
- case IEEE80211_FC1_DIR_NODS:
- qdf_mem_copy(eth_hdr->dest_addr, wh.i_addr1,
- IEEE80211_ADDR_LEN);
- qdf_mem_copy(eth_hdr->src_addr, wh.i_addr2,
- IEEE80211_ADDR_LEN);
- break;
- case IEEE80211_FC1_DIR_TODS:
- qdf_mem_copy(eth_hdr->dest_addr, wh.i_addr3,
- IEEE80211_ADDR_LEN);
- qdf_mem_copy(eth_hdr->src_addr, wh.i_addr2,
- IEEE80211_ADDR_LEN);
- break;
- case IEEE80211_FC1_DIR_FROMDS:
- qdf_mem_copy(eth_hdr->dest_addr, wh.i_addr1,
- IEEE80211_ADDR_LEN);
- qdf_mem_copy(eth_hdr->src_addr, wh.i_addr3,
- IEEE80211_ADDR_LEN);
- break;
- case IEEE80211_FC1_DIR_DSTODS:
- break;
- }
- /* TODO: Is it requried to copy rx_pkt_tlvs
- * to the start of data buffer?
- */
- qdf_mem_copy(eth_hdr->ethertype, llchdr.ethertype,
- sizeof(llchdr.ethertype));
- }
- /*
- * dp_rx_defrag_reo_reinject(): Reinject the fragment chain back into REO
- * @peer: Pointer to the peer
- * @tid: Transmit Identifier
- *
- * Reinject the fragment chain back into REO
- *
- * Returns: QDF_STATUS
- */
- static QDF_STATUS dp_rx_defrag_reo_reinject(struct dp_peer *peer,
- unsigned tid)
- {
- struct dp_pdev *pdev = peer->vdev->pdev;
- struct dp_soc *soc = pdev->soc;
- QDF_STATUS status = QDF_STATUS_E_FAILURE;
- void *ring_desc;
- enum hal_reo_error_status error;
- struct hal_rx_mpdu_desc_info *saved_mpdu_desc_info;
- void *hal_srng = soc->reo_reinject_ring.hal_srng;
- struct hal_rx_msdu_link_ptr_info *saved_msdu_link_ptr;
- if (qdf_unlikely(hal_srng_access_start(soc->hal_soc, hal_srng))) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "HAL RING Access For WBM Release SRNG Failed: %p",
- hal_srng);
- goto done;
- }
- ring_desc = hal_srng_src_get_next(soc->hal_soc, hal_srng);
- qdf_assert(ring_desc);
- error = HAL_RX_ERROR_STATUS_GET(ring_desc);
- if (qdf_unlikely(error == HAL_REO_ERROR_DETECTED)) {
- QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
- "HAL RING 0x%p:error %d", hal_srng, error);
- /* Don't know how to deal with this condition -- assert */
- qdf_assert(0);
- goto done;
- }
- saved_mpdu_desc_info =
- &peer->rx_tid[tid].transcap_rx_mpdu_desc_info;
- /* first msdu link pointer */
- saved_msdu_link_ptr =
- &peer->rx_tid[tid].transcap_msdu_link_ptr[0];
- hal_rx_defrag_update_src_ring_desc(ring_desc,
- saved_mpdu_desc_info, saved_msdu_link_ptr);
- status = QDF_STATUS_SUCCESS;
- done:
- hal_srng_access_end(soc->hal_soc, hal_srng);
- return status;
- }
- /*
- * dp_rx_defrag(): Defragment the fragment chain
- * @peer: Pointer to the peer
- * @tid: Transmit Identifier
- * @frag_list: Pointer to head list
- * @frag_list_tail: Pointer to tail list
- *
- * Defragment the fragment chain
- *
- * Returns: QDF_STATUS
- */
- static QDF_STATUS dp_rx_defrag(struct dp_peer *peer, unsigned tid,
- qdf_nbuf_t frag_list, qdf_nbuf_t frag_list_tail)
- {
- qdf_nbuf_t tmp_next;
- qdf_nbuf_t cur = frag_list, msdu;
- uint32_t index, tkip_demic = 0;
- uint16_t hdr_space;
- QDF_STATUS status;
- uint8_t key[DEFRAG_IEEE80211_KEY_LEN];
- struct dp_vdev *vdev = peer->vdev;
- cur = frag_list;
- hdr_space = dp_rx_defrag_hdrsize(cur);
- index = hal_rx_msdu_is_wlan_mcast(cur) ?
- dp_sec_mcast : dp_sec_ucast;
- switch (peer->security[index].sec_type) {
- case htt_sec_type_tkip:
- tkip_demic = 1;
- case htt_sec_type_tkip_nomic:
- while (cur) {
- tmp_next = qdf_nbuf_next(cur);
- if (dp_rx_defrag_tkip_decap(cur, hdr_space)) {
- /* TKIP decap failed, discard frags */
- dp_rx_defrag_frames_free(frag_list);
- QDF_TRACE(QDF_MODULE_ID_TXRX,
- QDF_TRACE_LEVEL_ERROR,
- "dp_rx_defrag: TKIP decap failed");
- return QDF_STATUS_E_DEFRAG_ERROR;
- }
- cur = tmp_next;
- }
- break;
- case htt_sec_type_aes_ccmp:
- while (cur) {
- tmp_next = qdf_nbuf_next(cur);
- if (dp_rx_defrag_ccmp_demic(cur, hdr_space)) {
- /* CCMP demic failed, discard frags */
- dp_rx_defrag_frames_free(frag_list);
- QDF_TRACE(QDF_MODULE_ID_TXRX,
- QDF_TRACE_LEVEL_ERROR,
- "dp_rx_defrag: CCMP demic failed");
- return QDF_STATUS_E_DEFRAG_ERROR;
- }
- if (dp_rx_defrag_ccmp_decap(cur, hdr_space)) {
- /* CCMP decap failed, discard frags */
- dp_rx_defrag_frames_free(frag_list);
- QDF_TRACE(QDF_MODULE_ID_TXRX,
- QDF_TRACE_LEVEL_ERROR,
- "dp_rx_defrag: CCMP decap failed");
- return QDF_STATUS_E_DEFRAG_ERROR;
- }
- cur = tmp_next;
- }
- break;
- case htt_sec_type_wep40:
- case htt_sec_type_wep104:
- case htt_sec_type_wep128:
- while (cur) {
- tmp_next = qdf_nbuf_next(cur);
- if (dp_rx_defrag_wep_decap(cur, hdr_space)) {
- /* WEP decap failed, discard frags */
- dp_rx_defrag_frames_free(frag_list);
- QDF_TRACE(QDF_MODULE_ID_TXRX,
- QDF_TRACE_LEVEL_ERROR,
- "dp_rx_defrag: WEP decap failed");
- return QDF_STATUS_E_DEFRAG_ERROR;
- }
- cur = tmp_next;
- }
- break;
- default:
- QDF_TRACE(QDF_MODULE_ID_TXRX,
- QDF_TRACE_LEVEL_ERROR,
- "dp_rx_defrag: Did not match any security type");
- break;
- }
- if (tkip_demic) {
- msdu = frag_list_tail; /* Only last fragment has the MIC */
- qdf_mem_copy(key,
- peer->security[index].michael_key,
- sizeof(peer->security[index].michael_key));
- if (dp_rx_defrag_tkip_demic(key, msdu, hdr_space)) {
- qdf_nbuf_free(msdu);
- dp_rx_defrag_err(vdev->vdev_id, peer->mac_addr.raw,
- tid, 0, QDF_STATUS_E_DEFRAG_ERROR, msdu,
- NULL, 0);
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "dp_rx_defrag: TKIP demic failed");
- return QDF_STATUS_E_DEFRAG_ERROR;
- }
- }
- dp_rx_defrag_qos_decap(cur, hdr_space);
- /* Convert the header to 802.3 header */
- dp_rx_defrag_nwifi_to_8023(cur);
- status = dp_rx_defrag_decap_recombine(peer, cur, tid, hdr_space);
- if (QDF_IS_STATUS_ERROR(status)) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "dp_rx_defrag_decap_recombine failed");
- qdf_assert(0);
- }
- return status;
- }
- /*
- * dp_rx_defrag_cleanup(): Clean up activities
- * @peer: Pointer to the peer
- * @tid: Transmit Identifier
- * @seq: Sequence number
- *
- * Returns: None
- */
- static void dp_rx_defrag_cleanup(struct dp_peer *peer, unsigned tid,
- uint16_t seq)
- {
- struct dp_rx_reorder_array_elem *rx_reorder_array_elem =
- &peer->rx_tid[tid].array[seq];
- /* Free up nbufs */
- dp_rx_defrag_frames_free(rx_reorder_array_elem->head);
- /* Free up saved ring descriptors */
- dp_rx_clear_saved_desc_info(peer, tid);
- rx_reorder_array_elem->head = NULL;
- rx_reorder_array_elem->tail = NULL;
- peer->rx_tid[tid].defrag_timeout_ms = 0;
- peer->rx_tid[tid].curr_frag_num = 0;
- peer->rx_tid[tid].curr_seq_num = 0;
- peer->rx_tid[tid].curr_ring_desc_idx = 0;
- }
- /*
- * dp_rx_defrag_save_info_from_ring_desc(): Save info from REO ring descriptor
- * @ring_desc: Pointer to the ring descriptor
- * @peer: Pointer to the peer
- * @tid: Transmit Identifier
- * @mpdu_desc_info: MPDU descriptor info
- *
- * Returns: None
- */
- static void dp_rx_defrag_save_info_from_ring_desc(void *ring_desc,
- struct dp_peer *peer, unsigned tid,
- struct hal_rx_mpdu_desc_info *mpdu_desc_info)
- {
- struct dp_pdev *pdev = peer->vdev->pdev;
- void *msdu_link_desc_va = NULL;
- uint8_t idx = peer->rx_tid[tid].curr_ring_desc_idx;
- uint8_t rbm;
- struct hal_rx_msdu_link_ptr_info *msdu_link_ptr_info =
- &peer->rx_tid[tid].transcap_msdu_link_ptr[++idx];
- struct hal_rx_mpdu_desc_info *tmp_mpdu_desc_info =
- &peer->rx_tid[tid].transcap_rx_mpdu_desc_info;
- struct hal_buf_info hbi;
- rbm = hal_rx_ret_buf_manager_get(ring_desc);
- if (qdf_unlikely(rbm != HAL_RX_BUF_RBM_SW3_BM)) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "Invalid RBM while chaining frag MSDUs");
- return;
- }
- hal_rx_reo_buf_paddr_get(ring_desc, &hbi);
- msdu_link_desc_va =
- dp_rx_cookie_2_link_desc_va(pdev->soc, &hbi);
- hal_rx_defrag_save_info_from_ring_desc(msdu_link_desc_va,
- msdu_link_ptr_info, &hbi);
- qdf_mem_copy(tmp_mpdu_desc_info, mpdu_desc_info,
- sizeof(*tmp_mpdu_desc_info));
- }
- /*
- * dp_rx_defrag_store_fragment(): Store incoming fragments
- * @soc: Pointer to the SOC data structure
- * @ring_desc: Pointer to the ring descriptor
- * @mpdu_desc_info: MPDU descriptor info
- * @msdu_info: Pointer to MSDU descriptor info
- * @tid: Traffic Identifier
- * @rx_desc: Pointer to rx descriptor
- *
- * Returns: QDF_STATUS
- */
- static QDF_STATUS dp_rx_defrag_store_fragment(struct dp_soc *soc,
- void *ring_desc,
- union dp_rx_desc_list_elem_t **head,
- union dp_rx_desc_list_elem_t **tail,
- struct hal_rx_mpdu_desc_info *mpdu_desc_info,
- struct hal_rx_msdu_desc_info *msdu_info,
- unsigned tid, struct dp_rx_desc *rx_desc)
- {
- uint8_t idx;
- struct dp_rx_reorder_array_elem *rx_reorder_array_elem;
- struct dp_pdev *pdev;
- struct dp_peer *peer;
- uint16_t peer_id;
- uint16_t rxseq, seq;
- uint8_t fragno, more_frag, all_frag_present = 0;
- uint16_t seq_num = mpdu_desc_info->mpdu_seq;
- QDF_STATUS status;
- struct dp_rx_tid *rx_tid;
- uint8_t mpdu_sequence_control_valid;
- uint8_t mpdu_frame_control_valid;
- qdf_nbuf_t frag = rx_desc->nbuf;
- uint8_t *rx_desc_info;
- /* Check if the packet is from a valid peer */
- peer_id = DP_PEER_METADATA_PEER_ID_GET(
- mpdu_desc_info->peer_meta_data);
- peer = dp_peer_find_by_id(soc, peer_id);
- if (!peer) {
- /* We should not recieve anything from unknown peer
- * however, that might happen while we are in the monitor mode.
- * We don't need to handle that here
- */
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "Unknown peer, dropping the fragment");
- qdf_nbuf_free(frag);
- dp_rx_add_to_free_desc_list(head, tail, rx_desc);
- return QDF_STATUS_E_DEFRAG_ERROR;
- }
- pdev = peer->vdev->pdev;
- rx_tid = &peer->rx_tid[tid];
- seq = seq_num & (peer->rx_tid[tid].ba_win_size - 1);
- qdf_assert(seq == 0);
- rx_reorder_array_elem = &peer->rx_tid[tid].array[seq];
- rx_desc_info = qdf_nbuf_data(frag);
- mpdu_sequence_control_valid =
- hal_rx_get_mpdu_sequence_control_valid(rx_desc_info);
- /* Invalid MPDU sequence control field, MPDU is of no use */
- if (!mpdu_sequence_control_valid) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "Invalid MPDU seq control field, dropping MPDU");
- qdf_nbuf_free(frag);
- dp_rx_add_to_free_desc_list(head, tail, rx_desc);
- qdf_assert(0);
- goto end;
- }
- mpdu_frame_control_valid =
- hal_rx_get_mpdu_frame_control_valid(rx_desc_info);
- /* Invalid frame control field */
- if (!mpdu_frame_control_valid) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "Invalid frame control field, dropping MPDU");
- qdf_nbuf_free(frag);
- dp_rx_add_to_free_desc_list(head, tail, rx_desc);
- qdf_assert(0);
- goto end;
- }
- /* Current mpdu sequence */
- rxseq = hal_rx_get_rx_sequence(rx_desc_info);
- more_frag = hal_rx_get_rx_more_frag_bit(rx_desc_info);
- /* HW does not populate the fragment number as of now
- * need to get from the 802.11 header
- */
- fragno = dp_rx_frag_get_mpdu_frag_number(rx_desc_info);
- /*
- * !more_frag: no more fragments to be delivered
- * !frag_no: packet is not fragmented
- * !rx_reorder_array_elem->head: no saved fragments so far
- */
- if ((!more_frag) && (!fragno) && (!rx_reorder_array_elem->head)) {
- /* We should not get into this situation here.
- * It means an unfragmented packet with fragment flag
- * is delivered over the REO exception ring.
- * Typically it follows normal rx path.
- */
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "Rcvd unfragmented pkt on REO Err srng, dropping");
- qdf_nbuf_free(frag);
- dp_rx_add_to_free_desc_list(head, tail, rx_desc);
- qdf_assert(0);
- goto end;
- }
- /* Check if the fragment is for the same sequence or a different one */
- if (rx_reorder_array_elem->head) {
- if (rxseq != rx_tid->curr_seq_num) {
- /* Drop stored fragments if out of sequence
- * fragment is received
- */
- dp_rx_defrag_frames_free(rx_reorder_array_elem->head);
- rx_reorder_array_elem->head = NULL;
- rx_reorder_array_elem->tail = NULL;
- /*
- * The sequence number for this fragment becomes the
- * new sequence number to be processed
- */
- rx_tid->curr_seq_num = rxseq;
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "%s mismatch, dropping earlier sequence ",
- (rxseq == rx_tid->curr_seq_num)
- ? "address"
- : "seq number");
- }
- } else {
- /* Start of a new sequence */
- rx_tid->curr_seq_num = rxseq;
- }
- /*
- * If the earlier sequence was dropped, this will be the fresh start.
- * Else, continue with next fragment in a given sequence
- */
- dp_rx_defrag_fraglist_insert(peer, tid, &rx_reorder_array_elem->head,
- &rx_reorder_array_elem->tail, frag,
- &all_frag_present);
- /*
- * Currently, we can have only 6 MSDUs per-MPDU, if the current
- * packet sequence has more than 6 MSDUs for some reason, we will
- * have to use the next MSDU link descriptor and chain them together
- * before reinjection
- */
- if (more_frag == 0 || fragno == HAL_RX_NUM_MSDU_DESC) {
- /*
- * Deep copy of MSDU link pointer and msdu descriptor structs
- */
- idx = peer->rx_tid[tid].curr_ring_desc_idx;
- if (idx < HAL_RX_MAX_SAVED_RING_DESC) {
- dp_rx_defrag_save_info_from_ring_desc(ring_desc,
- peer, tid, mpdu_desc_info);
- peer->rx_tid[tid].curr_ring_desc_idx++;
- } else {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "Max ring descr saved, dropping fragment");
- /*
- * Free up saved fragments and ring descriptors if any
- */
- goto end;
- }
- }
- /* TODO: handle fragment timeout gracefully */
- if (pdev->soc->rx.flags.defrag_timeout_check) {
- dp_rx_defrag_waitlist_remove(peer, tid);
- goto end;
- }
- /* Yet to receive more fragments for this sequence number */
- if (!all_frag_present) {
- uint32_t now_ms =
- qdf_system_ticks_to_msecs(qdf_system_ticks());
- peer->rx_tid[tid].defrag_timeout_ms =
- now_ms + pdev->soc->rx.defrag.timeout_ms;
- dp_rx_defrag_waitlist_add(peer, tid);
- goto end;
- }
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_INFO,
- "All fragments received for sequence: %d", rxseq);
- /* Process the fragments */
- status = dp_rx_defrag(peer, tid, rx_reorder_array_elem->head,
- rx_reorder_array_elem->tail);
- if (QDF_IS_STATUS_ERROR(status)) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "Fragment processing failed");
- goto end;
- }
- /* Re-inject the fragments back to REO for further processing */
- status = dp_rx_defrag_reo_reinject(peer, tid);
- if (QDF_IS_STATUS_SUCCESS(status))
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_INFO,
- "Fragmented sequence successfully reinjected");
- else
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "Fragmented sequence reinjection failed");
- end:
- dp_rx_defrag_cleanup(peer, tid, seq);
- return QDF_STATUS_E_DEFRAG_ERROR;
- }
- /**
- * dp_rx_frag_handle() - Handles fragmented Rx frames
- *
- * @soc: core txrx main context
- * @ring_desc: opaque pointer to the REO error ring descriptor
- * @mpdu_desc_info: MPDU descriptor information from ring descriptor
- * @head: head of the local descriptor free-list
- * @tail: tail of the local descriptor free-list
- * @quota: No. of units (packets) that can be serviced in one shot.
- *
- * This function implements RX 802.11 fragmentation handling
- * The handling is mostly same as legacy fragmentation handling.
- * If required, this function can re-inject the frames back to
- * REO ring (with proper setting to by-pass fragmentation check
- * but use duplicate detection / re-ordering and routing these frames
- * to a different core.
- *
- * Return: uint32_t: No. of elements processed
- */
- uint32_t dp_rx_frag_handle(struct dp_soc *soc, void *ring_desc,
- struct hal_rx_mpdu_desc_info *mpdu_desc_info,
- union dp_rx_desc_list_elem_t **head,
- union dp_rx_desc_list_elem_t **tail,
- uint32_t quota)
- {
- uint32_t rx_bufs_used = 0;
- void *link_desc_va;
- struct hal_buf_info buf_info;
- struct hal_rx_msdu_list msdu_list; /* per MPDU list of MSDUs */
- uint32_t tid;
- int idx;
- QDF_STATUS status;
- qdf_assert(soc);
- qdf_assert(mpdu_desc_info);
- /* Fragment from a valid peer */
- hal_rx_reo_buf_paddr_get(ring_desc, &buf_info);
- link_desc_va = dp_rx_cookie_2_link_desc_va(soc, &buf_info);
- qdf_assert(link_desc_va);
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_INFO_HIGH,
- "Number of MSDUs to process, num_msdus: %d",
- mpdu_desc_info->msdu_count);
- if (qdf_unlikely(mpdu_desc_info->msdu_count == 0)) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "Not sufficient MSDUs to process");
- return rx_bufs_used;
- }
- /* Get msdu_list for the given MPDU */
- hal_rx_msdu_list_get(link_desc_va, &msdu_list,
- mpdu_desc_info->msdu_count);
- /* Process all MSDUs in the current MPDU */
- for (idx = 0; (idx < mpdu_desc_info->msdu_count) && quota--; idx++) {
- struct dp_rx_desc *rx_desc =
- dp_rx_cookie_2_va_rxdma_buf(soc,
- msdu_list.sw_cookie[idx]);
- qdf_assert(rx_desc);
- tid = hal_rx_mpdu_start_tid_get(rx_desc->rx_buf_start);
- /* Process fragment-by-fragment */
- status = dp_rx_defrag_store_fragment(soc, ring_desc,
- head, tail, mpdu_desc_info,
- &msdu_list.msdu_info[idx], tid,
- rx_desc);
- if (QDF_IS_STATUS_SUCCESS(status))
- rx_bufs_used++;
- else
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "Rx Defragmentation error. mpdu_seq: 0x%x msdu_count: %d mpdu_flags: %d",
- mpdu_desc_info->mpdu_seq, mpdu_desc_info->msdu_count,
- mpdu_desc_info->mpdu_flags);
- }
- return rx_bufs_used;
- }
|