From d649c09d4ebc0ff6058f3e5f1a31029f217e9641 Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?=E6=AD=A6=E4=B8=B9?= Date: Fri, 14 Apr 2023 17:54:55 +0800 Subject: [PATCH] 2023-04-14-fix-wifi6/wifi6+ --- debian/changelog | 6 + wpa_supplicant/bss.c | 159 +++++++++++++++++++++++- wpa_supplicant/bss.h | 17 ++- wpa_supplicant/dbus/dbus_new.c | 12 ++ wpa_supplicant/dbus/dbus_new_handlers.c | 17 +++ wpa_supplicant/dbus/dbus_new_handlers.h | 1 + 6 files changed, 209 insertions(+), 3 deletions(-) diff --git a/debian/changelog b/debian/changelog index e394131..30544b4 100644 --- a/debian/changelog +++ b/debian/changelog @@ -1,3 +1,9 @@ +wpa (2:2.10-ok1.2) yangtze; urgency=medium + + * wifi6/wifi6+ + + -- wudan Fri, 14 Apr 2023 17:54:03 +0800 + wpa (2:2.10-ok1.1) yangtze; urgency=medium * 触发CI平台 diff --git a/wpa_supplicant/bss.c b/wpa_supplicant/bss.c index e13783c..defd2ab 100644 --- a/wpa_supplicant/bss.c +++ b/wpa_supplicant/bss.c @@ -297,7 +297,162 @@ static void wpa_bss_copy_res(struct wpa_bss *dst, struct wpa_scan_res *src, calculate_update_time(fetch_time, src->age, &dst->last_update); } +static u8 wpa_bss_get_160m_support_capability(struct wpa_bss *bss) +{ + const u8 *ie; + unsigned int channelWidth = 0; + unsigned int channelCenterSegment0 = 0; + unsigned int channelCenterSegment1 = 0; + /*find the VHT operation information */ + ie = wpa_bss_get_ie(bss, WLAN_EID_VHT_OPERATION); + if (ie == NULL || (ie[1] <= WIFI6WIFI6PLUS_VHT_CHANNEL_CENTER_SEGMENT1_INDEX)) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: NOT found VHT tag for SSID %s "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return WIFI6WIFI6PLUS_NOT_SUPPORTED; + } + + /*if the channel width equals 160MHZ, this AP has wifi6+ capability.*/ + channelWidth = ie[WIFI6WIFI6PLUS_HT_PRIMARY_CHANNEL_INDEX + 2]; + if (channelWidth == CHANWIDTH_160MHZ) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: 160MHZ supported(160MHZ) for SSID %s "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return WIFI6WIFI6PLUS_SUPPORTED; + } + + /*if Not, */ + channelCenterSegment0 = ie[WIFI6WIFI6PLUS_VHT_CHANNEL_CENTER_SEGMENT0_INDEX + 2]; + channelCenterSegment1 = ie[WIFI6WIFI6PLUS_VHT_CHANNEL_CENTER_SEGMENT1_INDEX + 2]; + wpa_printf(MSG_DEBUG, "wifi6wifi6+: SSID %s channelCenterSegment0:%d channelCenterSegment1:%d "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), channelCenterSegment0, channelCenterSegment1, MAC2STR(bss->bssid)); + if ((channelWidth == CHANWIDTH_80MHZ ) && channelCenterSegment0 && channelCenterSegment1 + && abs(channelCenterSegment1 - channelCenterSegment0) == 8) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: 160MHZ supported for SSID %s "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return WIFI6WIFI6PLUS_SUPPORTED; + } + + wpa_printf(MSG_DEBUG, "wifi6wifi6+: 160MHZ NOT supported for SSID %s "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return WIFI6WIFI6PLUS_NOT_SUPPORTED; +} +static u8 wpa_bss_get_narrowband_capability(struct wpa_bss *bss) +{ + const u8 *ie; + u8 index; + u8 bcc_id_header[9] = {0, 0xE0, 0xFC, 0x40, 0, 0, 0, 0x01, 0}; + unsigned int len = 0; + + /*To fetch vendor specific IE*/ + ie = wpa_bss_get_vendor_ie_content(bss, HW_IE_VENDOR_TYPE); + if (ie == NULL || (ie[1] <= sizeof(bcc_id_header))) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: vendor specific IE error1 for SSID %s "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return WIFI6WIFI6PLUS_NOT_SUPPORTED; + } + + /*To match the BCC ID head.*/ + for (index = 0; index < sizeof(bcc_id_header); index++) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: SSID %s ie[%d]:%d bcc_id_header:%d "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), index+2,ie[index+2],bcc_id_header[index], MAC2STR(bss->bssid)); + if ( ie[index + 2] != bcc_id_header[index]) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: bcc_id_header not match error SSID %s "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return WIFI6WIFI6PLUS_NOT_SUPPORTED; + } + } + + /*To find the narrowband sub ie entry, if successful, then to find the narrowband capability field and check its value.*/ + index = WIFI6WIFI6PLUS_TYPE_NARROWBAND_SUBIE_INDEX; + while (ie[1] > ie[index + 1] ) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: to match NB SUBIE for SSID %s ie[%d]:%d "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), index, ie[index], MAC2STR(bss->bssid)); + if (ie[index] == WIFI6WIFI6PLUS_TYPE_NARROWBAND_SUBIE) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: NB SUBIE FOUND SSID %s "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + len = ie[index + 1]; + index += len - WIFI6WIFI6PLUS_NARROWBAND_OFFSET; + if (index >= ie[1] ) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: Index ERROR SSID %s "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return WIFI6WIFI6PLUS_NOT_SUPPORTED; + } + + if (WIFI6WIFI6PLUS_NARROWBAND_CAPABILITY == (ie[index] & WIFI6WIFI6PLUS_NARROWBAND_CAPABILITY)) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: narrowband supported for SSID %s "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return WIFI6WIFI6PLUS_SUPPORTED; + } + } + len = ie[index + 1]; + index += len + 2; + } + + wpa_printf(MSG_DEBUG, "wifi6wifi6+: NB SUBIE NOT FOUND SSID %s ie[%d]:%d "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), index, ie[index], MAC2STR(bss->bssid)); + return WIFI6WIFI6PLUS_NOT_SUPPORTED; +} +static u8 wpa_bss_get_wifi6_capability(struct wpa_bss *bss) +{ + const u8 *ie; + + /*Whether this ap has wifi6 capability or not*/ + ie = get_ie_ext((u8 *) (bss + 1), bss->ie_len, WLAN_EID_EXT_HE_CAPABILITIES); + if (ie) { + return WIFI6WIFI6PLUS_SUPPORTED; + } + return WIFI6WIFI6PLUS_NOT_SUPPORTED; +} + +static void wpa_bss_get_wifi_category(struct wpa_bss *bss) +{ + u8 isWifi6Supported = 0; + u8 is160mBandSupported = 0; + u8 isNarrowbandSupported = 0; + + wpa_printf(MSG_DEBUG, "\r\n--------wifi6wifi6+ detect starting for SSID %s--------"MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + /*Whether this ap has wifi6 capability or not*/ + isWifi6Supported = wpa_bss_get_wifi6_capability(bss); + if (!isWifi6Supported){ + wpa_printf(MSG_DEBUG, "wifi6wifi6+: Wifi6 Not Supported %d SSID %s "MACSTR, + isWifi6Supported, wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + bss->category = WIFI6WIFI6PLUS_WIFI_CAPABILITY_DEFAULT; + wpa_printf(MSG_DEBUG, "--------wifi6wifi6+ detect finished for SSID %s--------"MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return; + } + + /*Whether this ap has wifi6 configure capability or not*/ + is160mBandSupported = wpa_bss_get_160m_support_capability(bss); + + if (is160mBandSupported){ + wpa_printf(MSG_DEBUG, "wifi6wifi6+: Wifi6 + Supported %d SSID %s "MACSTR, + is160mBandSupported, wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + bss->category = WIFI6WIFI6PLUS_WIFI_CATEGORY_WIFI6_PLUS; + wpa_printf(MSG_DEBUG, "--------wifi6wifi6+ detect finished for SSID %s--------"MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return; + } + + /*Whether this ap has narrowband capability or not*/ + isNarrowbandSupported = wpa_bss_get_narrowband_capability(bss); + + /*at last updating category result to bss entry according to the above results.*/ + if (isNarrowbandSupported) { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: Wifi6 + Supported %d SSID %s "MACSTR, + isNarrowbandSupported, wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + bss->category = WIFI6WIFI6PLUS_WIFI_CATEGORY_WIFI6_PLUS; + } + else { + wpa_printf(MSG_DEBUG, "wifi6wifi6+: Wifi6 Supported %d SSID %s "MACSTR, + isWifi6Supported, wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + bss->category = WIFI6WIFI6PLUS_WIFI_CATEGORY_WIFI6; + } + wpa_printf(MSG_DEBUG, "--------wifi6wifi6+ detect finished for SSID %s-------- "MACSTR, + wpa_ssid_txt(bss->ssid, bss->ssid_len), MAC2STR(bss->bssid)); + return; +} static int wpa_bss_is_wps_candidate(struct wpa_supplicant *wpa_s, struct wpa_bss *bss) { @@ -472,9 +627,9 @@ static struct wpa_bss * wpa_bss_add(struct wpa_supplicant *wpa_s, else extra[0] = '\0'; wpa_dbg(wpa_s, MSG_DEBUG, "BSS: Add new id %u BSSID " MACSTR - " SSID '%s' freq %d%s", + " SSID '%s' freq %d category %d %s", bss->id, MAC2STR(bss->bssid), wpa_ssid_txt(ssid, ssid_len), - bss->freq, extra); + bss->freq, bss->category, extra); wpas_notify_bss_added(wpa_s, bss->bssid, bss->id); return bss; } diff --git a/wpa_supplicant/bss.h b/wpa_supplicant/bss.h index 4078b9b..1112b22 100644 --- a/wpa_supplicant/bss.h +++ b/wpa_supplicant/bss.h @@ -19,7 +19,19 @@ struct wpa_scan_res; #define WPA_BSS_ASSOCIATED BIT(5) #define WPA_BSS_ANQP_FETCH_TRIED BIT(6) #define WPA_BSS_OWE_TRANSITION BIT(7) - +#define WIFI6WIFI6PLUS_NARROWBAND_CAPABILITY 0x20 +#define WIFI6WIFI6PLUS_HT_PRIMARY_CHANNEL_INDEX 0 +#define WIFI6WIFI6PLUS_VHT_CHANNEL_CENTER_SEGMENT0_INDEX 1 +#define WIFI6WIFI6PLUS_VHT_CHANNEL_CENTER_SEGMENT1_INDEX 2 +#define WIFI6WIFI6PLUS_WIFI_CAPABILITY_DEFAULT 0 +#define WIFI6WIFI6PLUS_WIFI_CATEGORY_WIFI6 1 +#define WIFI6WIFI6PLUS_WIFI_CATEGORY_WIFI6_PLUS 2 +#define WIFI6WIFI6PLUS_SUPPORTED 1 +#define WIFI6WIFI6PLUS_NOT_SUPPORTED 0 +#define WIFI6WIFI6PLUS_NARROWBAND_OFFSET 1 +#define WIFI6WIFI6PLUS_TYPE_NARROWBAND_SUBIE 0xFD +#define WIFI6WIFI6PLUS_TYPE_NARROWBAND_SUBIE_INDEX 0x0B +#define HW_IE_VENDOR_TYPE 0x00E0FC40 #define WPA_BSS_FREQ_CHANGED_FLAG BIT(0) #define WPA_BSS_SIGNAL_CHANGED_FLAG BIT(1) #define WPA_BSS_PRIVACY_CHANGED_FLAG BIT(2) @@ -114,6 +126,8 @@ struct wpa_bss { unsigned int est_throughput; /** Signal-to-noise ratio in dB */ int snr; + /*indicating wifi category(0 means common ap, 1 means wifi6, 2 means wifi6+ )*/ + int category; /** ANQP data */ struct wpa_bss_anqp *anqp; /** Length of the following IE field in octets (from Probe Response) */ @@ -158,6 +172,7 @@ struct wpa_bss * wpa_bss_get_id_range(struct wpa_supplicant *wpa_s, const u8 * wpa_bss_get_ie(const struct wpa_bss *bss, u8 ie); const u8 * wpa_bss_get_ie_ext(const struct wpa_bss *bss, u8 ext); const u8 * wpa_bss_get_vendor_ie(const struct wpa_bss *bss, u32 vendor_type); +const u8 * wpa_bss_get_vendor_ie_content(const struct wpa_bss *bss, u32 vendor_type); const u8 * wpa_bss_get_vendor_ie_beacon(const struct wpa_bss *bss, u32 vendor_type); struct wpabuf * wpa_bss_get_vendor_ie_multi(const struct wpa_bss *bss, diff --git a/wpa_supplicant/dbus/dbus_new.c b/wpa_supplicant/dbus/dbus_new.c index 9279ae4..30d347a 100644 --- a/wpa_supplicant/dbus/dbus_new.c +++ b/wpa_supplicant/dbus/dbus_new.c @@ -2913,6 +2913,11 @@ static const struct wpa_dbus_property_desc wpas_dbus_bss_properties[] = { NULL, NULL }, + { "Category", WPAS_DBUS_NEW_IFACE_BSS, "q", + wpas_dbus_getter_bss_category, + NULL, + NULL + }, { "Frequency", WPAS_DBUS_NEW_IFACE_BSS, "q", wpas_dbus_getter_bss_frequency, NULL, @@ -3567,6 +3572,13 @@ static const struct wpa_dbus_method_desc wpas_dbus_interface_methods[] = { END_ARGS } }, + { "GetChannelFreq", WPAS_DBUS_NEW_IFACE_INTERFACE, + (WPADBusMethodHandler) wpas_dbus_handler_get_channel_freq, + { + { "freq", "s", ARG_OUT }, + END_ARGS + } + }, #ifdef CONFIG_AUTOSCAN { "AutoScan", WPAS_DBUS_NEW_IFACE_INTERFACE, (WPADBusMethodHandler) wpas_dbus_handler_autoscan, diff --git a/wpa_supplicant/dbus/dbus_new_handlers.c b/wpa_supplicant/dbus/dbus_new_handlers.c index 959a68b..2a11312 100644 --- a/wpa_supplicant/dbus/dbus_new_handlers.c +++ b/wpa_supplicant/dbus/dbus_new_handlers.c @@ -5028,6 +5028,23 @@ dbus_bool_t wpas_dbus_getter_bss_frequency( &freq, error); } +dbus_bool_t wpas_dbus_getter_bss_category( + const struct wpa_dbus_property_desc *property_desc, + DBusMessageIter *iter, DBusError *error, void *user_data) +{ + struct bss_handler_args *args = user_data; + struct wpa_bss *res; + u16 category; + + res = get_bss_helper(args, error, __func__); + if (!res) + return FALSE; + wpa_printf(MSG_DEBUG,"wpas_dbus_getter_bss_category res->category=%s",res->category); + category = (u16) res->category; + wpa_printf(MSG_DEBUG,"wpas_dbus_getter_bss_category category=%s",category); + return wpas_dbus_simple_property_getter(iter, DBUS_TYPE_UINT16, + &category, error); +} static int cmp_u8s_desc(const void *a, const void *b) { diff --git a/wpa_supplicant/dbus/dbus_new_handlers.h b/wpa_supplicant/dbus/dbus_new_handlers.h index a421083..a99b183 100644 --- a/wpa_supplicant/dbus/dbus_new_handlers.h +++ b/wpa_supplicant/dbus/dbus_new_handlers.h @@ -209,6 +209,7 @@ DECLARE_ACCESSOR(wpas_dbus_getter_bss_privacy); DECLARE_ACCESSOR(wpas_dbus_getter_bss_mode); DECLARE_ACCESSOR(wpas_dbus_getter_bss_signal); DECLARE_ACCESSOR(wpas_dbus_getter_bss_frequency); +DECLARE_ACCESSOR(wpas_dbus_getter_bss_category); DECLARE_ACCESSOR(wpas_dbus_getter_bss_rates); DECLARE_ACCESSOR(wpas_dbus_getter_bss_wpa); DECLARE_ACCESSOR(wpas_dbus_getter_bss_rsn);