618 lines
17 KiB
C
618 lines
17 KiB
C
/******************************************************************************
|
|
*
|
|
* Copyright(c) 2007 - 2017 Realtek Corporation.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of version 2 of the GNU General Public License as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
*****************************************************************************/
|
|
#define _RTW_RADIOTAP_C_
|
|
|
|
#ifdef CONFIG_WIFI_MONITOR
|
|
|
|
#include <drv_types.h>
|
|
#include <hal_data.h>
|
|
|
|
#define CHAN2FREQ(a) ((a < 14) ? (2407+5*a) : (5000+5*a))
|
|
|
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 20, 0))
|
|
#define IEEE80211_RADIOTAP_ZERO_LEN_PSDU 26
|
|
#define IEEE80211_RADIOTAP_LSIG 27
|
|
#endif
|
|
|
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 0))
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP 22
|
|
/* For IEEE80211_RADIOTAP_TIMESTAMP */
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_UNIT_MASK 0x000F
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_UNIT_MS 0x0000
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_UNIT_US 0x0001
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_UNIT_NS 0x0003
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_MASK 0x00F0
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_BEGIN_MDPU 0x0000
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_EO_MPDU 0x0010
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_EO_PPDU 0x0020
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_PLCP_SIG_ACQ 0x0030
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_UNKNOWN 0x00F0
|
|
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_FLAG_64BIT 0x00
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_FLAG_32BIT 0x01
|
|
#define IEEE80211_RADIOTAP_TIMESTAMP_FLAG_ACCURACY 0x02
|
|
#endif
|
|
|
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0))
|
|
/* for IEEE80211_RADIOTAP_CHANNEL */
|
|
#define IEEE80211_CHAN_GSM 0x1000 /* GSM (900 MHz) */
|
|
#define IEEE80211_CHAN_STURBO 0x2000 /* Static Turbo */
|
|
#define IEEE80211_CHAN_HALF 0x4000 /* Half channel (10 MHz wide) */
|
|
#define IEEE80211_CHAN_QUARTER 0x8000 /* Quarter channel (5 MHz wide) */
|
|
#endif
|
|
|
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0))
|
|
#define IEEE80211_RADIOTAP_VHT 21
|
|
/* For IEEE80211_RADIOTAP_VHT */
|
|
#define IEEE80211_RADIOTAP_VHT_KNOWN_STBC 0x0001
|
|
#define IEEE80211_RADIOTAP_VHT_KNOWN_TXOP_PS_NA 0x0002
|
|
#define IEEE80211_RADIOTAP_VHT_KNOWN_GI 0x0004
|
|
#define IEEE80211_RADIOTAP_VHT_KNOWN_SGI_NSYM_DIS 0x0008
|
|
#define IEEE80211_RADIOTAP_VHT_KNOWN_LDPC_EXTRA_OFDM_SYM 0x0010
|
|
#define IEEE80211_RADIOTAP_VHT_KNOWN_BEAMFORMED 0x0020
|
|
#define IEEE80211_RADIOTAP_VHT_KNOWN_BANDWIDTH 0x0040
|
|
#define IEEE80211_RADIOTAP_VHT_KNOWN_GROUP_ID 0x0080
|
|
#define IEEE80211_RADIOTAP_VHT_KNOWN_PARTIAL_AID 0x0100
|
|
|
|
#define IEEE80211_RADIOTAP_VHT_FLAG_STBC 0x01
|
|
#define IEEE80211_RADIOTAP_VHT_FLAG_TXOP_PS_NA 0x02
|
|
#define IEEE80211_RADIOTAP_VHT_FLAG_SGI 0x04
|
|
#define IEEE80211_RADIOTAP_VHT_FLAG_SGI_NSYM_M10_9 0x08
|
|
#define IEEE80211_RADIOTAP_VHT_FLAG_LDPC_EXTRA_OFDM_SYM 0x10
|
|
#define IEEE80211_RADIOTAP_VHT_FLAG_BEAMFORMED 0x20
|
|
#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0))
|
|
#define IEEE80211_RADIOTAP_CODING_LDPC_USER0 0x01
|
|
#define IEEE80211_RADIOTAP_CODING_LDPC_USER1 0x02
|
|
#define IEEE80211_RADIOTAP_CODING_LDPC_USER2 0x04
|
|
#define IEEE80211_RADIOTAP_CODING_LDPC_USER3 0x08
|
|
#endif
|
|
|
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 7, 0))
|
|
#define IEEE80211_RADIOTAP_AMPDU_STATUS 20
|
|
/* For IEEE80211_RADIOTAP_AMPDU_STATUS */
|
|
#define IEEE80211_RADIOTAP_AMPDU_REPORT_ZEROLEN 0x0001
|
|
#define IEEE80211_RADIOTAP_AMPDU_IS_ZEROLEN 0x0002
|
|
#define IEEE80211_RADIOTAP_AMPDU_LAST_KNOWN 0x0004
|
|
#define IEEE80211_RADIOTAP_AMPDU_IS_LAST 0x0008
|
|
#define IEEE80211_RADIOTAP_AMPDU_DELIM_CRC_ERR 0x0010
|
|
#define IEEE80211_RADIOTAP_AMPDU_DELIM_CRC_KNOWN 0x0020
|
|
#elif (LINUX_VERSION_CODE < KERNEL_VERSION(4, 17, 0))
|
|
#define IEEE80211_RADIOTAP_AMPDU_EOF 0x0040
|
|
#define IEEE80211_RADIOTAP_AMPDU_EOF_KNOWN 0x0080
|
|
#endif
|
|
|
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 39))
|
|
#define IEEE80211_RADIOTAP_MCS 19
|
|
/* For IEEE80211_RADIOTAP_MCS */
|
|
#define IEEE80211_RADIOTAP_MCS_HAVE_BW 0x01
|
|
#define IEEE80211_RADIOTAP_MCS_HAVE_MCS 0x02
|
|
#define IEEE80211_RADIOTAP_MCS_HAVE_GI 0x04
|
|
#define IEEE80211_RADIOTAP_MCS_HAVE_FMT 0x08
|
|
#define IEEE80211_RADIOTAP_MCS_HAVE_FEC 0x10
|
|
|
|
#define IEEE80211_RADIOTAP_MCS_BW_MASK 0x03
|
|
#define IEEE80211_RADIOTAP_MCS_BW_20 0
|
|
#define IEEE80211_RADIOTAP_MCS_BW_40 1
|
|
#define IEEE80211_RADIOTAP_MCS_BW_20L 2
|
|
#define IEEE80211_RADIOTAP_MCS_BW_20U 3
|
|
#define IEEE80211_RADIOTAP_MCS_SGI 0x04
|
|
#define IEEE80211_RADIOTAP_MCS_FMT_GF 0x08
|
|
#define IEEE80211_RADIOTAP_MCS_FEC_LDPC 0x10
|
|
#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0))
|
|
#define IEEE80211_RADIOTAP_MCS_HAVE_STBC 0x20
|
|
|
|
#define IEEE80211_RADIOTAP_MCS_STBC_MASK 0x60
|
|
#define IEEE80211_RADIOTAP_MCS_STBC_1 1
|
|
#define IEEE80211_RADIOTAP_MCS_STBC_2 2
|
|
#define IEEE80211_RADIOTAP_MCS_STBC_3 3
|
|
#define IEEE80211_RADIOTAP_MCS_STBC_SHIFT 5
|
|
#endif
|
|
|
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 34))
|
|
#define IEEE80211_RADIOTAP_RADIOTAP_NAMESPACE 29
|
|
#define IEEE80211_RADIOTAP_VENDOR_NAMESPACE 30
|
|
#endif
|
|
|
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 30))
|
|
#define IEEE80211_RADIOTAP_F_BADFCS 0x40
|
|
#endif
|
|
|
|
static inline void _rtw_radiotap_fill_flags(struct rx_pkt_attrib *a, u8 *flags)
|
|
{
|
|
struct moinfo *moif = (struct moinfo *)&a->moif;
|
|
|
|
if (0)
|
|
*flags |= IEEE80211_RADIOTAP_F_CFP;
|
|
|
|
if (0)
|
|
*flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
|
|
|
|
if ((a->encrypt == 1) || (a->encrypt == 5))
|
|
*flags |= IEEE80211_RADIOTAP_F_WEP;
|
|
|
|
if (a->mfrag)
|
|
*flags |= IEEE80211_RADIOTAP_F_FRAG;
|
|
|
|
if (1)
|
|
*flags |= IEEE80211_RADIOTAP_F_FCS;
|
|
|
|
if (0)
|
|
*flags |= IEEE80211_RADIOTAP_F_DATAPAD;
|
|
|
|
if (a->crc_err)
|
|
*flags |= IEEE80211_RADIOTAP_F_BADFCS;
|
|
|
|
/* Currently unspecified but used
|
|
for short guard interval (HT) */
|
|
if (moif->u.snif_info.sgi || a->sgi)
|
|
*flags |= 0x80;
|
|
|
|
}
|
|
|
|
sint rtw_fill_radiotap_hdr(_adapter *padapter, struct rx_pkt_attrib *a, u8 *buf)
|
|
{
|
|
#define RTAP_HDR_MAX 64
|
|
|
|
sint ret = _SUCCESS;
|
|
struct moinfo *moif = (struct moinfo *)&a->moif;
|
|
|
|
u8 rx_cnt = 0;
|
|
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
|
|
|
|
int i = 0;
|
|
u8 tmp_8bit = 0;
|
|
u16 tmp_16bit = 0;
|
|
u32 tmp_32bit = 0;
|
|
u64 tmp_64bit = 0;
|
|
|
|
_pkt *pskb = NULL;
|
|
|
|
struct ieee80211_radiotap_header *rtap_hdr = NULL;
|
|
u8 *ptr = NULL;
|
|
|
|
/*
|
|
radiotap length (include header 8)
|
|
11G length: 36 (0x0040002f)
|
|
11N length:
|
|
11AC length: 60 (0x0070002b)
|
|
*/
|
|
u8 hdr_buf[RTAP_HDR_MAX] = { 0 };
|
|
u16 rt_len = 8;
|
|
|
|
/* create header */
|
|
rtap_hdr = (struct ieee80211_radiotap_header *)&hdr_buf[0];
|
|
rtap_hdr->it_version = PKTHDR_RADIOTAP_VERSION;
|
|
|
|
/* each antenna information */
|
|
rx_cnt = rf_type_to_rf_rx_cnt(pHalData->rf_type);
|
|
#if 0
|
|
if (rx_cnt > 1) {
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_RADIOTAP_NAMESPACE) |
|
|
BIT(IEEE80211_RADIOTAP_EXT);
|
|
|
|
for (i = 1; i < rx_cnt; i++) {
|
|
tmp_32bit = (BIT(IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
|
|
BIT(IEEE80211_RADIOTAP_LOCK_QUALITY) |
|
|
BIT(IEEE80211_RADIOTAP_ANTENNA) |
|
|
BIT(IEEE80211_RADIOTAP_RADIOTAP_NAMESPACE) |
|
|
BIT(IEEE80211_RADIOTAP_EXT));
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_32bit, 4);
|
|
rt_len += 4;
|
|
}
|
|
|
|
tmp_32bit = (BIT(IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
|
|
BIT(IEEE80211_RADIOTAP_LOCK_QUALITY) |
|
|
BIT(IEEE80211_RADIOTAP_ANTENNA));
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_32bit, 4);
|
|
rt_len += 4;
|
|
}
|
|
#endif
|
|
|
|
/* tsft, Required Alignment: 8 bytes */
|
|
if (0) { //(a->free_cnt) {
|
|
/* TSFT + free_cnt */
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_TSFT);
|
|
if (!IS_ALIGNED(rt_len, 8))
|
|
rt_len = ((rt_len + 7) & 0xFFF8); /* Alignment */
|
|
|
|
tmp_64bit = cpu_to_le64(a->free_cnt);
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_64bit, 8);
|
|
rt_len += 8;
|
|
}
|
|
|
|
/* flags */
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_FLAGS);
|
|
_rtw_radiotap_fill_flags(a, &hdr_buf[rt_len]);
|
|
rt_len += 1;
|
|
|
|
/* rate */
|
|
if (a->data_rate <= DESC_RATE54M) {
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_RATE);
|
|
hdr_buf[rt_len] = hw_rate_to_m_rate(a->data_rate);
|
|
rt_len += 1;
|
|
}
|
|
|
|
/* channel & flags, Required Alignment: 2 bytes */
|
|
if (1) {
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_CHANNEL);
|
|
rt_len += (rt_len % 2); /* Alignment */
|
|
|
|
tmp_16bit = CHAN2FREQ(rtw_get_oper_ch(padapter));
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2);
|
|
rt_len += 2;
|
|
|
|
/* channel flags */
|
|
tmp_16bit = 0;
|
|
if (pHalData->current_band_type == 0)
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_2GHZ);
|
|
else
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_5GHZ);
|
|
|
|
if (a->data_rate <= DESC_RATE11M) {
|
|
/* CCK */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_CCK);
|
|
} else {
|
|
/* OFDM */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_OFDM);
|
|
}
|
|
|
|
if (rtw_get_oper_bw(padapter) == CHANNEL_WIDTH_10) {
|
|
/* 10Mhz Channel Width */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_HALF);
|
|
}
|
|
|
|
if (rtw_get_oper_bw(padapter) == CHANNEL_WIDTH_5) {
|
|
/* 5Mhz Channel Width */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_QUARTER);
|
|
}
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2);
|
|
rt_len += 2;
|
|
}
|
|
|
|
/* dBm Antenna Signal */
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_DBM_ANTSIGNAL);
|
|
hdr_buf[rt_len] = a->phy_info.recv_signal_power;
|
|
rt_len += 1;
|
|
|
|
#if 0
|
|
/* dBm Antenna Noise */
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_DBM_ANTNOISE);
|
|
hdr_buf[rt_len] = 0;
|
|
rt_len += 1;
|
|
#endif
|
|
#if 0
|
|
/* Signal Quality, Required Alignment: 2 bytes */
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_LOCK_QUALITY);
|
|
if (!IS_ALIGNED(rt_len, 2))
|
|
rt_len++;
|
|
hdr_buf[rt_len] = a->phy_info.signal_quality;
|
|
rt_len += 2;
|
|
|
|
#endif
|
|
|
|
#if 0
|
|
/* Antenna */
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_ANTENNA);
|
|
hdr_buf[rt_len] = 0; /* pHalData->rf_type; */
|
|
rt_len += 1;
|
|
#endif
|
|
#if 0
|
|
/* RX flags, Required Alignment: 2 bytes */
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_RX_FLAGS);
|
|
tmp_16bit = 0;
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2);
|
|
rt_len += 2;
|
|
#endif
|
|
|
|
/* MCS information, Required Alignment: 1 bytes */
|
|
if (a->data_rate >= DESC_RATEMCS0 && a->data_rate <= DESC_RATEMCS31) {
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_MCS);
|
|
/* Structure u8 known, u8 flags, u8 mcs */
|
|
|
|
/* known.bandwidth */
|
|
hdr_buf[rt_len] |= IEEE80211_RADIOTAP_MCS_HAVE_BW;
|
|
if (moif->u.snif_info.ofdm_bw)
|
|
hdr_buf[rt_len + 1] |= IEEE80211_RADIOTAP_MCS_BW_40;
|
|
if (a->bw == CHANNEL_WIDTH_40)
|
|
hdr_buf[rt_len + 1] |= IEEE80211_RADIOTAP_MCS_BW_40;
|
|
else
|
|
hdr_buf[rt_len + 1] |= IEEE80211_RADIOTAP_MCS_BW_20;
|
|
|
|
|
|
/* known.guard interval */
|
|
hdr_buf[rt_len] |= IEEE80211_RADIOTAP_MCS_HAVE_GI;
|
|
if (moif->u.snif_info.sgi) {
|
|
hdr_buf[rt_len + 1] |= IEEE80211_RADIOTAP_MCS_SGI;
|
|
} else {
|
|
hdr_buf[rt_len + 1] |= ((a->sgi & 0x01) << 2);
|
|
}
|
|
|
|
/* FEC Type */
|
|
hdr_buf[rt_len] |= IEEE80211_RADIOTAP_MCS_HAVE_FEC;
|
|
if (moif->u.snif_info.ldpc) {
|
|
hdr_buf[rt_len + 1] |= ((moif->u.snif_info.ldpc & 0x01) << 4);
|
|
} else {
|
|
hdr_buf[rt_len + 1] |= ((a->ldpc & 0x01) << 4);
|
|
}
|
|
|
|
/* STBC */
|
|
hdr_buf[rt_len] |= IEEE80211_RADIOTAP_MCS_HAVE_STBC;
|
|
if (moif->u.snif_info.stbc) {
|
|
hdr_buf[rt_len + 1] |= ((moif->u.snif_info.stbc & 0x03) << 5);
|
|
} else {
|
|
hdr_buf[rt_len + 1] |= ((a->stbc & 0x03) << 5);
|
|
}
|
|
|
|
/* known.MCS index */
|
|
hdr_buf[rt_len] |= IEEE80211_RADIOTAP_MCS_HAVE_MCS;
|
|
|
|
/* u8 mcs */
|
|
hdr_buf[rt_len + 2] = a->data_rate - DESC_RATEMCS0;
|
|
|
|
rt_len += 3;
|
|
}
|
|
|
|
/* AMPDU, Required Alignment: 4 bytes */
|
|
if (a->ampdu) {
|
|
static u32 ref_num = 0x10000000;
|
|
static u8 ppdu_cnt = 0;
|
|
|
|
/* Structure u32 reference number, u16 flags, u8 delimiter CRC value, u8 reserved */
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_AMPDU_STATUS);
|
|
if (!IS_ALIGNED(rt_len, 4))
|
|
rt_len = ((rt_len + 3) & 0xFFFC); /* Alignment */
|
|
|
|
/* u32 reference number */
|
|
if (a->ppdu_cnt != ppdu_cnt) {
|
|
ppdu_cnt = a->ppdu_cnt;
|
|
ref_num += 1;
|
|
}
|
|
tmp_32bit = cpu_to_le32(ref_num);
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_32bit, 4);
|
|
rt_len += 4;
|
|
|
|
/* u16 flags */
|
|
tmp_16bit = 0;
|
|
if (0) {
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_REPORT_ZEROLEN);
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_IS_ZEROLEN);
|
|
}
|
|
|
|
if (0) {
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_IS_LAST);
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_LAST_KNOWN);
|
|
}
|
|
|
|
if (0) {
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_DELIM_CRC_ERR);
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_DELIM_CRC_KNOWN);
|
|
}
|
|
|
|
if (a->ampdu_eof) {
|
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0))
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_EOF_KNOWN);
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_EOF);
|
|
#endif
|
|
}
|
|
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2);
|
|
rt_len += 2;
|
|
|
|
/* u8 delimiter CRC value, u8 reserved */
|
|
rt_len += 2;
|
|
}
|
|
|
|
/* VHT, Required Alignment: 2 bytes */
|
|
if (a->data_rate >= DESC_RATEVHTSS1MCS0 && a->data_rate <= DESC_RATEVHTSS4MCS9) {
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_VHT);
|
|
|
|
rt_len += (rt_len % 2); /* Alignment */
|
|
|
|
/* Structure
|
|
u16 known, u8 flags, u8 bandwidth, u8 mcs_nss[4],
|
|
u8 coding, u8 group_id, u16 partial_aid */
|
|
|
|
tmp_16bit = 0;
|
|
|
|
/* STBC */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_STBC);
|
|
if (moif->u.snif_info.stbc) {
|
|
hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_STBC;
|
|
} else {
|
|
hdr_buf[rt_len + 2] |= (a->stbc & 0x01);
|
|
}
|
|
|
|
/* TXOP_PS_NOT_ALLOWED */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_TXOP_PS_NA);
|
|
if (moif->u.snif_info.vht_txop_not_allow) {
|
|
hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_TXOP_PS_NA;
|
|
}
|
|
|
|
|
|
/* Guard interval */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_GI);
|
|
if (moif->u.snif_info.sgi) {
|
|
hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_SGI;
|
|
} else {
|
|
hdr_buf[rt_len + 2] |= ((a->sgi & 0x01) << 2);
|
|
}
|
|
|
|
/* Short GI NSYM */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_SGI_NSYM_DIS);
|
|
if (moif->u.snif_info.vht_nsym_dis) {
|
|
hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_SGI_NSYM_M10_9;
|
|
}
|
|
|
|
/* LDPC extra OFDM symbol */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_LDPC_EXTRA_OFDM_SYM);
|
|
if (moif->u.snif_info.vht_ldpc_extra) {
|
|
hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_LDPC_EXTRA_OFDM_SYM;
|
|
} else {
|
|
hdr_buf[rt_len + 2] |= ((a->ldpc & 0x01) << 4);
|
|
}
|
|
|
|
/* Short GI NSYM */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_BEAMFORMED);
|
|
if (moif->u.snif_info.vht_beamformed) {
|
|
hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_BEAMFORMED;
|
|
}
|
|
|
|
/* know.Bandwidth */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_BANDWIDTH);
|
|
|
|
/* Group ID */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_GROUP_ID);
|
|
|
|
/* Partial AID */
|
|
tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_PARTIAL_AID);
|
|
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2);
|
|
rt_len += 3;
|
|
|
|
/* u8 bandwidth */
|
|
if (moif->u.snif_info.ofdm_bw)
|
|
tmp_8bit = moif->u.snif_info.ofdm_bw;
|
|
else
|
|
tmp_8bit = a->bw;
|
|
|
|
switch (tmp_8bit) {
|
|
case CHANNEL_WIDTH_20:
|
|
hdr_buf[rt_len] |= 0;
|
|
break;
|
|
case CHANNEL_WIDTH_40:
|
|
hdr_buf[rt_len] |= 1;
|
|
break;
|
|
case CHANNEL_WIDTH_80:
|
|
hdr_buf[rt_len] |= 4;
|
|
break;
|
|
case CHANNEL_WIDTH_160:
|
|
hdr_buf[rt_len] |= 11;
|
|
break;
|
|
default:
|
|
hdr_buf[rt_len] |= 0;
|
|
}
|
|
rt_len += 1;
|
|
|
|
/* u8 mcs_nss[4] */
|
|
if ((DESC_RATEVHTSS1MCS0 <= a->data_rate) &&
|
|
(a->data_rate <= DESC_RATEVHTSS4MCS9)) {
|
|
/* User 0 */
|
|
/* MCS */
|
|
hdr_buf[rt_len] = ((a->data_rate - DESC_RATEVHTSS1MCS0) % 10) << 4;
|
|
/* NSS */
|
|
hdr_buf[rt_len] |= (((a->data_rate - DESC_RATEVHTSS1MCS0) / 10) + 1);
|
|
}
|
|
rt_len += 4;
|
|
|
|
/* u8 coding, phystat? */
|
|
hdr_buf[rt_len] = 0;
|
|
rt_len += 1;
|
|
|
|
/* u8 group_id */
|
|
hdr_buf[rt_len] = moif->u.snif_info.vht_group_id;
|
|
rt_len += 1;
|
|
|
|
/* u16 partial_aid */
|
|
tmp_16bit = cpu_to_le16(moif->u.snif_info.vht_nsts_aid);
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2);
|
|
rt_len += 2;
|
|
}
|
|
|
|
/* frame timestamp, Required Alignment: 8 bytes */
|
|
if (0) { //(a->free_cnt) {
|
|
rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_TIMESTAMP);
|
|
if (!IS_ALIGNED(rt_len, 8))
|
|
rt_len = ((rt_len + 7) & 0xFFF8); /* Alignment */
|
|
|
|
/* u64 timestamp */
|
|
tmp_64bit = cpu_to_le64(a->free_cnt);
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_64bit, 8);
|
|
rt_len += 8;
|
|
|
|
/* u16 accuracy */
|
|
tmp_16bit = cpu_to_le16(22);
|
|
_rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2);
|
|
rt_len += 2;
|
|
|
|
/* u8 unit/position */
|
|
hdr_buf[rt_len] |= IEEE80211_RADIOTAP_TIMESTAMP_UNIT_US;
|
|
rt_len += 1;
|
|
|
|
/* u8 flags */
|
|
hdr_buf[rt_len] |= IEEE80211_RADIOTAP_TIMESTAMP_FLAG_32BIT;
|
|
hdr_buf[rt_len] |= IEEE80211_RADIOTAP_TIMESTAMP_FLAG_ACCURACY;
|
|
rt_len += 1;
|
|
}
|
|
|
|
/* each antenna information */
|
|
#if 0
|
|
if (rx_cnt > 1) {
|
|
for (i = 0; i <= rx_cnt; i++) {
|
|
/* dBm Antenna Signal */
|
|
hdr_buf[rt_len] = a->phy_info.rx_mimo_signal_strength[i];
|
|
rt_len += 1;
|
|
|
|
/* Signal Quality */
|
|
if (!IS_ALIGNED(rt_len, 2))
|
|
rt_len++;
|
|
hdr_buf[rt_len] = cpu_to_le16(a->phy_info.rx_mimo_signal_quality[i]);
|
|
rt_len += 2;
|
|
|
|
/* Antenna */
|
|
hdr_buf[rt_len] = i; /* pHalData->rf_type; */
|
|
rt_len += 1;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/* push to skb */
|
|
pskb = (_pkt *)buf;
|
|
if (skb_headroom(pskb) < rt_len) {
|
|
RTW_INFO("%s:%d %s headroom is too small.\n", __FILE__, __LINE__, __func__);
|
|
ret = _FAIL;
|
|
return ret;
|
|
}
|
|
|
|
ptr = skb_push(pskb, rt_len);
|
|
if (ptr) {
|
|
rtap_hdr->it_len = cpu_to_le16(rt_len);
|
|
rtap_hdr->it_present = cpu_to_le32(rtap_hdr->it_present);
|
|
memcpy(ptr, rtap_hdr, rt_len);
|
|
} else
|
|
ret = _FAIL;
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
void rx_query_moinfo(struct rx_pkt_attrib *a, u8 *desc)
|
|
{
|
|
switch (a->drvinfo_sz) {
|
|
case 40:
|
|
_rtw_memcpy(a->moif, &desc[32], 8);
|
|
break;
|
|
case 48:
|
|
_rtw_memcpy(a->moif, &desc[32], 12);
|
|
break;
|
|
case 32:
|
|
/* passthrough */
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
#endif /* CONFIG_WIFI_MONITOR */
|