mirror of
https://github.com/chinawrj/rtl8812au
synced 2024-11-27 15:44:18 +00:00
radiotap tx support for injection
This commit is contained in:
kimocoder
parent
d4f1921d37
commit
07c704c0a7
241
core/rtw_xmit.c
241
core/rtw_xmit.c
@ -4401,7 +4401,6 @@ static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib)
|
||||
s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev)
|
||||
{
|
||||
u16 frame_ctl;
|
||||
struct ieee80211_radiotap_header rtap_hdr;
|
||||
_adapter *padapter = (_adapter *)rtw_netdev_priv(ndev);
|
||||
struct pkt_file pktfile;
|
||||
struct rtw_ieee80211_hdr *pwlanhdr;
|
||||
@ -4411,37 +4410,57 @@ s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev)
|
||||
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
|
||||
struct registry_priv *pregpriv = &(padapter->registrypriv);
|
||||
unsigned char *pframe;
|
||||
u8 dummybuf[32];
|
||||
int len = skb->len, rtap_len, consume;
|
||||
int len = skb->len;
|
||||
|
||||
int rtap_len, rtap_remain, ret;
|
||||
struct ieee80211_radiotap_header *rtap_hdr; // net/ieee80211_radiotap.h
|
||||
struct ieee80211_radiotap_iterator iterator; // net/cfg80211.h
|
||||
u8 rtap_buf[256];
|
||||
|
||||
int alloc_tries, alloc_delay;
|
||||
|
||||
rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize);
|
||||
|
||||
#ifndef CONFIG_CUSTOMER_ALIBABA_GENERAL
|
||||
if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header)))
|
||||
goto fail;
|
||||
|
||||
_rtw_open_pktfile((_pkt *)skb, &pktfile);
|
||||
_rtw_pktfile_read(&pktfile, (u8 *)(&rtap_hdr), sizeof(struct ieee80211_radiotap_header));
|
||||
rtap_len = ieee80211_get_radiotap_len((u8 *)(&rtap_hdr));
|
||||
if (unlikely(rtap_hdr.it_version))
|
||||
// Read in radiotap header and sanity check length
|
||||
_rtw_pktfile_read(&pktfile, rtap_buf, sizeof(struct ieee80211_radiotap_header));
|
||||
rtap_hdr = (struct ieee80211_radiotap_header*)(rtap_buf);
|
||||
rtap_len = ieee80211_get_radiotap_len(rtap_buf);
|
||||
|
||||
if (unlikely(rtap_hdr->it_version))
|
||||
goto fail;
|
||||
|
||||
if (unlikely(skb->len < rtap_len))
|
||||
goto fail;
|
||||
|
||||
if (unlikely(rtap_len < sizeof(struct ieee80211_radiotap_header)))
|
||||
goto fail;
|
||||
|
||||
len -= sizeof(struct ieee80211_radiotap_header);
|
||||
rtap_len -= sizeof(struct ieee80211_radiotap_header);
|
||||
rtap_remain = rtap_len - sizeof(struct ieee80211_radiotap_header);
|
||||
|
||||
while(rtap_len) {
|
||||
consume = rtap_len > sizeof(dummybuf) ? sizeof(dummybuf) : rtap_len;
|
||||
_rtw_pktfile_read(&pktfile, dummybuf, consume);
|
||||
rtap_len -= consume;
|
||||
len -= consume;
|
||||
// Read in rest of radiotap body
|
||||
if (rtap_remain) {
|
||||
_rtw_pktfile_read(&pktfile, &rtap_buf[sizeof(struct ieee80211_radiotap_header)], rtap_remain);
|
||||
len -= rtap_remain;
|
||||
}
|
||||
#endif
|
||||
|
||||
// NOTE: we process the radiotap header after we update the frame attribs below,
|
||||
// so we can directly apply overrides rather than cache all the values into
|
||||
// variables and apply them later.
|
||||
|
||||
// In just a bit we will attempt to take a pointer to the wlan hdr. If the remaining bytes
|
||||
// are less than a full header, we will technically be reading random bytes. So this is a
|
||||
// guard check to ensure there is a full minimum frame to read before we alloc and proceed
|
||||
// to read.
|
||||
if (unlikely(len < sizeof(struct rtw_ieee80211_hdr))) {
|
||||
goto fail;
|
||||
}
|
||||
|
||||
// Process rest of frame
|
||||
alloc_delay = 100;
|
||||
for (alloc_tries=3; alloc_tries > 0; alloc_tries--) {
|
||||
pmgntframe = alloc_mgtxmitframe(pxmitpriv);
|
||||
@ -4459,7 +4478,7 @@ s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev)
|
||||
_rtw_pktfile_read(&pktfile, pframe, len);
|
||||
|
||||
|
||||
/* Check DATA/MGNT frames */
|
||||
// Setup attribs for default Mgmt vs Data frame
|
||||
pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
|
||||
pattrib = &pmgntframe->attrib;
|
||||
pattrib->injected = _TRUE;
|
||||
@ -4493,11 +4512,197 @@ s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev)
|
||||
else
|
||||
pattrib->retry_ctrl = _FALSE;
|
||||
pattrib->pktlen = len;
|
||||
pmlmeext->mgnt_seq = GetSequence(pwlanhdr);
|
||||
pattrib->seqnum = pmlmeext->mgnt_seq;
|
||||
pmlmeext->mgnt_seq++;
|
||||
|
||||
pattrib->last_txcmdsz = pattrib->pktlen;
|
||||
|
||||
/*
|
||||
ANALYSIS: most other xmit/frame generation flows:
|
||||
- take next seqnum from pmlmeext->mgnt_seq
|
||||
- call SetSeqNum to write it into the packet
|
||||
- increment pmlmext->mgnt_seq
|
||||
- and set it into pattrib->seqnum
|
||||
Then in HAL, update_txdesc will either use hardware seq number if !pattrib_qos_en,
|
||||
otherwise SET_TX_DESC_SEQ_8812 w/ pattrib->seqnum.
|
||||
Also worth noting is prior update_monitor_frame_attrib/update_mgntframe_attrib call
|
||||
merely set pattrib->seqnum to pmlmeext->mgnt_seq, but do NOT increment mgnt_seq.
|
||||
Also they both set qos_en=_FALSE, which induce HW seq numbers.
|
||||
The code below, however, appears to read the seq num out of the injected packet,
|
||||
update the global pmlmeext->mgnt_seq with the injected seqnum, and then set
|
||||
global pmlmeext to next seq. IMHO it appears to be doing the wrong thing, since
|
||||
it is both updating pmlmeext from data in the packet, and all those values
|
||||
are ignored because qos_en=_FALSE and thus HW seq is just used.
|
||||
Ideally it would be nice to be able to control the sequence number, but the
|
||||
strong coupling to qos_en makes that difficult right now. So we will just
|
||||
use the default HW mode. However, we are going to skip some of the extraneous
|
||||
steps this original code did by simply accepting:
|
||||
- update_*_attrib called prior already set seqnum from pmlmeext
|
||||
- so all we need to do is mgnt_seq++ just in case
|
||||
- (and it seems we can avoid the SetSeqNum call)
|
||||
pmlmeext->mgnt_seq = GetSequence(pwlanhdr);
|
||||
pattrib->seqnum = pmlmeext->mgnt_seq;
|
||||
pmlmeext->mgnt_seq++;
|
||||
*/
|
||||
pmlmeext->mgnt_seq++;
|
||||
|
||||
pattrib->retry_ctrl = _FALSE;
|
||||
|
||||
// Parse radiotap for injection items and overwrite attribs as needed
|
||||
ret = ieee80211_radiotap_iterator_init(&iterator, rtap_hdr, rtap_len, NULL);
|
||||
while (!ret) {
|
||||
ret = ieee80211_radiotap_iterator_next(&iterator);
|
||||
if (ret)
|
||||
continue;
|
||||
|
||||
switch (iterator.this_arg_index) {
|
||||
case IEEE80211_RADIOTAP_RATE:
|
||||
// This is basic 802.11b/g rate; use MCS/VHT for higher rates
|
||||
pattrib->rate = *iterator.this_arg;
|
||||
#ifdef CONFIG_80211AC_VHT
|
||||
pattrib->raid = RATEID_IDX_BGN_40M_1SS;
|
||||
#else
|
||||
if (pattrib->rate == IEEE80211_CCK_RATE_1MB
|
||||
|| pattrib->rate == IEEE80211_CCK_RATE_2MB
|
||||
|| pattrib->rate == IEEE80211_CCK_RATE_5MB
|
||||
|| pattrib->rate == IEEE80211_CCK_RATE_11MB )
|
||||
pattrib->raid = rtw_get_mgntframe_raid(padapter, WIRELESS_11B);
|
||||
else
|
||||
pattrib->raid = rtw_get_mgntframe_raid(padapter, WIRELESS_11G);
|
||||
#endif
|
||||
|
||||
// We have to reset other attributes that may have been set prior for MCS/VHT rates
|
||||
pattrib->ht_en = _FALSE;
|
||||
pattrib->ampdu_en = _FALSE;
|
||||
pattrib->sgi = _FALSE;
|
||||
pattrib->ldpc = _FALSE;
|
||||
pattrib->stbc = 0;
|
||||
pattrib->bwmode = CHANNEL_WIDTH_20;
|
||||
pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
|
||||
|
||||
break;
|
||||
|
||||
case IEEE80211_RADIOTAP_TX_FLAGS: {
|
||||
u16 txflags = get_unaligned_le16(iterator.this_arg);
|
||||
|
||||
if ((txflags & IEEE80211_RADIOTAP_F_TX_NOACK) == 0)
|
||||
pattrib->retry_ctrl = _TRUE; // Note; already _FALSE by default
|
||||
|
||||
if (txflags & 0x0010) { // Use preconfigured seq num
|
||||
// NOTE: this is currently ignored due to qos_en=_FALSE and HW seq num override
|
||||
pattrib->seqnum = GetSequence(pwlanhdr);
|
||||
}
|
||||
|
||||
break;
|
||||
}
|
||||
|
||||
case IEEE80211_RADIOTAP_MCS: {
|
||||
u8 mcs_have = iterator.this_arg[0];
|
||||
|
||||
// Set up defaults
|
||||
pattrib->rate = MGN_MCS0;
|
||||
pattrib->bwmode = IEEE80211_RADIOTAP_MCS_BW_20;
|
||||
pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
|
||||
pattrib->ht_en = _TRUE;
|
||||
pattrib->sgi = _FALSE;
|
||||
pattrib->ldpc = _FALSE;
|
||||
pattrib->stbc = 0;
|
||||
|
||||
if (mcs_have & IEEE80211_RADIOTAP_MCS_HAVE_BW) {
|
||||
|
||||
u8 bw = (iterator.this_arg[1] & IEEE80211_RADIOTAP_MCS_BW_MASK);
|
||||
if (bw == IEEE80211_RADIOTAP_MCS_BW_20L) {
|
||||
bw = IEEE80211_RADIOTAP_MCS_BW_20;
|
||||
pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER;
|
||||
}
|
||||
if (bw == IEEE80211_RADIOTAP_MCS_BW_20U) {
|
||||
bw = IEEE80211_RADIOTAP_MCS_BW_20;
|
||||
pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER;
|
||||
}
|
||||
|
||||
pattrib->bwmode = bw;
|
||||
}
|
||||
|
||||
if (mcs_have & IEEE80211_RADIOTAP_MCS_HAVE_MCS) {
|
||||
u8 fixed_rate = iterator.this_arg[2] & 0x7f;
|
||||
if(fixed_rate > 31)
|
||||
fixed_rate = 0;
|
||||
fixed_rate += MGN_MCS0;
|
||||
pattrib->rate = fixed_rate;
|
||||
}
|
||||
|
||||
if ((mcs_have & IEEE80211_RADIOTAP_MCS_HAVE_GI) && (iterator.this_arg[1] & IEEE80211_RADIOTAP_MCS_SGI))
|
||||
pattrib->sgi = _TRUE;
|
||||
|
||||
if ((mcs_have & IEEE80211_RADIOTAP_MCS_HAVE_FEC) && (iterator.this_arg[1] & IEEE80211_RADIOTAP_MCS_FEC_LDPC))
|
||||
pattrib->ldpc = _TRUE;
|
||||
|
||||
if (mcs_have & IEEE80211_RADIOTAP_MCS_HAVE_STBC) {
|
||||
u8 stbc = (iterator.this_arg[1] & IEEE80211_RADIOTAP_MCS_STBC_MASK) >> IEEE80211_RADIOTAP_MCS_STBC_SHIFT;
|
||||
pattrib->stbc = stbc;
|
||||
}
|
||||
}
|
||||
break;
|
||||
|
||||
#ifdef CONFIG_80211AC_VHT
|
||||
case IEEE80211_RADIOTAP_VHT: {
|
||||
unsigned int mcs, nss;
|
||||
|
||||
u8 known = iterator.this_arg[0];
|
||||
u8 flags = iterator.this_arg[2];
|
||||
|
||||
// Set up defaults
|
||||
pattrib->stbc = 0;
|
||||
pattrib->sgi = _FALSE;
|
||||
pattrib->bwmode = CHANNEL_WIDTH_20;
|
||||
pattrib->ldpc = _FALSE;
|
||||
pattrib->rate = MGN_VHT1SS_MCS0;
|
||||
pattrib->raid = RATEID_IDX_VHT_1SS;
|
||||
|
||||
// NOTE: this code currently only supports 1SS for radiotap defined rates
|
||||
|
||||
if ((known & IEEE80211_RADIOTAP_VHT_KNOWN_STBC) && (flags & IEEE80211_RADIOTAP_VHT_FLAG_STBC))
|
||||
pattrib->stbc = 1;
|
||||
|
||||
if ((known & IEEE80211_RADIOTAP_VHT_KNOWN_GI) && (flags & IEEE80211_RADIOTAP_VHT_FLAG_SGI))
|
||||
pattrib->sgi = _TRUE;
|
||||
|
||||
if (known & IEEE80211_RADIOTAP_VHT_KNOWN_BANDWIDTH) {
|
||||
u8 bw = iterator.this_arg[3] & 0x1F;
|
||||
// NOTE: there are various L and U, but we just use straight 20/40/80
|
||||
// since it's not clear how to set CHNL_OFFSET_LOWER/_UPPER with different
|
||||
// sideband sizes/configurations. TODO.
|
||||
// Also, any 160 is treated as 80 due to lack of WIDTH_160.
|
||||
if (bw == 0)
|
||||
pattrib->bwmode = CHANNEL_WIDTH_20;
|
||||
else if (bw >=1 && bw <= 3)
|
||||
pattrib->bwmode = CHANNEL_WIDTH_40;
|
||||
else if (bw >=4 && bw <= 10)
|
||||
pattrib->bwmode = CHANNEL_WIDTH_80;
|
||||
else if (bw >= 11 && bw <= 25)
|
||||
pattrib->bwmode = CHANNEL_WIDTH_80; // Supposed to be 160Mhz, we use 80Mhz
|
||||
}
|
||||
|
||||
// User 0
|
||||
nss = iterator.this_arg[4] & 0x0F; // Number of spatial streams
|
||||
if (nss > 0) {
|
||||
if (nss > 4) nss = 4;
|
||||
mcs = (iterator.this_arg[4]>>4) & 0x0F; // MCS rate index
|
||||
if (mcs > 8) mcs = 9;
|
||||
pattrib->rate = MGN_VHT1SS_MCS0 + ((nss-1)*10 + mcs);
|
||||
|
||||
if (iterator.this_arg[8] & IEEE80211_RADIOTAP_CODING_LDPC_USER0)
|
||||
pattrib->ldpc = _TRUE;
|
||||
}
|
||||
|
||||
}
|
||||
break;
|
||||
#endif
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
// All set
|
||||
dump_mgntframe(padapter, pmgntframe);
|
||||
pxmitpriv->tx_pkts++;
|
||||
pxmitpriv->tx_bytes += skb->len;
|
||||
|
||||
Loading…
Reference in New Issue
Block a user