]> git.ipfire.org Git - thirdparty/hostap.git/blame - src/drivers/driver_bsd.c
projects / thirdparty / hostap.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
bsd: Unify wpa_driver_bsd_ops
[thirdparty/hostap.git] / src / drivers / driver_bsd.c
CommitLineData
6fc6879b
JM		 1/*
2 * WPA Supplicant - driver interaction with BSD net80211 layer
3 * Copyright (c) 2004, Sam Leffler <sam@errno.com>
c5121837 4 * Copyright (c) 2004, 2Wire, Inc
6fc6879b
JM		 5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 *
10 * Alternatively, this software may be distributed under the terms of BSD
11 * license.
12 *
13 * See README and COPYING for more details.
14 */
15
16#include "includes.h"
17#include <sys/ioctl.h>
18
19#include "common.h"
20#include "driver.h"
21#include "eloop.h"
90973fb2 22#include "common/ieee802_11_defs.h"
6fc6879b
JM		 23
24#include <net/if.h>
5197244a 25#include <net/if_media.h>
898d6921
JR		 26
27#ifdef __NetBSD__
28#include <net/if_ether.h>
898d6921 29#else
6fc6879b 30#include <net/ethernet.h>
898d6921 31#endif
131289d8 32#include <net/route.h>
6fc6879b 33
9b336bce
MH		 34#ifdef __DragonFly__
35#include <netproto/802_11/ieee80211_ioctl.h>
36#include <netproto/802_11/ieee80211_dragonfly.h>
37#else /* __DragonFly__ */
6fc6879b 38#include <net80211/ieee80211.h>
6fc6879b 39#include <net80211/ieee80211_ioctl.h>
c610dba1 40#include <net80211/ieee80211_crypto.h>
9b336bce 41#endif /* __DragonFly__ */
131289d8
MH		 42#if __FreeBSD__
43#include <net80211/ieee80211_freebsd.h>
44#endif
45#if __NetBSD__
46#include <net80211/ieee80211_netbsd.h>
47#endif
48
42f34a9b
MH		 49#include "l2_packet/l2_packet.h"
50
86b24ea9
MH		 51struct bsd_driver_data {
52 struct hostapd_data *hapd; /* back pointer */
53
54 int sock; /* open socket for 802.11 ioctls */
55 struct l2_packet_data *sock_xmit;/* raw packet xmit socket */
56 int route; /* routing socket for events */
57 char ifname[IFNAMSIZ+1]; /* interface name */
58 unsigned int ifindex; /* interface index */
59 void *ctx;
60 struct wpa_driver_capa capa; /* driver capability */
61 int is_ap; /* Access point mode */
62 int prev_roaming; /* roaming state to restore on deinit */
63 int prev_privacy; /* privacy state to restore on deinit */
64 int prev_wpa; /* wpa state to restore on deinit */
65};
66
66d4085f
RM		 67/* Generic functions for hostapd and wpa_supplicant */
68
69static int
70bsd_set80211var(int s, const char *ifname, int op, const void *arg, int arg_len)
71{
72 struct ieee80211req ireq;
73
74 os_memset(&ireq, 0, sizeof(ireq));
75 os_strlcpy(ireq.i_name, ifname, sizeof(ireq.i_name));
76 ireq.i_type = op;
77 ireq.i_len = arg_len;
78 ireq.i_data = (void *) arg;
79
80 if (ioctl(s, SIOCS80211, &ireq) < 0) {
81 fprintf(stderr, "ioctl[SIOCS80211, op %u, len %u]: %s\n",
82 op, arg_len, strerror(errno));
83 return -1;
84 }
85 return 0;
86}
87
88static int
89bsd_get80211var(int s, const char *ifname, int op, void *arg, int arg_len)
90{
91 struct ieee80211req ireq;
92
93 os_memset(&ireq, 0, sizeof(ireq));
94 os_strlcpy(ireq.i_name, ifname, sizeof(ireq.i_name));
95 ireq.i_type = op;
96 ireq.i_len = arg_len;
97 ireq.i_data = arg;
98
99 if (ioctl(s, SIOCG80211, &ireq) < 0) {
100 fprintf(stderr, "ioctl[SIOCG80211, op %u, len %u]: %s\n",
101 op, arg_len, strerror(errno));
102 return -1;
103 }
104 return ireq.i_len;
105}
106
107static int
108bsd_set80211param(int s, const char *ifname, int op, int arg)
109{
110 struct ieee80211req ireq;
111
112 os_memset(&ireq, 0, sizeof(ireq));
113 os_strlcpy(ireq.i_name, ifname, sizeof(ireq.i_name));
114 ireq.i_type = op;
115 ireq.i_val = arg;
116
117 if (ioctl(s, SIOCS80211, &ireq) < 0) {
118 fprintf(stderr, "ioctl[SIOCS80211, op %u, arg 0x%x]: %s\n",
119 op, arg, strerror(errno));
120 return -1;
121 }
122 return 0;
123}
124
125static int
e1b1309b
MH		 126get80211var(struct bsd_driver_data *drv, int op, void *arg, int arg_len)
127{
128 return bsd_get80211var(drv->sock, drv->ifname, op, arg, arg_len);
129}
130
131static int
132set80211var(struct bsd_driver_data *drv, int op, const void *arg, int arg_len)
66d4085f 133{
e1b1309b
MH		 134 return bsd_set80211var(drv->sock, drv->ifname, op, arg, arg_len);
135}
136
137static int
138set80211param(struct bsd_driver_data *drv, int op, int arg)
139{
140 return bsd_set80211param(drv->sock, drv->ifname, op, arg);
141}
142
143static int
144bsd_get_ssid(const char *ifname, void *priv, u8 *ssid, int len)
145{
146 struct bsd_driver_data *drv = priv;
66d4085f
RM		 147#ifdef SIOCG80211NWID
148 struct ieee80211_nwid nwid;
149 struct ifreq ifr;
150
151 os_memset(&ifr, 0, sizeof(ifr));
e1b1309b 152 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
66d4085f 153 ifr.ifr_data = (void *)&nwid;
e1b1309b 154 if (ioctl(drv->sock, SIOCG80211NWID, &ifr) < 0 ||
66d4085f
RM		 155 nwid.i_len > IEEE80211_NWID_LEN)
156 return -1;
157 os_memcpy(ssid, nwid.i_nwid, nwid.i_len);
158 return nwid.i_len;
159#else
e1b1309b 160 return get80211var(drv, IEEE80211_IOC_SSID, ssid, IEEE80211_NWID_LEN);
66d4085f
RM		 161#endif
162}
163
164static int
e1b1309b 165bsd_set_ssid(const char *ifname, void *priv, const u8 *ssid, int ssid_len)
66d4085f 166{
e1b1309b 167 struct bsd_driver_data *drv = priv;
66d4085f
RM		 168#ifdef SIOCS80211NWID
169 struct ieee80211_nwid nwid;
170 struct ifreq ifr;
171
172 os_memcpy(nwid.i_nwid, ssid, ssid_len);
173 nwid.i_len = ssid_len;
174 os_memset(&ifr, 0, sizeof(ifr));
e1b1309b 175 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
66d4085f 176 ifr.ifr_data = (void *)&nwid;
e1b1309b 177 return ioctl(drv->sock, SIOCS80211NWID, &ifr);
66d4085f 178#else
e1b1309b 179 return set80211var(drv, IEEE80211_IOC_SSID, ssid, ssid_len);
66d4085f
RM		 180#endif
181}
182
5197244a 183static int
e1b1309b 184bsd_get_if_media(void *priv)
5197244a 185{
e1b1309b 186 struct bsd_driver_data *drv = priv;
5197244a
MH		 187 struct ifmediareq ifmr;
188
189 os_memset(&ifmr, 0, sizeof(ifmr));
e1b1309b 190 os_strlcpy(ifmr.ifm_name, drv->ifname, sizeof(ifmr.ifm_name));
5197244a 191
e1b1309b 192 if (ioctl(drv->sock, SIOCGIFMEDIA, &ifmr) < 0) {
5197244a
MH		 193 wpa_printf(MSG_ERROR, "%s: SIOCGIFMEDIA %s", __func__,
194 strerror(errno));
195 return -1;
196 }
197
198 return ifmr.ifm_current;
199}
200
201static int
e1b1309b 202bsd_set_if_media(void *priv, int media)
5197244a 203{
e1b1309b 204 struct bsd_driver_data *drv = priv;
5197244a
MH		 205 struct ifreq ifr;
206
207 os_memset(&ifr, 0, sizeof(ifr));
e1b1309b 208 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
5197244a
MH		 209 ifr.ifr_media = media;
210
e1b1309b 211 if (ioctl(drv->sock, SIOCSIFMEDIA, &ifr) < 0) {
5197244a
MH		 212 wpa_printf(MSG_ERROR, "%s: SIOCSIFMEDIA %s", __func__,
213 strerror(errno));
214 return -1;
215 }
216
217 return 0;
218}
219
220static int
e1b1309b 221bsd_set_mediaopt(void *priv, uint32_t mask, uint32_t mode)
5197244a 222{
e1b1309b 223 int media = bsd_get_if_media(priv);
5197244a
MH		 224
225 if (media < 0)
226 return -1;
227 media &= ~mask;
228 media |= mode;
e1b1309b 229 if (bsd_set_if_media(priv, media) < 0)
5197244a
MH		 230 return -1;
231 return 0;
232}
233
cbdecd2b 234static int
e1b1309b 235bsd_del_key(void *priv, const u8 *addr, int key_idx)
cbdecd2b
MH		 236{
237 struct ieee80211req_del_key wk;
238
239 os_memset(&wk, 0, sizeof(wk));
240 if (addr == NULL) {
241 wpa_printf(MSG_DEBUG, "%s: key_idx=%d", __func__, key_idx);
242 wk.idk_keyix = key_idx;
243 } else {
244 wpa_printf(MSG_DEBUG, "%s: addr=" MACSTR, __func__,
245 MAC2STR(addr));
246 os_memcpy(wk.idk_macaddr, addr, IEEE80211_ADDR_LEN);
247 wk.idk_keyix = (u_int8_t) IEEE80211_KEYIX_NONE; /* XXX */
248 }
249
e1b1309b 250 return set80211var(priv, IEEE80211_IOC_DELKEY, &wk, sizeof(wk));
cbdecd2b
MH		 251}
252
fa6b8afe 253static int
e1b1309b 254bsd_send_mlme_param(void *priv, const u8 op, const u16 reason, const u8 *addr)
fa6b8afe
MH		 255{
256 struct ieee80211req_mlme mlme;
257
258 os_memset(&mlme, 0, sizeof(mlme));
259 mlme.im_op = op;
260 mlme.im_reason = reason;
261 os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN);
e1b1309b 262 return set80211var(priv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme));
fa6b8afe
MH		 263}
264
60bc3033 265static int
e1b1309b 266bsd_ctrl_iface(void *priv, int enable)
60bc3033 267{
e1b1309b 268 struct bsd_driver_data *drv = priv;
60bc3033
MH		 269 struct ifreq ifr;
270
271 os_memset(&ifr, 0, sizeof(ifr));
e1b1309b 272 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
60bc3033 273
e1b1309b 274 if (ioctl(drv->sock, SIOCGIFFLAGS, &ifr) < 0) {
60bc3033
MH		 275 perror("ioctl[SIOCGIFFLAGS]");
276 return -1;
277 }
278
279 if (enable)
280 ifr.ifr_flags |= IFF_UP;
281 else
282 ifr.ifr_flags &= ~IFF_UP;
283
e1b1309b 284 if (ioctl(drv->sock, SIOCSIFFLAGS, &ifr) < 0) {
60bc3033
MH		 285 perror("ioctl[SIOCSIFFLAGS]");
286 return -1;
287 }
288
289 return 0;
290}
291
719196b1 292static int
e1b1309b 293bsd_set_key(const char *ifname, void *priv, enum wpa_alg alg,
719196b1
MH		 294 const unsigned char *addr, int key_idx, int set_tx, const u8 *seq,
295 size_t seq_len, const u8 *key, size_t key_len)
296{
297 struct ieee80211req_key wk;
298
299 wpa_printf(MSG_DEBUG, "%s: alg=%d addr=%p key_idx=%d set_tx=%d "
300 "seq_len=%zu key_len=%zu", __func__, alg, addr, key_idx,
301 set_tx, seq_len, key_len);
302
e1b1309b
MH		 303 if (alg == WPA_ALG_NONE) {
304#ifndef HOSTAPD
305 if (addr == NULL ||
306 os_memcmp(addr, "\xff\xff\xff\xff\xff\xff",
307 IEEE80211_ADDR_LEN) == 0)
308 return bsd_del_key(priv, NULL, key_idx);
309 else
310#endif /* HOSTAPD */
311 return bsd_del_key(priv, addr, key_idx);
312 }
313
719196b1
MH		 314 os_memset(&wk, 0, sizeof(wk));
315 switch (alg) {
316 case WPA_ALG_WEP:
317 wk.ik_type = IEEE80211_CIPHER_WEP;
318 break;
319 case WPA_ALG_TKIP:
320 wk.ik_type = IEEE80211_CIPHER_TKIP;
321 break;
322 case WPA_ALG_CCMP:
323 wk.ik_type = IEEE80211_CIPHER_AES_CCM;
324 break;
325 default:
326 wpa_printf(MSG_ERROR, "%s: unknown alg=%d", __func__, alg);
327 return -1;
328 }
329
330 wk.ik_flags = IEEE80211_KEY_RECV;
331 if (set_tx)
332 wk.ik_flags |= IEEE80211_KEY_XMIT;
333
334 if (addr == NULL) {
335 os_memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN);
336 wk.ik_keyix = key_idx;
337 } else {
338 os_memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN);
339 /*
340 * Deduce whether group/global or unicast key by checking
341 * the address (yech). Note also that we can only mark global
342 * keys default; doing this for a unicast key is an error.
343 */
344 if (os_memcmp(addr, "\xff\xff\xff\xff\xff\xff",
345 IEEE80211_ADDR_LEN) == 0) {
346 wk.ik_flags |= IEEE80211_KEY_GROUP;
347 wk.ik_keyix = key_idx;
348 } else {
349 wk.ik_keyix = key_idx == 0 ? IEEE80211_KEYIX_NONE :
350 key_idx;
351 }
352 }
353 if (wk.ik_keyix != IEEE80211_KEYIX_NONE && set_tx)
354 wk.ik_flags |= IEEE80211_KEY_DEFAULT;
355 wk.ik_keylen = key_len;
356 os_memcpy(&wk.ik_keyrsc, seq, seq_len);
357 os_memcpy(wk.ik_keydata, key, key_len);
358
e1b1309b 359 return set80211var(priv, IEEE80211_IOC_WPAKEY, &wk, sizeof(wk));
719196b1
MH		 360}
361
c5121837 362static int
e1b1309b 363bsd_configure_wpa(void *priv, struct wpa_bss_params *params)
c5121837
JM		 364{
365 static const char *ciphernames[] =
366 { "WEP", "TKIP", "AES-OCB", "AES-CCM", "CKIP", "NONE" };
c5121837
JM		 367 int v;
368
af586419 369 switch (params->wpa_group) {
c5121837
JM		 370 case WPA_CIPHER_CCMP:
371 v = IEEE80211_CIPHER_AES_CCM;
372 break;
373 case WPA_CIPHER_TKIP:
374 v = IEEE80211_CIPHER_TKIP;
375 break;
376 case WPA_CIPHER_WEP104:
377 v = IEEE80211_CIPHER_WEP;
378 break;
379 case WPA_CIPHER_WEP40:
380 v = IEEE80211_CIPHER_WEP;
381 break;
382 case WPA_CIPHER_NONE:
383 v = IEEE80211_CIPHER_NONE;
384 break;
385 default:
386 printf("Unknown group key cipher %u\n",
af586419 387 params->wpa_group);
c5121837
JM		 388 return -1;
389 }
390 wpa_printf(MSG_DEBUG, "%s: group key cipher=%s (%u)",
391 __func__, ciphernames[v], v);
e1b1309b 392 if (set80211param(priv, IEEE80211_IOC_MCASTCIPHER, v)) {
c5121837
JM		 393 printf("Unable to set group key cipher to %u (%s)\n",
394 v, ciphernames[v]);
395 return -1;
396 }
397 if (v == IEEE80211_CIPHER_WEP) {
398 /* key length is done only for specific ciphers */
af586419 399 v = (params->wpa_group == WPA_CIPHER_WEP104 ? 13 : 5);
e1b1309b 400 if (set80211param(priv, IEEE80211_IOC_MCASTKEYLEN, v)) {
c5121837
JM		 401 printf("Unable to set group key length to %u\n", v);
402 return -1;
403 }
404 }
405
406 v = 0;
af586419 407 if (params->wpa_pairwise & WPA_CIPHER_CCMP)
c5121837 408 v |= 1<<IEEE80211_CIPHER_AES_CCM;
af586419 409 if (params->wpa_pairwise & WPA_CIPHER_TKIP)
c5121837 410 v |= 1<<IEEE80211_CIPHER_TKIP;
af586419 411 if (params->wpa_pairwise & WPA_CIPHER_NONE)
c5121837
JM		 412 v |= 1<<IEEE80211_CIPHER_NONE;
413 wpa_printf(MSG_DEBUG, "%s: pairwise key ciphers=0x%x", __func__, v);
e1b1309b 414 if (set80211param(priv, IEEE80211_IOC_UCASTCIPHERS, v)) {
c5121837
JM		 415 printf("Unable to set pairwise key ciphers to 0x%x\n", v);
416 return -1;
417 }
418
419 wpa_printf(MSG_DEBUG, "%s: key management algorithms=0x%x",
af586419 420 __func__, params->wpa_key_mgmt);
e1b1309b
MH		 421 if (set80211param(priv, IEEE80211_IOC_KEYMGTALGS,
422 params->wpa_key_mgmt)) {
c5121837 423 printf("Unable to set key management algorithms to 0x%x\n",
af586419 424 params->wpa_key_mgmt);
c5121837
JM		 425 return -1;
426 }
427
428 v = 0;
af586419 429 if (params->rsn_preauth)
c5121837
JM		 430 v |= BIT(0);
431 wpa_printf(MSG_DEBUG, "%s: rsn capabilities=0x%x",
af586419 432 __func__, params->rsn_preauth);
e1b1309b 433 if (set80211param(priv, IEEE80211_IOC_RSNCAPS, v)) {
c5121837
JM		 434 printf("Unable to set RSN capabilities to 0x%x\n", v);
435 return -1;
436 }
437
af586419 438 wpa_printf(MSG_DEBUG, "%s: enable WPA= 0x%x", __func__, params->wpa);
e1b1309b 439 if (set80211param(priv, IEEE80211_IOC_WPA, params->wpa)) {
af586419 440 printf("Unable to set WPA to %u\n", params->wpa);
c5121837
JM		 441 return -1;
442 }
443 return 0;
444}
445
c5121837 446static int
e1b1309b 447bsd_set_ieee8021x(void *priv, struct wpa_bss_params *params)
c5121837 448{
af586419 449 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, params->enabled);
c5121837 450
af586419 451 if (!params->enabled) {
c5121837 452 /* XXX restore state */
e1b1309b
MH		 453 return set80211param(priv, IEEE80211_IOC_AUTHMODE,
454 IEEE80211_AUTH_AUTO);
c5121837 455 }
af586419 456 if (!params->wpa && !params->ieee802_1x) {
42f34a9b
MH		 457 wpa_printf(MSG_ERROR, "%s: No 802.1X or WPA enabled",
458 __func__);
c5121837
JM		 459 return -1;
460 }
e1b1309b 461 if (params->wpa && bsd_configure_wpa(priv, params) != 0) {
42f34a9b
MH		 462 wpa_printf(MSG_ERROR, "%s: Failed to configure WPA state",
463 __func__);
c5121837
JM		 464 return -1;
465 }
e1b1309b 466 if (set80211param(priv, IEEE80211_IOC_AUTHMODE,
af586419 467 (params->wpa ? IEEE80211_AUTH_WPA : IEEE80211_AUTH_8021X))) {
42f34a9b
MH		 468 wpa_printf(MSG_ERROR, "%s: Failed to enable WPA/802.1X",
469 __func__);
c5121837
JM		 470 return -1;
471 }
e1b1309b 472 return bsd_ctrl_iface(priv, 1);
c5121837
JM		 473}
474
475static int
e1b1309b
MH		 476bsd_set_sta_authorized(void *priv, const u8 *addr, int total_flags,
477 int flags_or, int flags_and)
c5121837 478{
42f34a9b 479 int authorized = -1;
c5121837 480
42f34a9b
MH		 481 /* For now, only support setting Authorized flag */
482 if (flags_or & WPA_STA_AUTHORIZED)
483 authorized = 1;
484 if (!(flags_and & WPA_STA_AUTHORIZED))
485 authorized = 0;
c5121837 486
42f34a9b
MH		 487 if (authorized < 0)
488 return 0;
489
e1b1309b 490 return bsd_send_mlme_param(priv, authorized ?
42f34a9b
MH		 491 IEEE80211_MLME_AUTHORIZE :
492 IEEE80211_MLME_UNAUTHORIZE, 0, addr);
493}
494
495static void
e1b1309b 496bsd_new_sta(void *priv, void *ctx, u8 addr[IEEE80211_ADDR_LEN])
42f34a9b
MH		 497{
498 struct ieee80211req_wpaie ie;
499 int ielen = 0;
500 u8 *iebuf = NULL;
501
502 /*
503 * Fetch and validate any negotiated WPA/RSN parameters.
504 */
505 memset(&ie, 0, sizeof(ie));
506 memcpy(ie.wpa_macaddr, addr, IEEE80211_ADDR_LEN);
e1b1309b 507 if (get80211var(priv, IEEE80211_IOC_WPAIE, &ie, sizeof(ie)) < 0) {
42f34a9b
MH		 508 printf("Failed to get WPA/RSN information element.\n");
509 goto no_ie;
510 }
511 iebuf = ie.wpa_ie;
512 ielen = ie.wpa_ie[1];
513 if (ielen == 0)
514 iebuf = NULL;
515 else
516 ielen += 2;
517
518no_ie:
519 drv_event_assoc(ctx, addr, iebuf, ielen);
520}
521
522static int
e1b1309b
MH		 523bsd_send_eapol(void *priv, const u8 *addr, const u8 *data, size_t data_len,
524 int encrypt, const u8 *own_addr)
42f34a9b 525{
e1b1309b
MH		 526 struct bsd_driver_data *drv = priv;
527
42f34a9b
MH		 528 wpa_hexdump(MSG_MSGDUMP, "TX EAPOL", data, data_len);
529
e1b1309b
MH		 530 return l2_packet_send(drv->sock_xmit, addr, ETH_P_EAPOL, data,
531 data_len);
c5121837
JM		 532}
533
534static int
e1b1309b 535bsd_set_freq(void *priv, u16 channel)
42f34a9b 536{
e1b1309b 537 struct bsd_driver_data *drv = priv;
aba7569e 538#ifdef SIOCS80211CHANNEL
42f34a9b
MH		 539 struct ieee80211chanreq creq;
540 u32 mode;
541
542 if (channel < 14)
543 mode = IFM_IEEE80211_11G;
544 else if (channel == 14)
545 mode = IFM_IEEE80211_11B;
546 else
547 mode = IFM_IEEE80211_11A;
e1b1309b 548 if (bsd_set_mediaopt(drv, IFM_MMASK, mode) < 0) {
42f34a9b
MH		 549 wpa_printf(MSG_ERROR, "%s: failed to set modulation mode",
550 __func__);
551 return -1;
552 }
553
554 os_memset(&creq, 0, sizeof(creq));
e1b1309b 555 os_strlcpy(creq.i_name, drv->ifname, sizeof(creq.i_name));
42f34a9b 556 creq.i_channel = channel;
e1b1309b 557 return ioctl(drv->sock, SIOCS80211CHANNEL, &creq);
aba7569e
JM		 558#else
559 wpa_printf(MSG_ERROR, "bsd_set_freq: SIOCS80211CHANNEL not "
560 "defined");
561 return -1;
562#endif
42f34a9b
MH		 563}
564
565
566#ifdef HOSTAPD
567
568/*
569 * Avoid conflicts with hostapd definitions by undefining couple of defines
570 * from net80211 header files.
571 */
572#undef RSN_VERSION
573#undef WPA_VERSION
574#undef WPA_OUI_TYPE
575
42f34a9b
MH		 576static int bsd_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr,
577 int reason_code);
578
42f34a9b
MH		 579static const char *
580ether_sprintf(const u8 *addr)
581{
582 static char buf[sizeof(MACSTR)];
583
584 if (addr != NULL)
585 snprintf(buf, sizeof(buf), MACSTR, MAC2STR(addr));
586 else
587 snprintf(buf, sizeof(buf), MACSTR, 0,0,0,0,0,0);
588 return buf;
589}
590
42f34a9b
MH		 591static int
592bsd_set_privacy(const char *ifname, void *priv, int enabled)
c5121837 593{
42f34a9b
MH		 594 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
595
e1b1309b 596 return set80211param(priv, IEEE80211_IOC_PRIVACY, enabled);
c5121837
JM		 597}
598
c5121837
JM		 599static int
600bsd_get_seqnum(const char *ifname, void *priv, const u8 *addr, int idx,
601 u8 *seq)
602{
c5121837
JM		 603 struct ieee80211req_key wk;
604
605 wpa_printf(MSG_DEBUG, "%s: addr=%s idx=%d",
606 __func__, ether_sprintf(addr), idx);
607
608 memset(&wk, 0, sizeof(wk));
609 if (addr == NULL)
610 memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN);
611 else
612 memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN);
613 wk.ik_keyix = idx;
614
e1b1309b 615 if (get80211var(priv, IEEE80211_IOC_WPAKEY, &wk, sizeof(wk)) < 0) {
c5121837
JM		 616 printf("Failed to get encryption.\n");
617 return -1;
618 }
619
620#ifdef WORDS_BIGENDIAN
621 {
622 /*
623 * wk.ik_keytsc is in host byte order (big endian), need to
624 * swap it to match with the byte order used in WPA.
625 */
626 int i;
627 u8 tmp[WPA_KEY_RSC_LEN];
628 memcpy(tmp, &wk.ik_keytsc, sizeof(wk.ik_keytsc));
629 for (i = 0; i < WPA_KEY_RSC_LEN; i++) {
630 seq[i] = tmp[WPA_KEY_RSC_LEN - i - 1];
631 }
632 }
633#else /* WORDS_BIGENDIAN */
634 memcpy(seq, &wk.ik_keytsc, sizeof(wk.ik_keytsc));
635#endif /* WORDS_BIGENDIAN */
636 return 0;
637}
638
639
640static int
641bsd_flush(void *priv)
642{
643 u8 allsta[IEEE80211_ADDR_LEN];
644
645 memset(allsta, 0xff, IEEE80211_ADDR_LEN);
731723a5 646 return bsd_sta_deauth(priv, NULL, allsta, IEEE80211_REASON_AUTH_LEAVE);
c5121837
JM		 647}
648
649
650static int
651bsd_read_sta_driver_data(void *priv, struct hostap_sta_driver_data *data,
652 const u8 *addr)
653{
c5121837
JM		 654 struct ieee80211req_sta_stats stats;
655
656 memcpy(stats.is_u.macaddr, addr, IEEE80211_ADDR_LEN);
e1b1309b
MH		 657 if (get80211var(priv, IEEE80211_IOC_STA_STATS, &stats, sizeof(stats))
658 > 0) {
c5121837
JM		 659 /* XXX? do packets counts include non-data frames? */
660 data->rx_packets = stats.is_stats.ns_rx_data;
661 data->rx_bytes = stats.is_stats.ns_rx_bytes;
662 data->tx_packets = stats.is_stats.ns_tx_data;
663 data->tx_bytes = stats.is_stats.ns_tx_bytes;
664 }
665 return 0;
666}
667
668static int
669bsd_set_opt_ie(const char *ifname, void *priv, const u8 *ie, size_t ie_len)
670{
671 /*
672 * Do nothing; we setup parameters at startup that define the
673 * contents of the beacon information element.
674 */
675 return 0;
676}
677
678static int
731723a5 679bsd_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, int reason_code)
c5121837 680{
e1b1309b
MH		 681 return bsd_send_mlme_param(priv, IEEE80211_MLME_DEAUTH, reason_code,
682 addr);
c5121837
JM		 683}
684
685static int
731723a5
JM		 686bsd_sta_disassoc(void *priv, const u8 *own_addr, const u8 *addr,
687 int reason_code)
c5121837 688{
e1b1309b
MH		 689 return bsd_send_mlme_param(priv, IEEE80211_MLME_DISASSOC, reason_code,
690 addr);
c5121837
JM		 691}
692
c5121837
JM		 693static void
694bsd_wireless_event_receive(int sock, void *ctx, void *sock_ctx)
695{
696 struct bsd_driver_data *drv = ctx;
c5121837
JM		 697 char buf[2048];
698 struct if_announcemsghdr *ifan;
699 struct rt_msghdr *rtm;
700 struct ieee80211_michael_event *mic;
701 struct ieee80211_join_event *join;
702 struct ieee80211_leave_event *leave;
703 int n;
1cd973d5 704 union wpa_event_data data;
c5121837
JM		 705
706 n = read(sock, buf, sizeof(buf));
707 if (n < 0) {
708 if (errno != EINTR && errno != EAGAIN)
709 perror("read(PF_ROUTE)");
710 return;
711 }
712
713 rtm = (struct rt_msghdr *) buf;
714 if (rtm->rtm_version != RTM_VERSION) {
715 wpa_printf(MSG_DEBUG, "Routing message version %d not "
716 "understood\n", rtm->rtm_version);
717 return;
718 }
719 ifan = (struct if_announcemsghdr *) rtm;
720 switch (rtm->rtm_type) {
721 case RTM_IEEE80211:
722 switch (ifan->ifan_what) {
723 case RTM_IEEE80211_ASSOC:
724 case RTM_IEEE80211_REASSOC:
725 case RTM_IEEE80211_DISASSOC:
726 case RTM_IEEE80211_SCAN:
727 break;
728 case RTM_IEEE80211_LEAVE:
729 leave = (struct ieee80211_leave_event *) &ifan[1];
69378b79 730 drv_event_disassoc(drv->hapd, leave->iev_addr);
c5121837
JM		 731 break;
732 case RTM_IEEE80211_JOIN:
733#ifdef RTM_IEEE80211_REJOIN
734 case RTM_IEEE80211_REJOIN:
735#endif
736 join = (struct ieee80211_join_event *) &ifan[1];
e1b1309b 737 bsd_new_sta(drv, drv->hapd, join->iev_addr);
c5121837
JM		 738 break;
739 case RTM_IEEE80211_REPLAY:
740 /* ignore */
741 break;
742 case RTM_IEEE80211_MICHAEL:
743 mic = (struct ieee80211_michael_event *) &ifan[1];
744 wpa_printf(MSG_DEBUG,
745 "Michael MIC failure wireless event: "
746 "keyix=%u src_addr=" MACSTR, mic->iev_keyix,
747 MAC2STR(mic->iev_src));
1cd973d5
JM		 748 os_memset(&data, 0, sizeof(data));
749 data.michael_mic_failure.unicast = 1;
750 data.michael_mic_failure.src = mic->iev_src;
751 wpa_supplicant_event(drv->hapd,
752 EVENT_MICHAEL_MIC_FAILURE, &data);
c5121837
JM		 753 break;
754 }
755 break;
756 }
757}
758
c5121837
JM		 759static void
760handle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len)
761{
762 struct bsd_driver_data *drv = ctx;
d3737256 763 drv_event_eapol_rx(drv->hapd, src_addr, buf, len);
c5121837
JM		 764}
765
42f34a9b
MH		 766static int
767hostapd_bsd_set_freq(void *priv, struct hostapd_freq_params *freq)
768{
e1b1309b 769 return bsd_set_freq(priv, freq->channel);
5197244a
MH		 770}
771
c5121837 772static void *
92f475b4 773bsd_init(struct hostapd_data *hapd, struct wpa_init_params *params)
c5121837
JM		 774{
775 struct bsd_driver_data *drv;
776
777 drv = os_zalloc(sizeof(struct bsd_driver_data));
778 if (drv == NULL) {
779 printf("Could not allocate memory for bsd driver data\n");
780 goto bad;
781 }
782
783 drv->hapd = hapd;
6850c707
MH		 784 drv->sock = socket(PF_INET, SOCK_DGRAM, 0);
785 if (drv->sock < 0) {
c5121837
JM		 786 perror("socket[PF_INET,SOCK_DGRAM]");
787 goto bad;
788 }
6850c707 789 os_strlcpy(drv->ifname, params->ifname, sizeof(drv->ifname));
c5121837 790
6850c707 791 drv->sock_xmit = l2_packet_init(drv->ifname, NULL, ETH_P_EAPOL,
d3737256 792 handle_read, drv, 0);
c5121837
JM		 793 if (drv->sock_xmit == NULL)
794 goto bad;
412036f5 795 if (l2_packet_get_own_addr(drv->sock_xmit, params->own_addr))
c5121837
JM		 796 goto bad;
797
60bc3033 798 /* mark down during setup */
e1b1309b 799 if (bsd_ctrl_iface(drv, 0) < 0)
60bc3033 800 goto bad;
6850c707
MH		 801
802 drv->route = socket(PF_ROUTE, SOCK_RAW, 0);
803 if (drv->route < 0) {
804 perror("socket(PF_ROUTE,SOCK_RAW)");
c5121837 805 goto bad;
6850c707
MH		 806 }
807 eloop_register_read_sock(drv->route, bsd_wireless_event_receive, drv,
808 NULL);
c5121837 809
e1b1309b 810 if (bsd_set_mediaopt(drv, IFM_OMASK, IFM_IEEE80211_HOSTAP) < 0) {
5197244a
MH		 811 wpa_printf(MSG_ERROR, "%s: failed to set operation mode",
812 __func__);
813 goto bad;
814 }
815
c5121837
JM		 816 return drv;
817bad:
818 if (drv->sock_xmit != NULL)
819 l2_packet_deinit(drv->sock_xmit);
6850c707
MH		 820 if (drv->sock >= 0)
821 close(drv->sock);
c5121837 822 if (drv != NULL)
82f36163 823 os_free(drv);
c5121837
JM		 824 return NULL;
825}
826
827
828static void
829bsd_deinit(void *priv)
830{
831 struct bsd_driver_data *drv = priv;
832
6850c707
MH		 833 if (drv->route >= 0) {
834 eloop_unregister_read_sock(drv->route);
835 close(drv->route);
836 }
e1b1309b 837 bsd_ctrl_iface(drv, 0);
6850c707
MH		 838 if (drv->sock >= 0)
839 close(drv->sock);
c5121837
JM		 840 if (drv->sock_xmit != NULL)
841 l2_packet_deinit(drv->sock_xmit);
82f36163 842 os_free(drv);
c5121837
JM		 843}
844
c5121837
JM		 845#else /* HOSTAPD */
846
6fc6879b 847static int
86b24ea9 848get80211param(struct bsd_driver_data *drv, int op)
6fc6879b
JM		 849{
850 struct ieee80211req ireq;
851
852 os_memset(&ireq, 0, sizeof(ireq));
66d4085f 853 os_strlcpy(ireq.i_name, drv->ifname, sizeof(ireq.i_name));
6fc6879b
JM		 854 ireq.i_type = op;
855
856 if (ioctl(drv->sock, SIOCG80211, &ireq) < 0) {
857 fprintf(stderr, "ioctl[SIOCG80211, op %u]: %s\n",
858 op, strerror(errno));
859 return -1;
860 }
861 return ireq.i_val;
862}
863
6fc6879b
JM		 864static int
865wpa_driver_bsd_get_bssid(void *priv, u8 *bssid)
866{
86b24ea9 867 struct bsd_driver_data *drv = priv;
66d4085f 868#ifdef SIOCG80211BSSID
a65f4a57 869 struct ieee80211_bssid bs;
6fc6879b 870
e1b1309b 871 os_strlcpy(bs.i_name, drv->ifname, sizeof(bs.i_name));
a65f4a57
MH		 872 if (ioctl(drv->sock, SIOCG80211BSSID, &bs) < 0)
873 return -1;
874 os_memcpy(bssid, bs.i_bssid, sizeof(bs.i_bssid));
875 return 0;
876#else
6fc6879b
JM		 877 return get80211var(drv, IEEE80211_IOC_BSSID,
878 bssid, IEEE80211_ADDR_LEN) < 0 ? -1 : 0;
a65f4a57 879#endif
6fc6879b
JM		 880}
881
6fc6879b
JM		 882static int
883wpa_driver_bsd_get_ssid(void *priv, u8 *ssid)
884{
86b24ea9 885 struct bsd_driver_data *drv = priv;
e1b1309b 886 return bsd_get_ssid(drv->ifname, drv, ssid, 0);
6fc6879b
JM		 887}
888
889static int
86b24ea9
MH		 890wpa_driver_bsd_set_wpa_ie(struct bsd_driver_data *drv, const u8 *wpa_ie,
891 size_t wpa_ie_len)
6fc6879b 892{
c610dba1
MH		 893#ifdef IEEE80211_IOC_APPIE
894 return set80211var(drv, IEEE80211_IOC_APPIE, wpa_ie, wpa_ie_len);
895#else /* IEEE80211_IOC_APPIE */
6fc6879b 896 return set80211var(drv, IEEE80211_IOC_OPTIE, wpa_ie, wpa_ie_len);
c610dba1 897#endif /* IEEE80211_IOC_APPIE */
6fc6879b
JM		 898}
899
900static int
901wpa_driver_bsd_set_wpa_internal(void *priv, int wpa, int privacy)
902{
6fc6879b
JM		 903 int ret = 0;
904
905 wpa_printf(MSG_DEBUG, "%s: wpa=%d privacy=%d",
906 __FUNCTION__, wpa, privacy);
907
e1b1309b 908 if (!wpa && wpa_driver_bsd_set_wpa_ie(priv, NULL, 0) < 0)
6fc6879b 909 ret = -1;
e1b1309b 910 if (set80211param(priv, IEEE80211_IOC_PRIVACY, privacy) < 0)
6fc6879b 911 ret = -1;
e1b1309b 912 if (set80211param(priv, IEEE80211_IOC_WPA, wpa) < 0)
6fc6879b
JM		 913 ret = -1;
914
915 return ret;
916}
917
918static int
919wpa_driver_bsd_set_wpa(void *priv, int enabled)
920{
921 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __FUNCTION__, enabled);
922
923 return wpa_driver_bsd_set_wpa_internal(priv, enabled ? 3 : 0, enabled);
924}
925
6fc6879b
JM		 926static int
927wpa_driver_bsd_set_countermeasures(void *priv, int enabled)
928{
6fc6879b 929 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
e1b1309b 930 return set80211param(priv, IEEE80211_IOC_COUNTERMEASURES, enabled);
6fc6879b
JM		 931}
932
933
934static int
935wpa_driver_bsd_set_drop_unencrypted(void *priv, int enabled)
936{
6fc6879b 937 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
e1b1309b 938 return set80211param(priv, IEEE80211_IOC_DROPUNENCRYPTED, enabled);
6fc6879b
JM		 939}
940
941static int
942wpa_driver_bsd_deauthenticate(void *priv, const u8 *addr, int reason_code)
943{
e1b1309b
MH		 944 return bsd_send_mlme_param(priv, IEEE80211_MLME_DEAUTH, reason_code,
945 addr);
6fc6879b
JM		 946}
947
948static int
949wpa_driver_bsd_disassociate(void *priv, const u8 *addr, int reason_code)
950{
e1b1309b
MH		 951 return bsd_send_mlme_param(priv, IEEE80211_MLME_DISASSOC, reason_code,
952 addr);
6fc6879b
JM		 953}
954
2a91091e
MH		 955static int
956wpa_driver_bsd_set_auth_alg(void *priv, int auth_alg)
957{
2a91091e
MH		 958 int authmode;
959
abd9fafa
JM		 960 if ((auth_alg & WPA_AUTH_ALG_OPEN) &&
961 (auth_alg & WPA_AUTH_ALG_SHARED))
2a91091e 962 authmode = IEEE80211_AUTH_AUTO;
abd9fafa 963 else if (auth_alg & WPA_AUTH_ALG_SHARED)
2a91091e
MH		 964 authmode = IEEE80211_AUTH_SHARED;
965 else
966 authmode = IEEE80211_AUTH_OPEN;
967
e1b1309b 968 return set80211param(priv, IEEE80211_IOC_AUTHMODE, authmode);
2a91091e
MH		 969}
970
42f34a9b
MH		 971static void
972handle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len)
973{
86b24ea9 974 struct bsd_driver_data *drv = ctx;
42f34a9b
MH		 975
976 drv_event_eapol_rx(drv->ctx, src_addr, buf, len);
977}
978
6fc6879b
JM		 979static int
980wpa_driver_bsd_associate(void *priv, struct wpa_driver_associate_params *params)
981{
86b24ea9 982 struct bsd_driver_data *drv = priv;
6fc6879b 983 struct ieee80211req_mlme mlme;
42f34a9b
MH		 984 u32 mode;
985 u16 channel;
6fc6879b 986 int privacy;
4a867032 987 int ret = 0;
6fc6879b
JM		 988
989 wpa_printf(MSG_DEBUG,
990 "%s: ssid '%.*s' wpa ie len %u pairwise %u group %u key mgmt %u"
991 , __func__
92e63aaf
JM		 992 , (unsigned int) params->ssid_len, params->ssid
993 , (unsigned int) params->wpa_ie_len
6fc6879b
JM		 994 , params->pairwise_suite
995 , params->group_suite
996 , params->key_mgmt_suite
997 );
998
42f34a9b
MH		 999 switch (params->mode) {
1000 case IEEE80211_MODE_INFRA:
1001 mode = 0 /* STA */;
1002 break;
1003 case IEEE80211_MODE_IBSS:
1004 mode = IFM_IEEE80211_IBSS;
1005 break;
1006 case IEEE80211_MODE_AP:
1007 mode = IFM_IEEE80211_HOSTAP;
1008 break;
1009 default:
1010 wpa_printf(MSG_ERROR, "%s: unknown operation mode", __func__);
1011 return -1;
1012 }
e1b1309b 1013 if (bsd_set_mediaopt(drv, IFM_OMASK, mode) < 0) {
42f34a9b
MH		 1014 wpa_printf(MSG_ERROR, "%s: failed to set operation mode",
1015 __func__);
1016 return -1;
1017 }
1018
1019 if (params->mode == IEEE80211_MODE_AP) {
1020 if (params->freq >= 2412 && params->freq <= 2472)
1021 channel = (params->freq - 2407) / 5;
1022 else if (params->freq == 2484)
1023 channel = 14;
1024 else if ((params->freq >= 5180 && params->freq <= 5240) ||
1025 (params->freq >= 5745 && params->freq <= 5825))
1026 channel = (params->freq - 5000) / 5;
1027 else
1028 channel = 0;
e1b1309b 1029 if (bsd_set_freq(drv, channel) < 0)
42f34a9b
MH		 1030 return -1;
1031
1032 drv->sock_xmit = l2_packet_init(drv->ifname, NULL, ETH_P_EAPOL,
1033 handle_read, drv, 0);
1034 if (drv->sock_xmit == NULL)
1035 return -1;
1036 drv->is_ap = 1;
1037 return 0;
1038 }
1039
4a867032
JM		 1040 if (wpa_driver_bsd_set_drop_unencrypted(drv, params->drop_unencrypted)
1041 < 0)
1042 ret = -1;
1043 if (wpa_driver_bsd_set_auth_alg(drv, params->auth_alg) < 0)
1044 ret = -1;
6fc6879b
JM		 1045 /* XXX error handling is wrong but unclear what to do... */
1046 if (wpa_driver_bsd_set_wpa_ie(drv, params->wpa_ie, params->wpa_ie_len) < 0)
1047 return -1;
6fc6879b
JM		 1048
1049 privacy = !(params->pairwise_suite == CIPHER_NONE &&
1050 params->group_suite == CIPHER_NONE &&
1051 params->key_mgmt_suite == KEY_MGMT_NONE &&
1052 params->wpa_ie_len == 0);
1053 wpa_printf(MSG_DEBUG, "%s: set PRIVACY %u", __func__, privacy);
1054
1055 if (set80211param(drv, IEEE80211_IOC_PRIVACY, privacy) < 0)
1056 return -1;
1057
1058 if (params->wpa_ie_len &&
1059 set80211param(drv, IEEE80211_IOC_WPA,
1060 params->wpa_ie[0] == WLAN_EID_RSN ? 2 : 1) < 0)
1061 return -1;
1062
1063 os_memset(&mlme, 0, sizeof(mlme));
1064 mlme.im_op = IEEE80211_MLME_ASSOC;
6fc6879b
JM		 1065 if (params->ssid != NULL)
1066 os_memcpy(mlme.im_ssid, params->ssid, params->ssid_len);
1067 mlme.im_ssid_len = params->ssid_len;
6fc6879b
JM		 1068 if (params->bssid != NULL)
1069 os_memcpy(mlme.im_macaddr, params->bssid, IEEE80211_ADDR_LEN);
1070 if (set80211var(drv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme)) < 0)
1071 return -1;
4a867032 1072 return ret;
6fc6879b
JM		 1073}
1074
6fc6879b 1075static int
c2e8d0a0 1076wpa_driver_bsd_scan(void *priv, struct wpa_driver_scan_params *params)
6fc6879b 1077{
86b24ea9 1078 struct bsd_driver_data *drv = priv;
c2e8d0a0
JM		 1079 const u8 *ssid = params->ssids[0].ssid;
1080 size_t ssid_len = params->ssids[0].ssid_len;
6fc6879b 1081
42f34a9b
MH		 1082 if (set80211param(drv, IEEE80211_IOC_ROAMING,
1083 IEEE80211_ROAMING_MANUAL) < 0) {
1084 wpa_printf(MSG_ERROR, "%s: failed to set "
1085 "wpa_supplicant-based roaming: %s", __func__,
1086 strerror(errno));
1087 return -1;
1088 }
1089
1090 if (wpa_driver_bsd_set_wpa(drv, 1) < 0) {
1091 wpa_printf(MSG_ERROR, "%s: failed to set wpa: %s", __func__,
1092 strerror(errno));
1093 return -1;
1094 }
1095
6fc6879b 1096 /* NB: interface must be marked UP to do a scan */
e1b1309b 1097 if (bsd_ctrl_iface(drv, 1) < 0)
6fc6879b
JM		 1098 return -1;
1099
1100 /* set desired ssid before scan */
e1b1309b 1101 if (bsd_set_ssid(drv->ifname, drv, ssid, ssid_len) < 0)
6fc6879b
JM		 1102 return -1;
1103
1104 /* NB: net80211 delivers a scan complete event so no need to poll */
1105 return set80211param(drv, IEEE80211_IOC_SCAN_REQ, 0);
1106}
1107
6fc6879b
JM		 1108static void
1109wpa_driver_bsd_event_receive(int sock, void *ctx, void *sock_ctx)
1110{
86b24ea9 1111 struct bsd_driver_data *drv = sock_ctx;
6fc6879b
JM		 1112 char buf[2048];
1113 struct if_announcemsghdr *ifan;
1114 struct if_msghdr *ifm;
1115 struct rt_msghdr *rtm;
1116 union wpa_event_data event;
1117 struct ieee80211_michael_event *mic;
42f34a9b
MH		 1118 struct ieee80211_leave_event *leave;
1119 struct ieee80211_join_event *join;
6fc6879b
JM		 1120 int n;
1121
1122 n = read(sock, buf, sizeof(buf));
1123 if (n < 0) {
1124 if (errno != EINTR && errno != EAGAIN)
1125 perror("read(PF_ROUTE)");
1126 return;
1127 }
1128
1129 rtm = (struct rt_msghdr *) buf;
1130 if (rtm->rtm_version != RTM_VERSION) {
1131 wpa_printf(MSG_DEBUG, "Routing message version %d not "
1132 "understood\n", rtm->rtm_version);
1133 return;
1134 }
1135 os_memset(&event, 0, sizeof(event));
1136 switch (rtm->rtm_type) {
1137 case RTM_IFANNOUNCE:
1138 ifan = (struct if_announcemsghdr *) rtm;
1139 if (ifan->ifan_index != drv->ifindex)
1140 break;
1141 strlcpy(event.interface_status.ifname, drv->ifname,
1142 sizeof(event.interface_status.ifname));
1143 switch (ifan->ifan_what) {
1144 case IFAN_DEPARTURE:
1145 event.interface_status.ievent = EVENT_INTERFACE_REMOVED;
1146 default:
1147 return;
1148 }
1149 wpa_printf(MSG_DEBUG, "RTM_IFANNOUNCE: Interface '%s' %s",
1150 event.interface_status.ifname,
1151 ifan->ifan_what == IFAN_DEPARTURE ?
1152 "removed" : "added");
1153 wpa_supplicant_event(ctx, EVENT_INTERFACE_STATUS, &event);
1154 break;
1155 case RTM_IEEE80211:
1156 ifan = (struct if_announcemsghdr *) rtm;
1157 if (ifan->ifan_index != drv->ifindex)
1158 break;
1159 switch (ifan->ifan_what) {
1160 case RTM_IEEE80211_ASSOC:
1161 case RTM_IEEE80211_REASSOC:
42f34a9b
MH		 1162 if (drv->is_ap)
1163 break;
6fc6879b
JM		 1164 wpa_supplicant_event(ctx, EVENT_ASSOC, NULL);
1165 break;
1166 case RTM_IEEE80211_DISASSOC:
42f34a9b
MH		 1167 if (drv->is_ap)
1168 break;
6fc6879b
JM		 1169 wpa_supplicant_event(ctx, EVENT_DISASSOC, NULL);
1170 break;
1171 case RTM_IEEE80211_SCAN:
42f34a9b
MH		 1172 if (drv->is_ap)
1173 break;
6fc6879b
JM		 1174 wpa_supplicant_event(ctx, EVENT_SCAN_RESULTS, NULL);
1175 break;
42f34a9b
MH		 1176 case RTM_IEEE80211_LEAVE:
1177 leave = (struct ieee80211_leave_event *) &ifan[1];
1178 drv_event_disassoc(ctx, leave->iev_addr);
1179 break;
1180 case RTM_IEEE80211_JOIN:
1181#ifdef RTM_IEEE80211_REJOIN
1182 case RTM_IEEE80211_REJOIN:
1183#endif
1184 join = (struct ieee80211_join_event *) &ifan[1];
e1b1309b 1185 bsd_new_sta(drv, ctx, join->iev_addr);
42f34a9b 1186 break;
6fc6879b
JM		 1187 case RTM_IEEE80211_REPLAY:
1188 /* ignore */
1189 break;
1190 case RTM_IEEE80211_MICHAEL:
1191 mic = (struct ieee80211_michael_event *) &ifan[1];
1192 wpa_printf(MSG_DEBUG,
1193 "Michael MIC failure wireless event: "
1194 "keyix=%u src_addr=" MACSTR, mic->iev_keyix,
1195 MAC2STR(mic->iev_src));
1196
1197 os_memset(&event, 0, sizeof(event));
1198 event.michael_mic_failure.unicast =
1199 !IEEE80211_IS_MULTICAST(mic->iev_dst);
1200 wpa_supplicant_event(ctx, EVENT_MICHAEL_MIC_FAILURE,
1201 &event);
1202 break;
1203 }
1204 break;
1205 case RTM_IFINFO:
1206 ifm = (struct if_msghdr *) rtm;
1207 if (ifm->ifm_index != drv->ifindex)
1208 break;
1209 if ((rtm->rtm_flags & RTF_UP) == 0) {
1210 strlcpy(event.interface_status.ifname, drv->ifname,
1211 sizeof(event.interface_status.ifname));
1212 event.interface_status.ievent = EVENT_INTERFACE_REMOVED;
1213 wpa_printf(MSG_DEBUG, "RTM_IFINFO: Interface '%s' DOWN",
1214 event.interface_status.ifname);
1215 wpa_supplicant_event(ctx, EVENT_INTERFACE_STATUS, &event);
1216 }
1217 break;
1218 }
1219}
1220
a65f4a57
MH		 1221static void
1222wpa_driver_bsd_add_scan_entry(struct wpa_scan_results *res,
1223 struct ieee80211req_scan_result *sr)
6fc6879b 1224{
a65f4a57
MH		 1225 struct wpa_scan_res *result, **tmp;
1226 size_t extra_len;
1227 u8 *pos;
6fc6879b 1228
a65f4a57
MH		 1229 extra_len = 2 + sr->isr_ssid_len;
1230 extra_len += 2 + sr->isr_nrates;
1231 extra_len += 3; /* ERP IE */
1232 extra_len += sr->isr_ie_len;
6fc6879b 1233
a65f4a57
MH		 1234 result = os_zalloc(sizeof(*result) + extra_len);
1235 if (result == NULL)
1236 return;
1237 os_memcpy(result->bssid, sr->isr_bssid, ETH_ALEN);
1238 result->freq = sr->isr_freq;
1239 result->beacon_int = sr->isr_intval;
1240 result->caps = sr->isr_capinfo;
1241 result->qual = sr->isr_rssi;
1242 result->noise = sr->isr_noise;
6fc6879b 1243
a65f4a57 1244 pos = (u8 *)(result + 1);
6fc6879b 1245
a65f4a57
MH		 1246 *pos++ = WLAN_EID_SSID;
1247 *pos++ = sr->isr_ssid_len;
1248 os_memcpy(pos, sr + 1, sr->isr_ssid_len);
1249 pos += sr->isr_ssid_len;
6fc6879b 1250
a65f4a57
MH		 1251 /*
1252 * Deal all rates as supported rate.
1253 * Because net80211 doesn't report extended supported rate or not.
1254 */
1255 *pos++ = WLAN_EID_SUPP_RATES;
1256 *pos++ = sr->isr_nrates;
1257 os_memcpy(pos, sr->isr_rates, sr->isr_nrates);
1258 pos += sr->isr_nrates;
6fc6879b 1259
a65f4a57
MH		 1260 *pos++ = WLAN_EID_ERP_INFO;
1261 *pos++ = 1;
1262 *pos++ = sr->isr_erp;
6fc6879b 1263
a65f4a57
MH		 1264 os_memcpy(pos, (u8 *)(sr + 1) + sr->isr_ssid_len, sr->isr_ie_len);
1265 pos += sr->isr_ie_len;
6fc6879b 1266
a65f4a57
MH		 1267 result->ie_len = pos - (u8 *)(result + 1);
1268
1269 tmp = os_realloc(res->res,
1270 (res->num + 1) * sizeof(struct wpa_scan_res *));
1271 if (tmp == NULL) {
1272 os_free(result);
1273 return;
1274 }
1275 tmp[res->num++] = result;
1276 res->res = tmp;
6fc6879b
JM		 1277}
1278
a65f4a57
MH		 1279struct wpa_scan_results *
1280wpa_driver_bsd_get_scan_results2(void *priv)
6fc6879b 1281{
6fc6879b 1282 struct ieee80211req_scan_result *sr;
a65f4a57
MH		 1283 struct wpa_scan_results *res;
1284 int len, rest;
1285 uint8_t buf[24*1024], *pos;
6fc6879b 1286
e1b1309b 1287 len = get80211var(priv, IEEE80211_IOC_SCAN_RESULTS, buf, 24*1024);
6fc6879b 1288 if (len < 0)
a65f4a57
MH		 1289 return NULL;
1290
1291 res = os_zalloc(sizeof(*res));
1292 if (res == NULL)
1293 return NULL;
6fc6879b 1294
a65f4a57
MH		 1295 pos = buf;
1296 rest = len;
1297 while (rest >= sizeof(struct ieee80211req_scan_result)) {
1298 sr = (struct ieee80211req_scan_result *)pos;
1299 wpa_driver_bsd_add_scan_entry(res, sr);
1300 pos += sr->isr_len;
1301 rest -= sr->isr_len;
6fc6879b 1302 }
6fc6879b 1303
a65f4a57
MH		 1304 wpa_printf(MSG_DEBUG, "Received %d bytes of scan results (%lu BSSes)",
1305 len, (unsigned long)res->num);
6fc6879b 1306
a65f4a57 1307 return res;
6fc6879b
JM		 1308}
1309
86b24ea9 1310static int wpa_driver_bsd_capa(struct bsd_driver_data *drv)
42f34a9b
MH		 1311{
1312 /* For now, assume TKIP, CCMP, WPA, WPA2 are supported */
1313 drv->capa.key_mgmt = WPA_DRIVER_CAPA_KEY_MGMT_WPA |
1314 WPA_DRIVER_CAPA_KEY_MGMT_WPA_PSK |
1315 WPA_DRIVER_CAPA_KEY_MGMT_WPA2 |
1316 WPA_DRIVER_CAPA_KEY_MGMT_WPA2_PSK;
1317 drv->capa.enc = WPA_DRIVER_CAPA_ENC_WEP40 |
1318 WPA_DRIVER_CAPA_ENC_WEP104 |
1319 WPA_DRIVER_CAPA_ENC_TKIP |
1320 WPA_DRIVER_CAPA_ENC_CCMP;
1321 drv->capa.auth = WPA_DRIVER_AUTH_OPEN |
1322 WPA_DRIVER_AUTH_SHARED |
1323 WPA_DRIVER_AUTH_LEAP;
1324
1325 //drv->capa.max_scan_ssids = info.max_scan_ssids;
1326 drv->capa.flags |= WPA_DRIVER_FLAGS_AP;
1327
1328 return 0;
1329}
1330
6fc6879b
JM		 1331static void *
1332wpa_driver_bsd_init(void *ctx, const char *ifname)
1333{
1334#define GETPARAM(drv, param, v) \
1335 (((v) = get80211param(drv, param)) != -1)
86b24ea9 1336 struct bsd_driver_data *drv;
6fc6879b
JM		 1337
1338 drv = os_zalloc(sizeof(*drv));
1339 if (drv == NULL)
1340 return NULL;
1341 /*
1342 * NB: We require the interface name be mappable to an index.
1343 * This implies we do not support having wpa_supplicant
1344 * wait for an interface to appear. This seems ok; that
1345 * doesn't belong here; it's really the job of devd.
1346 */
1347 drv->ifindex = if_nametoindex(ifname);
1348 if (drv->ifindex == 0) {
1349 wpa_printf(MSG_DEBUG, "%s: interface %s does not exist",
1350 __func__, ifname);
1351 goto fail1;
1352 }
1353 drv->sock = socket(PF_INET, SOCK_DGRAM, 0);
1354 if (drv->sock < 0)
1355 goto fail1;
1356 drv->route = socket(PF_ROUTE, SOCK_RAW, 0);
1357 if (drv->route < 0)
1358 goto fail;
1359 eloop_register_read_sock(drv->route,
1360 wpa_driver_bsd_event_receive, ctx, drv);
1361
1362 drv->ctx = ctx;
1363 os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
1364
42f34a9b 1365 /* Down interface during setup. */
e1b1309b 1366 if (bsd_ctrl_iface(drv, 0) < 0)
42f34a9b
MH		 1367 goto fail;
1368
6fc6879b
JM		 1369 if (!GETPARAM(drv, IEEE80211_IOC_ROAMING, drv->prev_roaming)) {
1370 wpa_printf(MSG_DEBUG, "%s: failed to get roaming state: %s",
1371 __func__, strerror(errno));
1372 goto fail;
1373 }
1374 if (!GETPARAM(drv, IEEE80211_IOC_PRIVACY, drv->prev_privacy)) {
1375 wpa_printf(MSG_DEBUG, "%s: failed to get privacy state: %s",
1376 __func__, strerror(errno));
1377 goto fail;
1378 }
1379 if (!GETPARAM(drv, IEEE80211_IOC_WPA, drv->prev_wpa)) {
1380 wpa_printf(MSG_DEBUG, "%s: failed to get wpa state: %s",
1381 __func__, strerror(errno));
1382 goto fail;
1383 }
5197244a 1384
e1b1309b 1385 if (bsd_set_mediaopt(drv, IFM_OMASK, 0 /* STA */) < 0) {
5197244a
MH		 1386 wpa_printf(MSG_ERROR, "%s: failed to set operation mode",
1387 __func__);
1388 goto fail;
1389 }
6fc6879b 1390
42f34a9b 1391 if (wpa_driver_bsd_capa(drv))
6fc6879b 1392 goto fail;
4a867032 1393
6fc6879b
JM		 1394 return drv;
1395fail:
1396 close(drv->sock);
1397fail1:
1398 os_free(drv);
1399 return NULL;
1400#undef GETPARAM
1401}
1402
1403static void
1404wpa_driver_bsd_deinit(void *priv)
1405{
86b24ea9 1406 struct bsd_driver_data *drv = priv;
6fc6879b 1407
4a867032 1408 wpa_driver_bsd_set_wpa(drv, 0);
6fc6879b
JM		 1409 eloop_unregister_read_sock(drv->route);
1410
1411 /* NB: mark interface down */
e1b1309b 1412 bsd_ctrl_iface(drv, 0);
6fc6879b
JM		 1413
1414 wpa_driver_bsd_set_wpa_internal(drv, drv->prev_wpa, drv->prev_privacy);
1415 if (set80211param(drv, IEEE80211_IOC_ROAMING, drv->prev_roaming) < 0)
1416 wpa_printf(MSG_DEBUG, "%s: failed to restore roaming state",
1417 __func__);
1418
42f34a9b
MH		 1419 if (drv->sock_xmit != NULL)
1420 l2_packet_deinit(drv->sock_xmit);
6fc6879b
JM		 1421 (void) close(drv->route); /* ioctl socket */
1422 (void) close(drv->sock); /* event socket */
1423 os_free(drv);
1424}
1425
42f34a9b
MH		 1426static int
1427wpa_driver_bsd_get_capa(void *priv, struct wpa_driver_capa *capa)
1428{
86b24ea9 1429 struct bsd_driver_data *drv = priv;
42f34a9b
MH		 1430
1431 os_memcpy(capa, &drv->capa, sizeof(*capa));
1432 return 0;
1433}
e1b1309b 1434#endif /* HOSTAPD */
42f34a9b 1435
6fc6879b
JM		 1436
1437const struct wpa_driver_ops wpa_driver_bsd_ops = {
1438 .name = "bsd",
66d4085f 1439 .desc = "BSD 802.11 support",
e1b1309b
MH		 1440#ifdef HOSTAPD
1441 .hapd_init = bsd_init,
1442 .hapd_deinit = bsd_deinit,
1443 .set_privacy = bsd_set_privacy,
1444 .get_seqnum = bsd_get_seqnum,
1445 .flush = bsd_flush,
1446 .set_generic_elem = bsd_set_opt_ie,
1447 .read_sta_data = bsd_read_sta_driver_data,
1448 .sta_disassoc = bsd_sta_disassoc,
1449 .sta_deauth = bsd_sta_deauth,
1450 .set_freq = hostapd_bsd_set_freq,
1451#else /* HOSTAPD */
6fc6879b
JM		 1452 .init = wpa_driver_bsd_init,
1453 .deinit = wpa_driver_bsd_deinit,
1454 .get_bssid = wpa_driver_bsd_get_bssid,
1455 .get_ssid = wpa_driver_bsd_get_ssid,
6fc6879b 1456 .set_countermeasures = wpa_driver_bsd_set_countermeasures,
c2e8d0a0 1457 .scan2 = wpa_driver_bsd_scan,
a65f4a57 1458 .get_scan_results2 = wpa_driver_bsd_get_scan_results2,
6fc6879b
JM		 1459 .deauthenticate = wpa_driver_bsd_deauthenticate,
1460 .disassociate = wpa_driver_bsd_disassociate,
1461 .associate = wpa_driver_bsd_associate,
42f34a9b 1462 .get_capa = wpa_driver_bsd_get_capa,
c5121837 1463#endif /* HOSTAPD */
e1b1309b
MH		 1464 .set_key = bsd_set_key,
1465 .set_ieee8021x = bsd_set_ieee8021x,
1466 .hapd_set_ssid = bsd_set_ssid,
1467 .hapd_get_ssid = bsd_get_ssid,
1468 .hapd_send_eapol = bsd_send_eapol,
1469 .sta_set_flags = bsd_set_sta_authorized,
1470};
Unnamed repository; edit this file 'description' to name the repository.