bss.c 8.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303
  1. /*
  2. * BSS list
  3. * Copyright (c) 2010, Jouni Malinen <j@w1.fi>
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License version 2 as
  7. * published by the Free Software Foundation.
  8. *
  9. * Alternatively, this software may be distributed under the terms of BSD
  10. * license.
  11. *
  12. * See README and COPYING for more details.
  13. */
  14. #include "utils/includes.h"
  15. #include "utils/common.h"
  16. #include "common/defs.h"
  17. #include "common/ieee802_11_defs.h"
  18. #include "common/ieee802_11_common.h"
  19. #include "crypto/sha1.h"
  20. #include "wlantest.h"
  21. struct wlantest_bss * bss_find(struct wlantest *wt, const u8 *bssid)
  22. {
  23. struct wlantest_bss *bss;
  24. dl_list_for_each(bss, &wt->bss, struct wlantest_bss, list) {
  25. if (os_memcmp(bss->bssid, bssid, ETH_ALEN) == 0)
  26. return bss;
  27. }
  28. return NULL;
  29. }
  30. struct wlantest_bss * bss_get(struct wlantest *wt, const u8 *bssid)
  31. {
  32. struct wlantest_bss *bss;
  33. if (bssid[0] & 0x01)
  34. return NULL; /* Skip group addressed frames */
  35. bss = bss_find(wt, bssid);
  36. if (bss)
  37. return bss;
  38. bss = os_zalloc(sizeof(*bss));
  39. if (bss == NULL)
  40. return NULL;
  41. dl_list_init(&bss->sta);
  42. dl_list_init(&bss->pmk);
  43. dl_list_init(&bss->tdls);
  44. os_memcpy(bss->bssid, bssid, ETH_ALEN);
  45. dl_list_add(&wt->bss, &bss->list);
  46. wpa_printf(MSG_DEBUG, "Discovered new BSS - " MACSTR,
  47. MAC2STR(bss->bssid));
  48. return bss;
  49. }
  50. void pmk_deinit(struct wlantest_pmk *pmk)
  51. {
  52. dl_list_del(&pmk->list);
  53. os_free(pmk);
  54. }
  55. void tdls_deinit(struct wlantest_tdls *tdls)
  56. {
  57. dl_list_del(&tdls->list);
  58. os_free(tdls);
  59. }
  60. void bss_deinit(struct wlantest_bss *bss)
  61. {
  62. struct wlantest_sta *sta, *n;
  63. struct wlantest_pmk *pmk, *np;
  64. struct wlantest_tdls *tdls, *nt;
  65. dl_list_for_each_safe(sta, n, &bss->sta, struct wlantest_sta, list)
  66. sta_deinit(sta);
  67. dl_list_for_each_safe(pmk, np, &bss->pmk, struct wlantest_pmk, list)
  68. pmk_deinit(pmk);
  69. dl_list_for_each_safe(tdls, nt, &bss->tdls, struct wlantest_tdls, list)
  70. tdls_deinit(tdls);
  71. dl_list_del(&bss->list);
  72. os_free(bss);
  73. }
  74. int bss_add_pmk_from_passphrase(struct wlantest_bss *bss,
  75. const char *passphrase)
  76. {
  77. struct wlantest_pmk *pmk;
  78. pmk = os_zalloc(sizeof(*pmk));
  79. if (pmk == NULL)
  80. return -1;
  81. if (pbkdf2_sha1(passphrase, (char *) bss->ssid, bss->ssid_len, 4096,
  82. pmk->pmk, sizeof(pmk->pmk)) < 0) {
  83. os_free(pmk);
  84. return -1;
  85. }
  86. wpa_printf(MSG_INFO, "Add possible PMK for BSSID " MACSTR
  87. " based on passphrase '%s'",
  88. MAC2STR(bss->bssid), passphrase);
  89. wpa_hexdump(MSG_DEBUG, "Possible PMK", pmk->pmk, sizeof(pmk->pmk));
  90. dl_list_add(&bss->pmk, &pmk->list);
  91. return 0;
  92. }
  93. static void bss_add_pmk(struct wlantest *wt, struct wlantest_bss *bss)
  94. {
  95. struct wlantest_passphrase *p;
  96. dl_list_for_each(p, &wt->passphrase, struct wlantest_passphrase, list)
  97. {
  98. if (!is_zero_ether_addr(p->bssid) &&
  99. os_memcmp(p->bssid, bss->bssid, ETH_ALEN) != 0)
  100. continue;
  101. if (p->ssid_len &&
  102. (p->ssid_len != bss->ssid_len ||
  103. os_memcmp(p->ssid, bss->ssid, p->ssid_len) != 0))
  104. continue;
  105. if (bss_add_pmk_from_passphrase(bss, p->passphrase) < 0)
  106. break;
  107. }
  108. }
  109. void bss_update(struct wlantest *wt, struct wlantest_bss *bss,
  110. struct ieee802_11_elems *elems)
  111. {
  112. struct wpa_ie_data data;
  113. int update = 0;
  114. if (bss->capab_info != bss->prev_capab_info)
  115. update = 1;
  116. if (elems->ssid == NULL || elems->ssid_len > 32) {
  117. wpa_printf(MSG_INFO, "Invalid or missing SSID in a Beacon "
  118. "frame for " MACSTR, MAC2STR(bss->bssid));
  119. bss->parse_error_reported = 1;
  120. return;
  121. }
  122. if (bss->ssid_len != elems->ssid_len ||
  123. os_memcmp(bss->ssid, elems->ssid, bss->ssid_len) != 0) {
  124. wpa_printf(MSG_DEBUG, "Store SSID '%s' for BSSID " MACSTR,
  125. wpa_ssid_txt(elems->ssid, elems->ssid_len),
  126. MAC2STR(bss->bssid));
  127. os_memcpy(bss->ssid, elems->ssid, elems->ssid_len);
  128. bss->ssid_len = elems->ssid_len;
  129. bss_add_pmk(wt, bss);
  130. }
  131. if (elems->rsn_ie == NULL) {
  132. if (bss->rsnie[0]) {
  133. wpa_printf(MSG_INFO, "BSS " MACSTR " - RSN IE removed",
  134. MAC2STR(bss->bssid));
  135. bss->rsnie[0] = 0;
  136. update = 1;
  137. }
  138. } else {
  139. if (bss->rsnie[0] == 0 ||
  140. os_memcmp(bss->rsnie, elems->rsn_ie - 2,
  141. elems->rsn_ie_len + 2) != 0) {
  142. wpa_printf(MSG_INFO, "BSS " MACSTR " - RSN IE "
  143. "stored", MAC2STR(bss->bssid));
  144. wpa_hexdump(MSG_DEBUG, "RSN IE", elems->rsn_ie - 2,
  145. elems->rsn_ie_len + 2);
  146. update = 1;
  147. }
  148. os_memcpy(bss->rsnie, elems->rsn_ie - 2,
  149. elems->rsn_ie_len + 2);
  150. }
  151. if (elems->wpa_ie == NULL) {
  152. if (bss->wpaie[0]) {
  153. wpa_printf(MSG_INFO, "BSS " MACSTR " - WPA IE removed",
  154. MAC2STR(bss->bssid));
  155. bss->wpaie[0] = 0;
  156. update = 1;
  157. }
  158. } else {
  159. if (bss->wpaie[0] == 0 ||
  160. os_memcmp(bss->wpaie, elems->wpa_ie - 2,
  161. elems->wpa_ie_len + 2) != 0) {
  162. wpa_printf(MSG_INFO, "BSS " MACSTR " - WPA IE "
  163. "stored", MAC2STR(bss->bssid));
  164. wpa_hexdump(MSG_DEBUG, "WPA IE", elems->wpa_ie - 2,
  165. elems->wpa_ie_len + 2);
  166. update = 1;
  167. }
  168. os_memcpy(bss->wpaie, elems->wpa_ie - 2,
  169. elems->wpa_ie_len + 2);
  170. }
  171. if (!update)
  172. return;
  173. bss->prev_capab_info = bss->capab_info;
  174. bss->proto = 0;
  175. bss->pairwise_cipher = 0;
  176. bss->group_cipher = 0;
  177. bss->key_mgmt = 0;
  178. bss->rsn_capab = 0;
  179. bss->mgmt_group_cipher = 0;
  180. if (bss->wpaie[0]) {
  181. if (wpa_parse_wpa_ie_wpa(bss->wpaie, 2 + bss->wpaie[1], &data)
  182. < 0) {
  183. wpa_printf(MSG_INFO, "Failed to parse WPA IE from "
  184. MACSTR, MAC2STR(bss->bssid));
  185. } else {
  186. bss->proto |= data.proto;
  187. bss->pairwise_cipher |= data.pairwise_cipher;
  188. bss->group_cipher |= data.group_cipher;
  189. bss->key_mgmt |= data.key_mgmt;
  190. bss->rsn_capab = data.capabilities;
  191. bss->mgmt_group_cipher |= data.mgmt_group_cipher;
  192. }
  193. }
  194. if (bss->rsnie[0]) {
  195. if (wpa_parse_wpa_ie_rsn(bss->rsnie, 2 + bss->rsnie[1], &data)
  196. < 0) {
  197. wpa_printf(MSG_INFO, "Failed to parse RSN IE from "
  198. MACSTR, MAC2STR(bss->bssid));
  199. } else {
  200. bss->proto |= data.proto;
  201. bss->pairwise_cipher |= data.pairwise_cipher;
  202. bss->group_cipher |= data.group_cipher;
  203. bss->key_mgmt |= data.key_mgmt;
  204. bss->rsn_capab = data.capabilities;
  205. bss->mgmt_group_cipher |= data.mgmt_group_cipher;
  206. }
  207. }
  208. if (!(bss->proto & WPA_PROTO_RSN) ||
  209. !(bss->rsn_capab & WPA_CAPABILITY_MFPC))
  210. bss->mgmt_group_cipher = 0;
  211. if (!bss->wpaie[0] && !bss->rsnie[0] &&
  212. (bss->capab_info & WLAN_CAPABILITY_PRIVACY))
  213. bss->group_cipher = WPA_CIPHER_WEP40;
  214. wpa_printf(MSG_INFO, "BSS " MACSTR
  215. " proto=%s%s%s"
  216. "pairwise=%s%s%s%s"
  217. "group=%s%s%s%s%s%s"
  218. "mgmt_group_cipher=%s"
  219. "key_mgmt=%s%s%s%s%s%s%s%s"
  220. "rsn_capab=%s%s%s%s%s",
  221. MAC2STR(bss->bssid),
  222. bss->proto == 0 ? "OPEN " : "",
  223. bss->proto & WPA_PROTO_WPA ? "WPA " : "",
  224. bss->proto & WPA_PROTO_RSN ? "WPA2 " : "",
  225. bss->pairwise_cipher == 0 ? "N/A " : "",
  226. bss->pairwise_cipher & WPA_CIPHER_NONE ? "NONE " : "",
  227. bss->pairwise_cipher & WPA_CIPHER_TKIP ? "TKIP " : "",
  228. bss->pairwise_cipher & WPA_CIPHER_CCMP ? "CCMP " : "",
  229. bss->group_cipher == 0 ? "N/A " : "",
  230. bss->group_cipher & WPA_CIPHER_NONE ? "NONE " : "",
  231. bss->group_cipher & WPA_CIPHER_WEP40 ? "WEP40 " : "",
  232. bss->group_cipher & WPA_CIPHER_WEP104 ? "WEP104 " : "",
  233. bss->group_cipher & WPA_CIPHER_TKIP ? "TKIP " : "",
  234. bss->group_cipher & WPA_CIPHER_CCMP ? "CCMP " : "",
  235. bss->mgmt_group_cipher & WPA_CIPHER_AES_128_CMAC ? "BIP " :
  236. "N/A ",
  237. bss->key_mgmt == 0 ? "N/A " : "",
  238. bss->key_mgmt & WPA_KEY_MGMT_IEEE8021X ? "EAP " : "",
  239. bss->key_mgmt & WPA_KEY_MGMT_PSK ? "PSK " : "",
  240. bss->key_mgmt & WPA_KEY_MGMT_WPA_NONE ? "WPA-NONE " : "",
  241. bss->key_mgmt & WPA_KEY_MGMT_FT_IEEE8021X ? "FT-EAP " : "",
  242. bss->key_mgmt & WPA_KEY_MGMT_FT_PSK ? "FT-PSK " : "",
  243. bss->key_mgmt & WPA_KEY_MGMT_IEEE8021X_SHA256 ?
  244. "EAP-SHA256 " : "",
  245. bss->key_mgmt & WPA_KEY_MGMT_PSK_SHA256 ?
  246. "PSK-SHA256 " : "",
  247. bss->rsn_capab & WPA_CAPABILITY_PREAUTH ? "PREAUTH " : "",
  248. bss->rsn_capab & WPA_CAPABILITY_NO_PAIRWISE ?
  249. "NO_PAIRWISE " : "",
  250. bss->rsn_capab & WPA_CAPABILITY_MFPR ? "MFPR " : "",
  251. bss->rsn_capab & WPA_CAPABILITY_MFPC ? "MFPC " : "",
  252. bss->rsn_capab & WPA_CAPABILITY_PEERKEY_ENABLED ?
  253. "PEERKEY " : "");
  254. }
  255. void bss_flush(struct wlantest *wt)
  256. {
  257. struct wlantest_bss *bss, *n;
  258. dl_list_for_each_safe(bss, n, &wt->bss, struct wlantest_bss, list)
  259. bss_deinit(bss);
  260. }