2023-04-14-fix-wifi6/wifi6+

debian/changelog

@@ -1,3 +1,9 @@
+wpa (2:2.10-ok1.2) yangtze; urgency=medium
+
+  * wifi6/wifi6+
+
+ -- wudan <wudan@kylinos.cn>  Fri, 14 Apr 2023 17:54:03 +0800
+ 
 wpa (2:2.10-ok1.1) yangtze; urgency=medium
 
   * 触发CI平台

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;
 }

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,

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,

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)
 {

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);