hs20_supplicant.c 4.7 KB

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