[PATCH 1/2] wiphy: parse TX/RX frame types, and API to check auth frame support

[James Prestwood <prestwoj@gmail.com>]

Drivers have been identified that do not support authentication via
CMD_FRAME. This prevents FT from succeeding but since there is no
way to check this in IWD station cannot handle it gracefully.

Now IWD can parse the TX/RX frame types and check if authentication
is supported and plan the type of roam according to what protocol
will work correctly.
---
 src/wiphy.c | 54 +++++++++++++++++++++++++++++++++++++++++++++++++++++
 src/wiphy.h |  1 +
 2 files changed, 55 insertions(+)

diff --git a/src/wiphy.c b/src/wiphy.c
index 06f72ef2..cc0e6dd7 100644
--- a/src/wiphy.c
+++ b/src/wiphy.c
@@ -150,6 +150,8 @@ struct wiphy {
 	bool ap_probe_resp_offload : 1;
 	bool supports_uapsd : 1;
 	bool supports_cmd_offchannel : 1;
+	/* Bit 0 for TX, Bit 1 for RX */
+	uint8_t supports_auth_frame : 2;
 };
 
 static struct l_queue *wiphy_list = NULL;
@@ -938,6 +940,11 @@ bool wiphy_supports_cmd_offchannel(const struct wiphy *wiphy)
 	return wiphy->supports_cmd_offchannel;
 }
 
+bool wiphy_supports_auth_frame(const struct wiphy *wiphy)
+{
+	return wiphy->supports_auth_frame == 0x03;
+}
+
 const uint8_t *wiphy_get_ht_capabilities(const struct wiphy *wiphy,
 						enum band_freq band,
 						size_t *size)
@@ -1816,6 +1823,45 @@ static void parse_iftype_extended_capabilities(struct wiphy *wiphy,
 	}
 }
 
+static void wiphy_parse_frame_types(struct wiphy *wiphy,
+					struct l_genl_attr *attr, bool tx)
+{
+	uint16_t type, len;
+	const void *data;
+
+	while (l_genl_attr_next(attr, NULL, NULL, NULL)) {
+		struct l_genl_attr types;
+
+		if (!l_genl_attr_recurse(attr, &types))
+			continue;
+
+		while (l_genl_attr_next(&types, &type, &len, &data)) {
+			uint16_t frame_type;
+
+			if (L_WARN_ON(type != NL80211_ATTR_FRAME_TYPE))
+				continue;
+
+			if (L_WARN_ON(len != 2))
+				continue;
+
+			frame_type = l_get_le16(data);
+
+			switch (frame_type) {
+			/* Authentication */
+			case 0x00b0:
+				if (tx)
+					wiphy->supports_auth_frame |= 0x01;
+				else
+					wiphy->supports_auth_frame |= 0x02;
+				break;
+			default:
+				break;
+			}
+
+		}
+	}
+}
+
 static void wiphy_parse_attributes(struct wiphy *wiphy,
 					struct l_genl_msg *msg)
 {
@@ -1903,6 +1949,14 @@ static void wiphy_parse_attributes(struct wiphy *wiphy,
 		case NL80211_ATTR_SUPPORT_AP_UAPSD:
 			wiphy->supports_uapsd = true;
 			break;
+		case NL80211_ATTR_TX_FRAME_TYPES:
+			if (l_genl_attr_recurse(&attr, &nested))
+				wiphy_parse_frame_types(wiphy, &nested, true);
+			break;
+		case NL80211_ATTR_RX_FRAME_TYPES:
+			if (l_genl_attr_recurse(&attr, &nested))
+				wiphy_parse_frame_types(wiphy, &nested, false);
+			break;
 		}
 	}
 }
diff --git a/src/wiphy.h b/src/wiphy.h
index 17e53075..fe7e9e49 100644
--- a/src/wiphy.h
+++ b/src/wiphy.h
@@ -142,6 +142,7 @@ void wiphy_get_reg_domain_country(struct wiphy *wiphy, char *out);
 bool wiphy_country_is_unknown(struct wiphy *wiphy);
 bool wiphy_supports_uapsd(const struct wiphy *wiphy);
 bool wiphy_supports_cmd_offchannel(const struct wiphy *wiphy);
+bool wiphy_supports_auth_frame(const struct wiphy *wiphy);
 
 const uint8_t *wiphy_get_ht_capabilities(const struct wiphy *wiphy,
 						enum band_freq band,
-- 
2.34.1