Home | History | Annotate | Download | only in wpa_supplicant
      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 
     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 
     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 
     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 		wpa_bss_anqp_unshare_alloc(bss);
     84 		freq = bss->freq;
     85 	}
     86 	if (freq <= 0)
     87 		return -1;
     88 
     89 	wpa_printf(MSG_DEBUG, "HS20: ANQP Query Request to " MACSTR " for "
     90 		   "subtypes 0x%x", MAC2STR(dst), stypes);
     91 
     92 	buf = hs20_build_anqp_req(stypes, payload, payload_len);
     93 	if (buf == NULL)
     94 		return -1;
     95 
     96 	res = gas_query_req(wpa_s->gas, dst, freq, buf, anqp_resp_cb, wpa_s);
     97 	if (res < 0) {
     98 		wpa_printf(MSG_DEBUG, "ANQP: Failed to send Query Request");
     99 		ret = -1;
    100 	} else
    101 		wpa_printf(MSG_DEBUG, "ANQP: Query started with dialog token "
    102 			   "%u", res);
    103 
    104 	wpabuf_free(buf);
    105 	return ret;
    106 }
    107 
    108 
    109 void hs20_parse_rx_hs20_anqp_resp(struct wpa_supplicant *wpa_s,
    110 				  const u8 *sa, const u8 *data, size_t slen)
    111 {
    112 	const u8 *pos = data;
    113 	u8 subtype;
    114 	struct wpa_bss *bss = wpa_bss_get_bssid(wpa_s, sa);
    115 	struct wpa_bss_anqp *anqp = NULL;
    116 
    117 	if (slen < 2)
    118 		return;
    119 
    120 	if (bss)
    121 		anqp = bss->anqp;
    122 
    123 	subtype = *pos++;
    124 	slen--;
    125 
    126 	pos++; /* Reserved */
    127 	slen--;
    128 
    129 	switch (subtype) {
    130 	case HS20_STYPE_CAPABILITY_LIST:
    131 		wpa_msg(wpa_s, MSG_INFO, "RX-HS20-ANQP " MACSTR
    132 			" HS Capability List", MAC2STR(sa));
    133 		wpa_hexdump_ascii(MSG_DEBUG, "HS Capability List", pos, slen);
    134 		break;
    135 	case HS20_STYPE_OPERATOR_FRIENDLY_NAME:
    136 		wpa_msg(wpa_s, MSG_INFO, "RX-HS20-ANQP " MACSTR
    137 			" Operator Friendly Name", MAC2STR(sa));
    138 		wpa_hexdump_ascii(MSG_DEBUG, "oper friendly name", pos, slen);
    139 		if (anqp) {
    140 			wpabuf_free(anqp->hs20_operator_friendly_name);
    141 			anqp->hs20_operator_friendly_name =
    142 				wpabuf_alloc_copy(pos, slen);
    143 		}
    144 		break;
    145 	case HS20_STYPE_WAN_METRICS:
    146 		wpa_hexdump(MSG_DEBUG, "WAN Metrics", pos, slen);
    147 		if (slen < 13) {
    148 			wpa_dbg(wpa_s, MSG_DEBUG, "HS 2.0: Too short WAN "
    149 				"Metrics value from " MACSTR, MAC2STR(sa));
    150 			break;
    151 		}
    152 		wpa_msg(wpa_s, MSG_INFO, "RX-HS20-ANQP " MACSTR
    153 			" WAN Metrics %02x:%u:%u:%u:%u:%u", MAC2STR(sa),
    154 			pos[0], WPA_GET_LE32(pos + 1), WPA_GET_LE32(pos + 5),
    155 			pos[9], pos[10], WPA_GET_LE16(pos + 11));
    156 		if (anqp) {
    157 			wpabuf_free(anqp->hs20_wan_metrics);
    158 			anqp->hs20_wan_metrics = wpabuf_alloc_copy(pos, slen);
    159 		}
    160 		break;
    161 	case HS20_STYPE_CONNECTION_CAPABILITY:
    162 		wpa_msg(wpa_s, MSG_INFO, "RX-HS20-ANQP " MACSTR
    163 			" Connection Capability", MAC2STR(sa));
    164 		wpa_hexdump_ascii(MSG_DEBUG, "conn capability", pos, slen);
    165 		if (anqp) {
    166 			wpabuf_free(anqp->hs20_connection_capability);
    167 			anqp->hs20_connection_capability =
    168 				wpabuf_alloc_copy(pos, slen);
    169 		}
    170 		break;
    171 	case HS20_STYPE_OPERATING_CLASS:
    172 		wpa_msg(wpa_s, MSG_INFO, "RX-HS20-ANQP " MACSTR
    173 			" Operating Class", MAC2STR(sa));
    174 		wpa_hexdump_ascii(MSG_DEBUG, "Operating Class", pos, slen);
    175 		if (anqp) {
    176 			wpabuf_free(anqp->hs20_operating_class);
    177 			anqp->hs20_operating_class =
    178 				wpabuf_alloc_copy(pos, slen);
    179 		}
    180 		break;
    181 	default:
    182 		wpa_printf(MSG_DEBUG, "HS20: Unsupported subtype %u", subtype);
    183 		break;
    184 	}
    185 }
    186