Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 040b97be authored by Jes Sorensen's avatar Jes Sorensen Committed by Kalle Valo
Browse files

rtl8xxxu: Add support for aggregated RX packets on gen1 parts 



This implements support for demuxing aggregated RX packets on gen1
devices, using the rxdesc16 format.

So far this has only been tested with rtl8723au devices.

Signed-off-by: default avatarJes Sorensen <Jes.Sorensen@redhat.com>
Signed-off-by: default avatarKalle Valo <kvalo@codeaurora.org>
parent 41892729

drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_core.c

+69 −34
Original line number Diff line number Diff line
@@ -5093,28 +5093,54 @@ static void rtl8723bu_handle_c2h(struct rtl8xxxu_priv *priv, 
int rtl8xxxu_parse_rxdesc16(struct rtl8xxxu_priv *priv, struct sk_buff *skb)

{

	struct ieee80211_hw *hw = priv->hw;

	struct ieee80211_rx_status *rx_status = IEEE80211_SKB_RXCB(skb);

	struct rtl8xxxu_rxdesc16 *rx_desc =

		(struct rtl8xxxu_rxdesc16 *)skb->data;

	struct ieee80211_rx_status *rx_status;

	struct rtl8xxxu_rxdesc16 *rx_desc;

	struct rtl8723au_phy_stats *phy_stats;

	__le32 *_rx_desc_le = (__le32 *)skb->data;

	u32 *_rx_desc = (u32 *)skb->data;

	struct sk_buff *next_skb = NULL;

	__le32 *_rx_desc_le;

	u32 *_rx_desc;

	int drvinfo_sz, desc_shift;

	int i;

	int i, pkt_cnt, pkt_len, urb_len, pkt_offset;



	urb_len = skb->len;

	pkt_cnt = 0;



	for (i = 0; i < (sizeof(struct rtl8xxxu_rxdesc16) / sizeof(u32)); i++)

	do {

		rx_desc = (struct rtl8xxxu_rxdesc16 *)skb->data;

		_rx_desc_le = (__le32 *)skb->data;

		_rx_desc = (u32 *)skb->data;



		for (i = 0;

		     i < (sizeof(struct rtl8xxxu_rxdesc16) / sizeof(u32)); i++)

			_rx_desc[i] = le32_to_cpu(_rx_desc_le[i]);



		/*

		 * Only read pkt_cnt from the header if we're parsing the

		 * first packet

		 */

		if (!pkt_cnt)

			pkt_cnt = rx_desc->pkt_cnt;

		pkt_len = rx_desc->pktlen;



		drvinfo_sz = rx_desc->drvinfo_sz * 8;

		desc_shift = rx_desc->shift;

		pkt_offset = roundup(pkt_len + drvinfo_sz + desc_shift +

				     sizeof(struct rtl8xxxu_rxdesc16), 128);



		if (pkt_cnt > 1)

			next_skb = skb_clone(skb, GFP_ATOMIC);



		rx_status = IEEE80211_SKB_RXCB(skb);

		memset(rx_status, 0, sizeof(struct ieee80211_rx_status));



		skb_pull(skb, sizeof(struct rtl8xxxu_rxdesc16));



		phy_stats = (struct rtl8723au_phy_stats *)skb->data;



	drvinfo_sz = rx_desc->drvinfo_sz * 8;

	desc_shift = rx_desc->shift;

		skb_pull(skb, drvinfo_sz + desc_shift);



		skb_trim(skb, pkt_len);



		if (rx_desc->phy_stats)

			rtl8xxxu_rx_parse_phystats(priv, rx_status, phy_stats,

						   rx_desc->rxmcs);
@@ -5140,6 +5166,15 @@ int rtl8xxxu_parse_rxdesc16(struct rtl8xxxu_priv *priv, struct sk_buff *skb) 
		rx_status->band = hw->conf.chandef.chan->band;



		ieee80211_rx_irqsafe(hw, skb);



		skb = next_skb;

		if (skb)

			skb_pull(next_skb, pkt_offset);



		pkt_cnt--;

		urb_len -= pkt_offset;

	} while (skb && urb_len > 0 && pkt_cnt > 0);



	return RX_TYPE_DATA_PKT;

}