contrib/wpa/wpa_supplicant/hs20_supplicant.c

   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 }