1 /*
2 * Copyright (c) 2009, Atheros Communications, Inc.
3 * Copyright (c) 2011-2012, Qualcomm Atheros, Inc.
4 *
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
7 */
8
9 #include "includes.h"
10
11 #include "common.h"
12 #include "eloop.h"
13 #include "common/ieee802_11_common.h"
14 #include "common/ieee802_11_defs.h"
15 #include "common/gas.h"
16 #include "common/wpa_ctrl.h"
17 #include "wpa_supplicant_i.h"
18 #include "driver_i.h"
19 #include "config.h"
20 #include "bss.h"
21 #include "gas_query.h"
22 #include "interworking.h"
23 #include "hs20_supplicant.h"
24
25
wpas_hs20_add_indication(struct wpabuf * buf)26 void wpas_hs20_add_indication(struct wpabuf *buf)
27 {
28 wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC);
29 wpabuf_put_u8(buf, 5);
30 wpabuf_put_be24(buf, OUI_WFA);
31 wpabuf_put_u8(buf, HS20_INDICATION_OUI_TYPE);
32 wpabuf_put_u8(buf, 0x00); /* Hotspot Configuration */
33 }
34
35
hs20_build_anqp_req(u32 stypes,const u8 * payload,size_t payload_len)36 struct wpabuf * hs20_build_anqp_req(u32 stypes, const u8 *payload,
37 size_t payload_len)
38 {
39 struct wpabuf *buf;
40 u8 *len_pos;
41
42 buf = gas_anqp_build_initial_req(0, 100 + payload_len);
43 if (buf == NULL)
44 return NULL;
45
46 len_pos = gas_anqp_add_element(buf, ANQP_VENDOR_SPECIFIC);
47 wpabuf_put_be24(buf, OUI_WFA);
48 wpabuf_put_u8(buf, HS20_ANQP_OUI_TYPE);
49 if (stypes == BIT(HS20_STYPE_NAI_HOME_REALM_QUERY)) {
50 wpabuf_put_u8(buf, HS20_STYPE_NAI_HOME_REALM_QUERY);
51 wpabuf_put_u8(buf, 0); /* Reserved */
52 if (payload)
53 wpabuf_put_data(buf, payload, payload_len);
54 } else {
55 u8 i;
56 wpabuf_put_u8(buf, HS20_STYPE_QUERY_LIST);
57 wpabuf_put_u8(buf, 0); /* Reserved */
58 for (i = 0; i < 32; i++) {
59 if (stypes & BIT(i))
60 wpabuf_put_u8(buf, i);
61 }
62 }
63 gas_anqp_set_element_len(buf, len_pos);
64
65 gas_anqp_set_len(buf);
66
67 return buf;
68 }
69
70
hs20_anqp_send_req(struct wpa_supplicant * wpa_s,const u8 * dst,u32 stypes,const u8 * payload,size_t payload_len)71 int hs20_anqp_send_req(struct wpa_supplicant *wpa_s, const u8 *dst, u32 stypes,
72 const u8 *payload, size_t payload_len)
73 {
74 struct wpabuf *buf;
75 int ret = 0;
76 int freq;
77 struct wpa_bss *bss;
78 int res;
79
80 freq = wpa_s->assoc_freq;
81 bss = wpa_bss_get_bssid(wpa_s, dst);
82 if (bss)
83 freq = bss->freq;
84 if (freq <= 0)
85 return -1;
86
87 wpa_printf(MSG_DEBUG, "HS20: ANQP Query Request to " MACSTR " for "
88 "subtypes 0x%x", MAC2STR(dst), stypes);
89
90 buf = hs20_build_anqp_req(stypes, payload, payload_len);
91 if (buf == NULL)
92 return -1;
93
94 res = gas_query_req(wpa_s->gas, dst, freq, buf, anqp_resp_cb, wpa_s);
95 if (res < 0) {
96 wpa_printf(MSG_DEBUG, "ANQP: Failed to send Query Request");
97 ret = -1;
98 } else
99 wpa_printf(MSG_DEBUG, "ANQP: Query started with dialog token "
100 "%u", res);
101
102 wpabuf_free(buf);
103 return ret;
104 }
105
106
hs20_parse_rx_hs20_anqp_resp(struct wpa_supplicant * wpa_s,const u8 * sa,const u8 * data,size_t slen)107 void hs20_parse_rx_hs20_anqp_resp(struct wpa_supplicant *wpa_s,
108 const u8 *sa, const u8 *data, size_t slen)
109 {
110 const u8 *pos = data;
111 u8 subtype;
112 struct wpa_bss *bss = wpa_bss_get_bssid(wpa_s, sa);
113 struct wpa_bss_anqp *anqp = NULL;
114
115 if (slen < 2)
116 return;
117
118 if (bss)
119 anqp = bss->anqp;
120
121 subtype = *pos++;
122 slen--;
123
124 pos++; /* Reserved */
125 slen--;
126
127 switch (subtype) {
128 case HS20_STYPE_CAPABILITY_LIST:
129 wpa_msg(wpa_s, MSG_INFO, "RX-HS20-ANQP " MACSTR
130 " HS Capability List", MAC2STR(sa));
131 wpa_hexdump_ascii(MSG_DEBUG, "HS Capability List", pos, slen);
132 break;
133 case HS20_STYPE_OPERATOR_FRIENDLY_NAME:
134 wpa_msg(wpa_s, MSG_INFO, "RX-HS20-ANQP " MACSTR
135 " Operator Friendly Name", MAC2STR(sa));
136 wpa_hexdump_ascii(MSG_DEBUG, "oper friendly name", pos, slen);
137 if (anqp) {
138 wpabuf_free(anqp->hs20_operator_friendly_name);
139 anqp->hs20_operator_friendly_name =
140 wpabuf_alloc_copy(pos, slen);
141 }
142 break;
143 case HS20_STYPE_WAN_METRICS:
144 wpa_msg(wpa_s, MSG_INFO, "RX-HS20-ANQP " MACSTR
145 " WAN Metrics", MAC2STR(sa));
146 wpa_hexdump_ascii(MSG_DEBUG, "WAN Metrics", pos, slen);
147 if (anqp) {
148 wpabuf_free(anqp->hs20_wan_metrics);
149 anqp->hs20_wan_metrics = wpabuf_alloc_copy(pos, slen);
150 }
151 break;
152 case HS20_STYPE_CONNECTION_CAPABILITY:
153 wpa_msg(wpa_s, MSG_INFO, "RX-HS20-ANQP " MACSTR
154 " Connection Capability", MAC2STR(sa));
155 wpa_hexdump_ascii(MSG_DEBUG, "conn capability", pos, slen);
156 if (anqp) {
157 wpabuf_free(anqp->hs20_connection_capability);
158 anqp->hs20_connection_capability =
159 wpabuf_alloc_copy(pos, slen);
160 }
161 break;
162 case HS20_STYPE_OPERATING_CLASS:
163 wpa_msg(wpa_s, MSG_INFO, "RX-HS20-ANQP " MACSTR
164 " Operating Class", MAC2STR(sa));
165 wpa_hexdump_ascii(MSG_DEBUG, "Operating Class", pos, slen);
166 if (anqp) {
167 wpabuf_free(anqp->hs20_operating_class);
168 anqp->hs20_operating_class =
169 wpabuf_alloc_copy(pos, slen);
170 }
171 break;
172 default:
173 wpa_printf(MSG_DEBUG, "HS20: Unsupported subtype %u", subtype);
174 break;
175 }
176 }
177