Implement management frame TX for wpa_supplicant AP mode
[wpasupplicant] / wpa_supplicant / ap.c
1 /*
2  * WPA Supplicant - Basic AP mode support routines
3  * Copyright (c) 2003-2009, Jouni Malinen <j@w1.fi>
4  * Copyright (c) 2009, Atheros Communications
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
18 #include "common.h"
19 #include "../hostapd/hostapd.h"
20 #include "../hostapd/config.h"
21 #include "../hostapd/driver.h"
22 #ifdef NEED_MLME
23 #include "../hostapd/ieee802_11.h"
24 #endif /* NEED_MLME */
25 #include "eap_common/eap_defs.h"
26 #include "eap_server/eap_methods.h"
27 #include "eap_common/eap_wsc_common.h"
28 #include "config_ssid.h"
29 #include "wpa_supplicant_i.h"
30 #include "driver_i.h"
31 #include "ap.h"
32
33
34 int hostapd_for_each_interface(int (*cb)(struct hostapd_iface *iface,
35                                          void *ctx), void *ctx)
36 {
37         /* TODO */
38         return 0;
39 }
40
41
42 int hostapd_ctrl_iface_init(struct hostapd_data *hapd)
43 {
44         return 0;
45 }
46
47
48 void hostapd_ctrl_iface_deinit(struct hostapd_data *hapd)
49 {
50 }
51
52
53 struct ap_driver_data {
54         struct hostapd_data *hapd;
55 };
56
57
58 static void * ap_driver_init(struct hostapd_data *hapd)
59 {
60         struct ap_driver_data *drv;
61
62         drv = os_zalloc(sizeof(struct ap_driver_data));
63         if (drv == NULL) {
64                 wpa_printf(MSG_ERROR, "Could not allocate memory for AP "
65                            "driver data");
66                 return NULL;
67         }
68         drv->hapd = hapd;
69
70         return drv;
71 }
72
73
74 static void ap_driver_deinit(void *priv)
75 {
76         struct ap_driver_data *drv = priv;
77
78         os_free(drv);
79 }
80
81
82 static int ap_driver_send_ether(void *priv, const u8 *dst, const u8 *src,
83                                 u16 proto, const u8 *data, size_t data_len)
84 {
85         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
86         return -1;
87 }
88
89
90 static int ap_driver_set_key(const char *iface, void *priv, wpa_alg alg,
91                              const u8 *addr, int key_idx, int set_tx,
92                              const u8 *seq, size_t seq_len, const u8 *key,
93                              size_t key_len)
94 {
95         struct ap_driver_data *drv = priv;
96         struct wpa_supplicant *wpa_s = drv->hapd->iface->owner;
97         return wpa_drv_set_key(wpa_s, alg, addr, key_idx, set_tx, seq, seq_len,
98                                key, key_len);
99 }
100
101
102 static int ap_driver_get_seqnum(const char *iface, void *priv, const u8 *addr,
103                                 int idx, u8 *seq)
104 {
105         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
106         return -1;
107 }
108
109
110 static int ap_driver_flush(void *priv)
111 {
112         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
113         return -1;
114 }
115
116
117 static int ap_driver_read_sta_data(void *priv,
118                                    struct hostap_sta_driver_data *data,
119                                    const u8 *addr)
120 {
121         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
122         return -1;
123 }
124
125
126 static int ap_driver_sta_set_flags(void *priv, const u8 *addr, int total_flags,
127                                    int flags_or, int flags_and)
128 {
129         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
130         return -1;
131 }
132
133
134 static int ap_driver_sta_deauth(void *priv, const u8 *addr, int reason)
135 {
136         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
137         return -1;
138 }
139
140
141 static int ap_driver_sta_disassoc(void *priv, const u8 *addr, int reason)
142 {
143         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
144         return -1;
145 }
146
147
148 static int ap_driver_sta_remove(void *priv, const u8 *addr)
149 {
150         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
151         return -1;
152 }
153
154
155 static int ap_driver_send_mgmt_frame(void *priv, const void *data, size_t len,
156                                      int flags)
157 {
158         struct ap_driver_data *drv = priv;
159         struct wpa_supplicant *wpa_s = drv->hapd->iface->owner;
160         return wpa_drv_send_mlme(wpa_s, data, len);
161 }
162
163
164 static int ap_driver_sta_add(const char *ifname, void *priv,
165                              struct hostapd_sta_add_params *params)
166 {
167         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
168         return -1;
169 }
170
171
172 static int ap_driver_get_inact_sec(void *priv, const u8 *addr)
173 {
174         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
175         return -1;
176 }
177
178
179 static int ap_driver_set_freq(void *priv, struct hostapd_freq_params *freq)
180 {
181         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
182         return 0;
183 }
184
185
186 static int ap_driver_set_beacon(const char *iface, void *priv,
187                                 const u8 *head, size_t head_len,
188                                 const u8 *tail, size_t tail_len,
189                                 int dtim_period)
190 {
191         struct ap_driver_data *drv = priv;
192         struct wpa_supplicant *wpa_s = drv->hapd->iface->owner;
193         return wpa_drv_set_beacon(wpa_s, head, head_len, tail, tail_len,
194                                   dtim_period);
195 }
196
197
198 static int ap_driver_set_beacon_int(void *priv, int value)
199 {
200         struct ap_driver_data *drv = priv;
201         struct wpa_supplicant *wpa_s = drv->hapd->iface->owner;
202         return wpa_drv_set_beacon_int(wpa_s, value);
203 }
204
205
206 static int ap_driver_set_cts_protect(void *priv, int value)
207 {
208         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
209         return -1;
210 }
211
212
213 static int ap_driver_set_preamble(void *priv, int value)
214 {
215         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
216         return -1;
217 }
218
219
220 static int ap_driver_set_short_slot_time(void *priv, int value)
221 {
222         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
223         return -1;
224 }
225
226
227 static int ap_driver_set_tx_queue_params(void *priv, int queue, int aifs,
228                                          int cw_min, int cw_max,
229                                          int burst_time)
230 {
231         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
232         return -1;
233 }
234
235
236 static struct hostapd_hw_modes *ap_driver_get_hw_feature_data(void *priv,
237                                                               u16 *num_modes,
238                                                               u16 *flags)
239 {
240         wpa_printf(MSG_DEBUG, "AP TODO: %s", __func__);
241         return NULL;
242 }
243
244
245 static struct hapd_driver_ops ap_driver_ops =
246 {
247         .name = "wpa_supplicant",
248         .init = ap_driver_init,
249         .deinit = ap_driver_deinit,
250         .send_ether = ap_driver_send_ether,
251         .set_key = ap_driver_set_key,
252         .get_seqnum = ap_driver_get_seqnum,
253         .flush = ap_driver_flush,
254         .read_sta_data = ap_driver_read_sta_data,
255         .sta_set_flags = ap_driver_sta_set_flags,
256         .sta_deauth = ap_driver_sta_deauth,
257         .sta_disassoc = ap_driver_sta_disassoc,
258         .sta_remove = ap_driver_sta_remove,
259         .send_mgmt_frame = ap_driver_send_mgmt_frame,
260         .sta_add = ap_driver_sta_add,
261         .get_inact_sec = ap_driver_get_inact_sec,
262         .set_freq = ap_driver_set_freq,
263         .set_beacon = ap_driver_set_beacon,
264         .set_beacon_int = ap_driver_set_beacon_int,
265         .set_cts_protect = ap_driver_set_cts_protect,
266         .set_preamble = ap_driver_set_preamble,
267         .set_short_slot_time = ap_driver_set_short_slot_time,
268         .set_tx_queue_params = ap_driver_set_tx_queue_params,
269         .get_hw_feature_data = ap_driver_get_hw_feature_data,
270 };
271
272 struct hapd_driver_ops *hostapd_drivers[] =
273 {
274         &ap_driver_ops,
275         NULL
276 };
277
278
279 static int wpa_supplicant_conf_ap(struct wpa_supplicant *wpa_s,
280                                   struct wpa_ssid *ssid,
281                                   struct hostapd_config *conf)
282 {
283         struct hostapd_bss_config *bss = &conf->bss[0];
284
285         os_strlcpy(bss->iface, wpa_s->ifname, sizeof(bss->iface));
286
287         if (ssid->frequency == 0) {
288                 /* default channel 11 */
289                 conf->hw_mode = HOSTAPD_MODE_IEEE80211G;
290                 conf->channel = 11;
291         } else if (ssid->frequency >= 2412 && ssid->frequency <= 2472) {
292                 conf->hw_mode = HOSTAPD_MODE_IEEE80211G;
293                 conf->channel = (ssid->frequency - 2407) / 5;
294         } else if ((ssid->frequency >= 5180 && ssid->frequency <= 5240) ||
295                    (ssid->frequency >= 5745 && ssid->frequency <= 5825)) {
296                 conf->hw_mode = HOSTAPD_MODE_IEEE80211G;
297                 conf->channel = (ssid->frequency - 5000) / 5;
298         } else {
299                 wpa_printf(MSG_ERROR, "Unsupported AP mode frequency: %d MHz",
300                            ssid->frequency);
301                 return -1;
302         }
303
304         /* TODO: enable HT if driver supports it;
305          * drop to 11b if driver does not support 11g */
306
307         if (ssid->ssid_len == 0) {
308                 wpa_printf(MSG_ERROR, "No SSID configured for AP mode");
309                 return -1;
310         }
311         os_memcpy(bss->ssid.ssid, ssid->ssid, ssid->ssid_len);
312         bss->ssid.ssid[ssid->ssid_len] = '\0';
313         bss->ssid.ssid_len = ssid->ssid_len;
314         bss->ssid.ssid_set = 1;
315
316         if (wpa_key_mgmt_wpa_psk(ssid->key_mgmt))
317                 bss->wpa = ssid->proto;
318         bss->wpa_key_mgmt = ssid->key_mgmt;
319         bss->wpa_pairwise = ssid->pairwise_cipher;
320         if (ssid->passphrase) {
321                 bss->ssid.wpa_passphrase = os_strdup(ssid->passphrase);
322                 if (hostapd_setup_wpa_psk(bss))
323                         return -1;
324         } else if (ssid->psk_set) {
325                 os_free(bss->ssid.wpa_psk);
326                 bss->ssid.wpa_psk = os_zalloc(sizeof(struct hostapd_wpa_psk));
327                 if (bss->ssid.wpa_psk == NULL)
328                         return -1;
329                 os_memcpy(bss->ssid.wpa_psk->psk, ssid->psk, PMK_LEN);
330                 bss->ssid.wpa_psk->group = 1;
331         }
332
333         return 0;
334 }
335
336
337 int wpa_supplicant_create_ap(struct wpa_supplicant *wpa_s,
338                              struct wpa_ssid *ssid)
339 {
340         struct wpa_driver_associate_params params;
341         struct hostapd_iface *hapd_iface;
342         struct hostapd_config *conf;
343         size_t i;
344
345         if (ssid->ssid == NULL || ssid->ssid_len == 0) {
346                 wpa_printf(MSG_ERROR, "No SSID configured for AP mode");
347                 return -1;
348         }
349
350         wpa_supplicant_ap_deinit(wpa_s);
351
352         wpa_printf(MSG_DEBUG, "Setting up AP (SSID='%s')",
353                    wpa_ssid_txt(ssid->ssid, ssid->ssid_len));
354
355         os_memset(&params, 0, sizeof(params));
356         params.ssid = ssid->ssid;
357         params.ssid_len = ssid->ssid_len;
358         params.mode = ssid->mode;
359         params.freq = ssid->frequency;
360
361         if (wpa_drv_associate(wpa_s, &params) < 0) {
362                 wpa_msg(wpa_s, MSG_INFO, "Failed to start AP functionality");
363                 return -1;
364         }
365
366         wpa_s->ap_iface = hapd_iface = os_zalloc(sizeof(*wpa_s->ap_iface));
367         if (hapd_iface == NULL)
368                 return -1;
369         hapd_iface->owner = wpa_s;
370
371         wpa_s->ap_iface->conf = conf = hostapd_config_defaults();
372         if (conf == NULL) {
373                 wpa_supplicant_ap_deinit(wpa_s);
374                 return -1;
375         }
376
377         if (wpa_supplicant_conf_ap(wpa_s, ssid, conf)) {
378                 wpa_printf(MSG_ERROR, "Failed to create AP configuration");
379                 wpa_supplicant_ap_deinit(wpa_s);
380                 return -1;
381         }
382
383         hapd_iface->num_bss = conf->num_bss;
384         hapd_iface->bss = os_zalloc(conf->num_bss *
385                                     sizeof(struct hostapd_data *));
386         if (hapd_iface->bss == NULL) {
387                 wpa_supplicant_ap_deinit(wpa_s);
388                 return -1;
389         }
390
391         for (i = 0; i < conf->num_bss; i++) {
392                 hapd_iface->bss[i] =
393                         hostapd_alloc_bss_data(hapd_iface, conf,
394                                                &conf->bss[i]);
395                 if (hapd_iface->bss[i] == NULL) {
396                         wpa_supplicant_ap_deinit(wpa_s);
397                         return -1;
398                 }
399         }
400
401         if (hostapd_setup_interface(wpa_s->ap_iface)) {
402                 wpa_printf(MSG_ERROR, "Failed to initialize AP interface");
403                 wpa_supplicant_ap_deinit(wpa_s);
404                 return -1;
405         }
406
407         return 0;
408 }
409
410
411 void wpa_supplicant_ap_deinit(struct wpa_supplicant *wpa_s)
412 {
413         if (wpa_s->ap_iface == NULL)
414                 return;
415
416         hostapd_interface_deinit(wpa_s->ap_iface);
417         wpa_s->ap_iface = NULL;
418 }
419
420
421 void ap_tx_status(void *ctx, const u8 *addr,
422                   const u8 *buf, size_t len, int ack)
423 {
424         struct wpa_supplicant *wpa_s = ctx;
425         hostapd_tx_status(wpa_s->ap_iface->bss[0], addr, buf, len, ack);
426 }
427
428
429 void ap_rx_from_unknown_sta(void *ctx, const u8 *addr)
430 {
431         struct wpa_supplicant *wpa_s = ctx;
432         ap_rx_from_unknown_sta(wpa_s->ap_iface->bss[0], addr);
433 }
434
435
436 #ifdef NEED_MLME
437 void ap_mgmt_rx(void *ctx, u8 *buf, size_t len, u16 stype,
438                 struct hostapd_frame_info *fi)
439 {
440         struct wpa_supplicant *wpa_s = ctx;
441         ieee802_11_mgmt(wpa_s->ap_iface->bss[0], buf, len, stype, fi);
442 }
443
444
445 void ap_mgmt_tx_cb(void *ctx, u8 *buf, size_t len, u16 stype, int ok)
446 {
447         struct wpa_supplicant *wpa_s = ctx;
448         ieee802_11_mgmt_cb(wpa_s->ap_iface->bss[0], buf, len, stype, ok);
449 }
450 #endif /* NEED_MLME */