blob: 0d86b4a4f01be48fc8318504c80f096daa318493 [file] [log] [blame]
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001/*
2 * hostapd / UNIX domain socket -based control interface
Dmitry Shmidt807291d2015-01-27 13:40:23 -08003 * Copyright (c) 2004-2015, Jouni Malinen <j@w1.fi>
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07004 *
Dmitry Shmidtc5ec7f52012-03-06 16:33:24 -08005 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07007 */
8
9#include "utils/includes.h"
10
11#ifndef CONFIG_NATIVE_WINDOWS
12
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -080013#ifdef CONFIG_TESTING_OPTIONS
14#include <net/ethernet.h>
15#include <netinet/ip.h>
16#endif /* CONFIG_TESTING_OPTIONS */
17
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070018#include <sys/un.h>
19#include <sys/stat.h>
20#include <stddef.h>
21
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -080022#ifdef CONFIG_CTRL_IFACE_UDP
23#include <netdb.h>
24#endif /* CONFIG_CTRL_IFACE_UDP */
25
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070026#include "utils/common.h"
27#include "utils/eloop.h"
Dmitry Shmidt4ae50e62016-06-27 13:48:39 -070028#include "utils/module_tests.h"
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070029#include "common/version.h"
30#include "common/ieee802_11_defs.h"
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -080031#include "common/ctrl_iface_common.h"
Dmitry Shmidtff787d52015-01-12 13:01:47 -080032#include "crypto/tls.h"
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070033#include "drivers/driver.h"
Dmitry Shmidtd80a4012015-11-05 16:35:40 -080034#include "eapol_auth/eapol_auth_sm.h"
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070035#include "radius/radius_client.h"
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -080036#include "radius/radius_server.h"
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -080037#include "l2_packet/l2_packet.h"
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070038#include "ap/hostapd.h"
39#include "ap/ap_config.h"
40#include "ap/ieee802_1x.h"
41#include "ap/wpa_auth.h"
42#include "ap/ieee802_11.h"
43#include "ap/sta_info.h"
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070044#include "ap/wps_hostapd.h"
45#include "ap/ctrl_iface_ap.h"
46#include "ap/ap_drv_ops.h"
Dmitry Shmidtf21452a2014-02-26 10:55:25 -080047#include "ap/hs20.h"
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -080048#include "ap/wnm_ap.h"
Dmitry Shmidtf7e0a992013-05-23 11:03:10 -070049#include "ap/wpa_auth.h"
Dmitry Shmidt7f656022015-02-25 14:36:37 -080050#include "ap/beacon.h"
Dmitry Shmidt849734c2016-05-27 09:59:01 -070051#include "ap/neighbor_db.h"
52#include "ap/rrm.h"
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070053#include "wps/wps_defs.h"
54#include "wps/wps.h"
Dmitry Shmidtd80a4012015-11-05 16:35:40 -080055#include "fst/fst_ctrl_iface.h"
Dmitry Shmidt04949592012-07-19 12:16:46 -070056#include "config_file.h"
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070057#include "ctrl_iface.h"
58
59
Dmitry Shmidtd80a4012015-11-05 16:35:40 -080060#define HOSTAPD_CLI_DUP_VALUE_MAX_LEN 256
61
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -080062#ifdef CONFIG_CTRL_IFACE_UDP
63#define COOKIE_LEN 8
64static unsigned char cookie[COOKIE_LEN];
65static unsigned char gcookie[COOKIE_LEN];
66#define HOSTAPD_CTRL_IFACE_PORT 8877
67#define HOSTAPD_CTRL_IFACE_PORT_LIMIT 50
68#define HOSTAPD_GLOBAL_CTRL_IFACE_PORT 8878
69#define HOSTAPD_GLOBAL_CTRL_IFACE_PORT_LIMIT 50
70#endif /* CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070071
72static void hostapd_ctrl_iface_send(struct hostapd_data *hapd, int level,
Anton Nayshtutf715e8d2014-11-16 16:52:49 +020073 enum wpa_msg_type type,
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070074 const char *buf, size_t len);
75
76
77static int hostapd_ctrl_iface_attach(struct hostapd_data *hapd,
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -080078 struct sockaddr_storage *from,
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070079 socklen_t fromlen)
80{
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -080081 return ctrl_iface_attach(&hapd->ctrl_dst, from, fromlen);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070082}
83
84
85static int hostapd_ctrl_iface_detach(struct hostapd_data *hapd,
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -080086 struct sockaddr_storage *from,
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070087 socklen_t fromlen)
88{
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -080089 return ctrl_iface_detach(&hapd->ctrl_dst, from, fromlen);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070090}
91
92
93static int hostapd_ctrl_iface_level(struct hostapd_data *hapd,
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -080094 struct sockaddr_storage *from,
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070095 socklen_t fromlen,
96 char *level)
97{
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -080098 return ctrl_iface_level(&hapd->ctrl_dst, from, fromlen, level);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -070099}
100
101
102static int hostapd_ctrl_iface_new_sta(struct hostapd_data *hapd,
103 const char *txtaddr)
104{
105 u8 addr[ETH_ALEN];
106 struct sta_info *sta;
107
108 wpa_printf(MSG_DEBUG, "CTRL_IFACE NEW_STA %s", txtaddr);
109
110 if (hwaddr_aton(txtaddr, addr))
111 return -1;
112
113 sta = ap_get_sta(hapd, addr);
114 if (sta)
115 return 0;
116
117 wpa_printf(MSG_DEBUG, "Add new STA " MACSTR " based on ctrl_iface "
118 "notification", MAC2STR(addr));
119 sta = ap_sta_add(hapd, addr);
120 if (sta == NULL)
121 return -1;
122
123 hostapd_new_assoc_sta(hapd, sta, 0);
124 return 0;
125}
126
127
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -0700128#ifdef CONFIG_IEEE80211W
129#ifdef NEED_AP_MLME
130static int hostapd_ctrl_iface_sa_query(struct hostapd_data *hapd,
131 const char *txtaddr)
132{
133 u8 addr[ETH_ALEN];
134 u8 trans_id[WLAN_SA_QUERY_TR_ID_LEN];
135
136 wpa_printf(MSG_DEBUG, "CTRL_IFACE SA_QUERY %s", txtaddr);
137
138 if (hwaddr_aton(txtaddr, addr) ||
139 os_get_random(trans_id, WLAN_SA_QUERY_TR_ID_LEN) < 0)
140 return -1;
141
142 ieee802_11_send_sa_query_req(hapd, addr, trans_id);
143
144 return 0;
145}
146#endif /* NEED_AP_MLME */
147#endif /* CONFIG_IEEE80211W */
148
149
150#ifdef CONFIG_WPS
151static int hostapd_ctrl_iface_wps_pin(struct hostapd_data *hapd, char *txt)
152{
153 char *pin = os_strchr(txt, ' ');
154 char *timeout_txt;
155 int timeout;
156 u8 addr_buf[ETH_ALEN], *addr = NULL;
157 char *pos;
158
159 if (pin == NULL)
160 return -1;
161 *pin++ = '\0';
162
163 timeout_txt = os_strchr(pin, ' ');
164 if (timeout_txt) {
165 *timeout_txt++ = '\0';
166 timeout = atoi(timeout_txt);
167 pos = os_strchr(timeout_txt, ' ');
168 if (pos) {
169 *pos++ = '\0';
170 if (hwaddr_aton(pos, addr_buf) == 0)
171 addr = addr_buf;
172 }
173 } else
174 timeout = 0;
175
176 return hostapd_wps_add_pin(hapd, addr, txt, pin, timeout);
177}
178
179
180static int hostapd_ctrl_iface_wps_check_pin(
181 struct hostapd_data *hapd, char *cmd, char *buf, size_t buflen)
182{
183 char pin[9];
184 size_t len;
185 char *pos;
186 int ret;
187
188 wpa_hexdump_ascii_key(MSG_DEBUG, "WPS_CHECK_PIN",
189 (u8 *) cmd, os_strlen(cmd));
190 for (pos = cmd, len = 0; *pos != '\0'; pos++) {
191 if (*pos < '0' || *pos > '9')
192 continue;
193 pin[len++] = *pos;
194 if (len == 9) {
195 wpa_printf(MSG_DEBUG, "WPS: Too long PIN");
196 return -1;
197 }
198 }
199 if (len != 4 && len != 8) {
200 wpa_printf(MSG_DEBUG, "WPS: Invalid PIN length %d", (int) len);
201 return -1;
202 }
203 pin[len] = '\0';
204
205 if (len == 8) {
206 unsigned int pin_val;
207 pin_val = atoi(pin);
208 if (!wps_pin_valid(pin_val)) {
209 wpa_printf(MSG_DEBUG, "WPS: Invalid checksum digit");
210 ret = os_snprintf(buf, buflen, "FAIL-CHECKSUM\n");
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -0800211 if (os_snprintf_error(buflen, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -0700212 return -1;
213 return ret;
214 }
215 }
216
217 ret = os_snprintf(buf, buflen, "%s", pin);
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -0800218 if (os_snprintf_error(buflen, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -0700219 return -1;
220
221 return ret;
222}
223
224
Dmitry Shmidt04949592012-07-19 12:16:46 -0700225#ifdef CONFIG_WPS_NFC
226static int hostapd_ctrl_iface_wps_nfc_tag_read(struct hostapd_data *hapd,
227 char *pos)
228{
229 size_t len;
230 struct wpabuf *buf;
231 int ret;
232
233 len = os_strlen(pos);
234 if (len & 0x01)
235 return -1;
236 len /= 2;
237
238 buf = wpabuf_alloc(len);
239 if (buf == NULL)
240 return -1;
241 if (hexstr2bin(pos, wpabuf_put(buf, len), len) < 0) {
242 wpabuf_free(buf);
243 return -1;
244 }
245
246 ret = hostapd_wps_nfc_tag_read(hapd, buf);
247 wpabuf_free(buf);
248
249 return ret;
250}
251
252
253static int hostapd_ctrl_iface_wps_nfc_config_token(struct hostapd_data *hapd,
254 char *cmd, char *reply,
255 size_t max_len)
256{
257 int ndef;
258 struct wpabuf *buf;
259 int res;
260
261 if (os_strcmp(cmd, "WPS") == 0)
262 ndef = 0;
263 else if (os_strcmp(cmd, "NDEF") == 0)
264 ndef = 1;
265 else
266 return -1;
267
268 buf = hostapd_wps_nfc_config_token(hapd, ndef);
269 if (buf == NULL)
270 return -1;
271
272 res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
273 wpabuf_len(buf));
274 reply[res++] = '\n';
275 reply[res] = '\0';
276
277 wpabuf_free(buf);
278
279 return res;
280}
281
282
283static int hostapd_ctrl_iface_wps_nfc_token_gen(struct hostapd_data *hapd,
284 char *reply, size_t max_len,
285 int ndef)
286{
287 struct wpabuf *buf;
288 int res;
289
290 buf = hostapd_wps_nfc_token_gen(hapd, ndef);
291 if (buf == NULL)
292 return -1;
293
294 res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
295 wpabuf_len(buf));
296 reply[res++] = '\n';
297 reply[res] = '\0';
298
299 wpabuf_free(buf);
300
301 return res;
302}
303
304
305static int hostapd_ctrl_iface_wps_nfc_token(struct hostapd_data *hapd,
306 char *cmd, char *reply,
307 size_t max_len)
308{
309 if (os_strcmp(cmd, "WPS") == 0)
310 return hostapd_ctrl_iface_wps_nfc_token_gen(hapd, reply,
311 max_len, 0);
312
313 if (os_strcmp(cmd, "NDEF") == 0)
314 return hostapd_ctrl_iface_wps_nfc_token_gen(hapd, reply,
315 max_len, 1);
316
317 if (os_strcmp(cmd, "enable") == 0)
318 return hostapd_wps_nfc_token_enable(hapd);
319
320 if (os_strcmp(cmd, "disable") == 0) {
321 hostapd_wps_nfc_token_disable(hapd);
322 return 0;
323 }
324
325 return -1;
326}
Dmitry Shmidtf8623282013-02-20 14:34:59 -0800327
328
329static int hostapd_ctrl_iface_nfc_get_handover_sel(struct hostapd_data *hapd,
330 char *cmd, char *reply,
331 size_t max_len)
332{
333 struct wpabuf *buf;
334 int res;
335 char *pos;
336 int ndef;
337
338 pos = os_strchr(cmd, ' ');
339 if (pos == NULL)
340 return -1;
341 *pos++ = '\0';
342
343 if (os_strcmp(cmd, "WPS") == 0)
344 ndef = 0;
345 else if (os_strcmp(cmd, "NDEF") == 0)
346 ndef = 1;
347 else
348 return -1;
349
350 if (os_strcmp(pos, "WPS-CR") == 0)
351 buf = hostapd_wps_nfc_hs_cr(hapd, ndef);
352 else
353 buf = NULL;
354 if (buf == NULL)
355 return -1;
356
357 res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
358 wpabuf_len(buf));
359 reply[res++] = '\n';
360 reply[res] = '\0';
361
362 wpabuf_free(buf);
363
364 return res;
365}
366
367
368static int hostapd_ctrl_iface_nfc_report_handover(struct hostapd_data *hapd,
369 char *cmd)
370{
Dmitry Shmidtcf32e602014-01-28 10:57:39 -0800371 size_t len;
372 struct wpabuf *req, *sel;
373 int ret;
374 char *pos, *role, *type, *pos2;
375
376 role = cmd;
377 pos = os_strchr(role, ' ');
378 if (pos == NULL)
379 return -1;
380 *pos++ = '\0';
381
382 type = pos;
383 pos = os_strchr(type, ' ');
384 if (pos == NULL)
385 return -1;
386 *pos++ = '\0';
387
388 pos2 = os_strchr(pos, ' ');
389 if (pos2 == NULL)
390 return -1;
391 *pos2++ = '\0';
392
393 len = os_strlen(pos);
394 if (len & 0x01)
395 return -1;
396 len /= 2;
397
398 req = wpabuf_alloc(len);
399 if (req == NULL)
400 return -1;
401 if (hexstr2bin(pos, wpabuf_put(req, len), len) < 0) {
402 wpabuf_free(req);
403 return -1;
404 }
405
406 len = os_strlen(pos2);
407 if (len & 0x01) {
408 wpabuf_free(req);
409 return -1;
410 }
411 len /= 2;
412
413 sel = wpabuf_alloc(len);
414 if (sel == NULL) {
415 wpabuf_free(req);
416 return -1;
417 }
418 if (hexstr2bin(pos2, wpabuf_put(sel, len), len) < 0) {
419 wpabuf_free(req);
420 wpabuf_free(sel);
421 return -1;
422 }
423
424 if (os_strcmp(role, "RESP") == 0 && os_strcmp(type, "WPS") == 0) {
425 ret = hostapd_wps_nfc_report_handover(hapd, req, sel);
426 } else {
427 wpa_printf(MSG_DEBUG, "NFC: Unsupported connection handover "
428 "reported: role=%s type=%s", role, type);
429 ret = -1;
430 }
431 wpabuf_free(req);
432 wpabuf_free(sel);
433
434 return ret;
Dmitry Shmidtf8623282013-02-20 14:34:59 -0800435}
436
Dmitry Shmidt04949592012-07-19 12:16:46 -0700437#endif /* CONFIG_WPS_NFC */
438
439
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -0700440static int hostapd_ctrl_iface_wps_ap_pin(struct hostapd_data *hapd, char *txt,
441 char *buf, size_t buflen)
442{
443 int timeout = 300;
444 char *pos;
445 const char *pin_txt;
446
447 pos = os_strchr(txt, ' ');
448 if (pos)
449 *pos++ = '\0';
450
451 if (os_strcmp(txt, "disable") == 0) {
452 hostapd_wps_ap_pin_disable(hapd);
453 return os_snprintf(buf, buflen, "OK\n");
454 }
455
456 if (os_strcmp(txt, "random") == 0) {
457 if (pos)
458 timeout = atoi(pos);
459 pin_txt = hostapd_wps_ap_pin_random(hapd, timeout);
460 if (pin_txt == NULL)
461 return -1;
462 return os_snprintf(buf, buflen, "%s", pin_txt);
463 }
464
465 if (os_strcmp(txt, "get") == 0) {
466 pin_txt = hostapd_wps_ap_pin_get(hapd);
467 if (pin_txt == NULL)
468 return -1;
469 return os_snprintf(buf, buflen, "%s", pin_txt);
470 }
471
472 if (os_strcmp(txt, "set") == 0) {
473 char *pin;
474 if (pos == NULL)
475 return -1;
476 pin = pos;
477 pos = os_strchr(pos, ' ');
478 if (pos) {
479 *pos++ = '\0';
480 timeout = atoi(pos);
481 }
482 if (os_strlen(pin) > buflen)
483 return -1;
484 if (hostapd_wps_ap_pin_set(hapd, pin, timeout) < 0)
485 return -1;
486 return os_snprintf(buf, buflen, "%s", pin);
487 }
488
489 return -1;
490}
491
492
493static int hostapd_ctrl_iface_wps_config(struct hostapd_data *hapd, char *txt)
494{
495 char *pos;
496 char *ssid, *auth, *encr = NULL, *key = NULL;
497
498 ssid = txt;
499 pos = os_strchr(txt, ' ');
500 if (!pos)
501 return -1;
502 *pos++ = '\0';
503
504 auth = pos;
505 pos = os_strchr(pos, ' ');
506 if (pos) {
507 *pos++ = '\0';
508 encr = pos;
509 pos = os_strchr(pos, ' ');
510 if (pos) {
511 *pos++ = '\0';
512 key = pos;
513 }
514 }
515
516 return hostapd_wps_config_ap(hapd, ssid, auth, encr, key);
517}
Dmitry Shmidtb7b4d0e2013-08-26 12:09:05 -0700518
519
520static const char * pbc_status_str(enum pbc_status status)
521{
522 switch (status) {
523 case WPS_PBC_STATUS_DISABLE:
524 return "Disabled";
525 case WPS_PBC_STATUS_ACTIVE:
526 return "Active";
527 case WPS_PBC_STATUS_TIMEOUT:
528 return "Timed-out";
529 case WPS_PBC_STATUS_OVERLAP:
530 return "Overlap";
531 default:
532 return "Unknown";
533 }
534}
535
536
537static int hostapd_ctrl_iface_wps_get_status(struct hostapd_data *hapd,
538 char *buf, size_t buflen)
539{
540 int ret;
541 char *pos, *end;
542
543 pos = buf;
544 end = buf + buflen;
545
546 ret = os_snprintf(pos, end - pos, "PBC Status: %s\n",
547 pbc_status_str(hapd->wps_stats.pbc_status));
548
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -0800549 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidtb7b4d0e2013-08-26 12:09:05 -0700550 return pos - buf;
551 pos += ret;
552
553 ret = os_snprintf(pos, end - pos, "Last WPS result: %s\n",
554 (hapd->wps_stats.status == WPS_STATUS_SUCCESS ?
555 "Success":
556 (hapd->wps_stats.status == WPS_STATUS_FAILURE ?
557 "Failed" : "None")));
558
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -0800559 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidtb7b4d0e2013-08-26 12:09:05 -0700560 return pos - buf;
561 pos += ret;
562
563 /* If status == Failure - Add possible Reasons */
564 if(hapd->wps_stats.status == WPS_STATUS_FAILURE &&
565 hapd->wps_stats.failure_reason > 0) {
566 ret = os_snprintf(pos, end - pos,
567 "Failure Reason: %s\n",
568 wps_ei_str(hapd->wps_stats.failure_reason));
569
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -0800570 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidtb7b4d0e2013-08-26 12:09:05 -0700571 return pos - buf;
572 pos += ret;
573 }
574
575 if (hapd->wps_stats.status) {
576 ret = os_snprintf(pos, end - pos, "Peer Address: " MACSTR "\n",
577 MAC2STR(hapd->wps_stats.peer_addr));
578
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -0800579 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidtb7b4d0e2013-08-26 12:09:05 -0700580 return pos - buf;
581 pos += ret;
582 }
583
584 return pos - buf;
585}
586
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -0700587#endif /* CONFIG_WPS */
588
Dmitry Shmidtf21452a2014-02-26 10:55:25 -0800589#ifdef CONFIG_HS20
590
591static int hostapd_ctrl_iface_hs20_wnm_notif(struct hostapd_data *hapd,
592 const char *cmd)
593{
594 u8 addr[ETH_ALEN];
595 const char *url;
596
597 if (hwaddr_aton(cmd, addr))
598 return -1;
599 url = cmd + 17;
600 if (*url == '\0') {
601 url = NULL;
602 } else {
603 if (*url != ' ')
604 return -1;
605 url++;
606 if (*url == '\0')
607 url = NULL;
608 }
609
610 return hs20_send_wnm_notification(hapd, addr, 1, url);
611}
612
613
614static int hostapd_ctrl_iface_hs20_deauth_req(struct hostapd_data *hapd,
615 const char *cmd)
616{
617 u8 addr[ETH_ALEN];
618 int code, reauth_delay, ret;
619 const char *pos;
620 size_t url_len;
621 struct wpabuf *req;
622
623 /* <STA MAC Addr> <Code(0/1)> <Re-auth-Delay(sec)> [URL] */
624 if (hwaddr_aton(cmd, addr))
625 return -1;
626
627 pos = os_strchr(cmd, ' ');
628 if (pos == NULL)
629 return -1;
630 pos++;
631 code = atoi(pos);
632
633 pos = os_strchr(pos, ' ');
634 if (pos == NULL)
635 return -1;
636 pos++;
637 reauth_delay = atoi(pos);
638
639 url_len = 0;
640 pos = os_strchr(pos, ' ');
641 if (pos) {
642 pos++;
643 url_len = os_strlen(pos);
644 }
645
646 req = wpabuf_alloc(4 + url_len);
647 if (req == NULL)
648 return -1;
649 wpabuf_put_u8(req, code);
650 wpabuf_put_le16(req, reauth_delay);
651 wpabuf_put_u8(req, url_len);
652 if (pos)
653 wpabuf_put_data(req, pos, url_len);
654
655 wpa_printf(MSG_DEBUG, "HS 2.0: Send WNM-Notification to " MACSTR
656 " to indicate imminent deauthentication (code=%d "
657 "reauth_delay=%d)", MAC2STR(addr), code, reauth_delay);
658 ret = hs20_send_wnm_notification_deauth_req(hapd, addr, req);
659 wpabuf_free(req);
660 return ret;
661}
662
663#endif /* CONFIG_HS20 */
664
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -0700665
Dmitry Shmidt051af732013-10-22 13:52:46 -0700666#ifdef CONFIG_INTERWORKING
667
668static int hostapd_ctrl_iface_set_qos_map_set(struct hostapd_data *hapd,
669 const char *cmd)
670{
671 u8 qos_map_set[16 + 2 * 21], count = 0;
672 const char *pos = cmd;
673 int val, ret;
674
675 for (;;) {
676 if (count == sizeof(qos_map_set)) {
677 wpa_printf(MSG_ERROR, "Too many qos_map_set parameters");
678 return -1;
679 }
680
681 val = atoi(pos);
682 if (val < 0 || val > 255) {
683 wpa_printf(MSG_INFO, "Invalid QoS Map Set");
684 return -1;
685 }
686
687 qos_map_set[count++] = val;
688 pos = os_strchr(pos, ',');
689 if (!pos)
690 break;
691 pos++;
692 }
693
694 if (count < 16 || count & 1) {
695 wpa_printf(MSG_INFO, "Invalid QoS Map Set");
696 return -1;
697 }
698
699 ret = hostapd_drv_set_qos_map(hapd, qos_map_set, count);
700 if (ret) {
701 wpa_printf(MSG_INFO, "Failed to set QoS Map Set");
702 return -1;
703 }
704
705 os_memcpy(hapd->conf->qos_map_set, qos_map_set, count);
706 hapd->conf->qos_map_set_len = count;
707
708 return 0;
709}
710
711
712static int hostapd_ctrl_iface_send_qos_map_conf(struct hostapd_data *hapd,
713 const char *cmd)
714{
715 u8 addr[ETH_ALEN];
716 struct sta_info *sta;
717 struct wpabuf *buf;
718 u8 *qos_map_set = hapd->conf->qos_map_set;
719 u8 qos_map_set_len = hapd->conf->qos_map_set_len;
720 int ret;
721
722 if (!qos_map_set_len) {
723 wpa_printf(MSG_INFO, "QoS Map Set is not set");
724 return -1;
725 }
726
727 if (hwaddr_aton(cmd, addr))
728 return -1;
729
730 sta = ap_get_sta(hapd, addr);
731 if (sta == NULL) {
732 wpa_printf(MSG_DEBUG, "Station " MACSTR " not found "
733 "for QoS Map Configuration message",
734 MAC2STR(addr));
735 return -1;
736 }
737
738 if (!sta->qos_map_enabled) {
739 wpa_printf(MSG_DEBUG, "Station " MACSTR " did not indicate "
740 "support for QoS Map", MAC2STR(addr));
741 return -1;
742 }
743
744 buf = wpabuf_alloc(2 + 2 + qos_map_set_len);
745 if (buf == NULL)
746 return -1;
747
748 wpabuf_put_u8(buf, WLAN_ACTION_QOS);
749 wpabuf_put_u8(buf, QOS_QOS_MAP_CONFIG);
750
751 /* QoS Map Set Element */
752 wpabuf_put_u8(buf, WLAN_EID_QOS_MAP_SET);
753 wpabuf_put_u8(buf, qos_map_set_len);
754 wpabuf_put_data(buf, qos_map_set, qos_map_set_len);
755
756 ret = hostapd_drv_send_action(hapd, hapd->iface->freq, 0, addr,
757 wpabuf_head(buf), wpabuf_len(buf));
758 wpabuf_free(buf);
759
760 return ret;
761}
762
763#endif /* CONFIG_INTERWORKING */
764
765
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -0800766#ifdef CONFIG_WNM
767
768static int hostapd_ctrl_iface_disassoc_imminent(struct hostapd_data *hapd,
769 const char *cmd)
770{
771 u8 addr[ETH_ALEN];
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -0800772 int disassoc_timer;
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -0800773 struct sta_info *sta;
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -0800774
775 if (hwaddr_aton(cmd, addr))
776 return -1;
777 if (cmd[17] != ' ')
778 return -1;
779 disassoc_timer = atoi(cmd + 17);
780
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -0800781 sta = ap_get_sta(hapd, addr);
782 if (sta == NULL) {
783 wpa_printf(MSG_DEBUG, "Station " MACSTR
784 " not found for disassociation imminent message",
785 MAC2STR(addr));
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -0800786 return -1;
787 }
788
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -0800789 return wnm_send_disassoc_imminent(hapd, sta, disassoc_timer);
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -0800790}
791
792
Dmitry Shmidt1f69aa52012-01-24 16:10:04 -0800793static int hostapd_ctrl_iface_ess_disassoc(struct hostapd_data *hapd,
794 const char *cmd)
795{
796 u8 addr[ETH_ALEN];
Dmitry Shmidtb6e9aaf2013-05-20 14:49:44 -0700797 const char *url, *timerstr;
Dmitry Shmidtb6e9aaf2013-05-20 14:49:44 -0700798 int disassoc_timer;
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -0800799 struct sta_info *sta;
Dmitry Shmidt1f69aa52012-01-24 16:10:04 -0800800
801 if (hwaddr_aton(cmd, addr))
802 return -1;
Dmitry Shmidtb6e9aaf2013-05-20 14:49:44 -0700803
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -0800804 sta = ap_get_sta(hapd, addr);
805 if (sta == NULL) {
806 wpa_printf(MSG_DEBUG, "Station " MACSTR
807 " not found for ESS disassociation imminent message",
808 MAC2STR(addr));
809 return -1;
810 }
811
Dmitry Shmidtb6e9aaf2013-05-20 14:49:44 -0700812 timerstr = cmd + 17;
813 if (*timerstr != ' ')
814 return -1;
815 timerstr++;
816 disassoc_timer = atoi(timerstr);
817 if (disassoc_timer < 0 || disassoc_timer > 65535)
818 return -1;
819
820 url = os_strchr(timerstr, ' ');
Dmitry Shmidt8bae4132013-06-06 11:25:10 -0700821 if (url == NULL)
Dmitry Shmidt1f69aa52012-01-24 16:10:04 -0800822 return -1;
823 url++;
Dmitry Shmidt1f69aa52012-01-24 16:10:04 -0800824
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -0800825 return wnm_send_ess_disassoc_imminent(hapd, sta, url, disassoc_timer);
Dmitry Shmidt1f69aa52012-01-24 16:10:04 -0800826}
827
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -0800828
829static int hostapd_ctrl_iface_bss_tm_req(struct hostapd_data *hapd,
830 const char *cmd)
831{
832 u8 addr[ETH_ALEN];
833 const char *pos, *end;
834 int disassoc_timer = 0;
835 struct sta_info *sta;
836 u8 req_mode = 0, valid_int = 0x01;
837 u8 bss_term_dur[12];
838 char *url = NULL;
839 int ret;
840 u8 nei_rep[1000];
841 u8 *nei_pos = nei_rep;
Dmitry Shmidt57c2d392016-02-23 13:40:19 -0800842 u8 mbo[10];
843 size_t mbo_len = 0;
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -0800844
845 if (hwaddr_aton(cmd, addr)) {
846 wpa_printf(MSG_DEBUG, "Invalid STA MAC address");
847 return -1;
848 }
849
850 sta = ap_get_sta(hapd, addr);
851 if (sta == NULL) {
852 wpa_printf(MSG_DEBUG, "Station " MACSTR
853 " not found for BSS TM Request message",
854 MAC2STR(addr));
855 return -1;
856 }
857
858 pos = os_strstr(cmd, " disassoc_timer=");
859 if (pos) {
860 pos += 16;
861 disassoc_timer = atoi(pos);
862 if (disassoc_timer < 0 || disassoc_timer > 65535) {
863 wpa_printf(MSG_DEBUG, "Invalid disassoc_timer");
864 return -1;
865 }
866 }
867
868 pos = os_strstr(cmd, " valid_int=");
869 if (pos) {
870 pos += 11;
871 valid_int = atoi(pos);
872 }
873
874 pos = os_strstr(cmd, " bss_term=");
875 if (pos) {
876 pos += 10;
877 req_mode |= WNM_BSS_TM_REQ_BSS_TERMINATION_INCLUDED;
878 /* TODO: TSF configurable/learnable */
879 bss_term_dur[0] = 4; /* Subelement ID */
880 bss_term_dur[1] = 10; /* Length */
881 os_memset(bss_term_dur, 2, 8);
882 end = os_strchr(pos, ',');
883 if (end == NULL) {
884 wpa_printf(MSG_DEBUG, "Invalid bss_term data");
885 return -1;
886 }
887 end++;
888 WPA_PUT_LE16(&bss_term_dur[10], atoi(end));
889 }
890
891
892 /*
893 * BSS Transition Candidate List Entries - Neighbor Report elements
894 * neighbor=<BSSID>,<BSSID Information>,<Operating Class>,
895 * <Channel Number>,<PHY Type>[,<hexdump of Optional Subelements>]
896 */
897 pos = cmd;
898 while (pos) {
899 u8 *nei_start;
900 long int val;
901 char *endptr, *tmp;
902
903 pos = os_strstr(pos, " neighbor=");
904 if (!pos)
905 break;
906 if (nei_pos + 15 > nei_rep + sizeof(nei_rep)) {
907 wpa_printf(MSG_DEBUG,
908 "Not enough room for additional neighbor");
909 return -1;
910 }
911 pos += 10;
912
913 nei_start = nei_pos;
914 *nei_pos++ = WLAN_EID_NEIGHBOR_REPORT;
915 nei_pos++; /* length to be filled in */
916
917 if (hwaddr_aton(pos, nei_pos)) {
918 wpa_printf(MSG_DEBUG, "Invalid BSSID");
919 return -1;
920 }
921 nei_pos += ETH_ALEN;
922 pos += 17;
923 if (*pos != ',') {
924 wpa_printf(MSG_DEBUG, "Missing BSSID Information");
925 return -1;
926 }
927 pos++;
928
929 val = strtol(pos, &endptr, 0);
930 WPA_PUT_LE32(nei_pos, val);
931 nei_pos += 4;
932 if (*endptr != ',') {
933 wpa_printf(MSG_DEBUG, "Missing Operating Class");
934 return -1;
935 }
936 pos = endptr + 1;
937
938 *nei_pos++ = atoi(pos); /* Operating Class */
939 pos = os_strchr(pos, ',');
940 if (pos == NULL) {
941 wpa_printf(MSG_DEBUG, "Missing Channel Number");
942 return -1;
943 }
944 pos++;
945
946 *nei_pos++ = atoi(pos); /* Channel Number */
947 pos = os_strchr(pos, ',');
948 if (pos == NULL) {
949 wpa_printf(MSG_DEBUG, "Missing PHY Type");
950 return -1;
951 }
952 pos++;
953
954 *nei_pos++ = atoi(pos); /* PHY Type */
955 end = os_strchr(pos, ' ');
956 tmp = os_strchr(pos, ',');
957 if (tmp && (!end || tmp < end)) {
958 /* Optional Subelements (hexdump) */
959 size_t len;
960
961 pos = tmp + 1;
962 end = os_strchr(pos, ' ');
963 if (end)
964 len = end - pos;
965 else
966 len = os_strlen(pos);
967 if (nei_pos + len / 2 > nei_rep + sizeof(nei_rep)) {
968 wpa_printf(MSG_DEBUG,
969 "Not enough room for neighbor subelements");
970 return -1;
971 }
972 if (len & 0x01 ||
973 hexstr2bin(pos, nei_pos, len / 2) < 0) {
974 wpa_printf(MSG_DEBUG,
975 "Invalid neighbor subelement info");
976 return -1;
977 }
978 nei_pos += len / 2;
979 pos = end;
980 }
981
982 nei_start[1] = nei_pos - nei_start - 2;
983 }
984
985 pos = os_strstr(cmd, " url=");
986 if (pos) {
987 size_t len;
988 pos += 5;
989 end = os_strchr(pos, ' ');
990 if (end)
991 len = end - pos;
992 else
993 len = os_strlen(pos);
994 url = os_malloc(len + 1);
995 if (url == NULL)
996 return -1;
997 os_memcpy(url, pos, len);
998 url[len] = '\0';
999 req_mode |= WNM_BSS_TM_REQ_ESS_DISASSOC_IMMINENT;
1000 }
1001
1002 if (os_strstr(cmd, " pref=1"))
1003 req_mode |= WNM_BSS_TM_REQ_PREF_CAND_LIST_INCLUDED;
1004 if (os_strstr(cmd, " abridged=1"))
1005 req_mode |= WNM_BSS_TM_REQ_ABRIDGED;
1006 if (os_strstr(cmd, " disassoc_imminent=1"))
1007 req_mode |= WNM_BSS_TM_REQ_DISASSOC_IMMINENT;
1008
Dmitry Shmidt57c2d392016-02-23 13:40:19 -08001009#ifdef CONFIG_MBO
1010 pos = os_strstr(cmd, "mbo=");
1011 if (pos) {
1012 unsigned int mbo_reason, cell_pref, reassoc_delay;
1013 u8 *mbo_pos = mbo;
1014
1015 ret = sscanf(pos, "mbo=%u:%u:%u", &mbo_reason,
1016 &reassoc_delay, &cell_pref);
1017 if (ret != 3) {
1018 wpa_printf(MSG_DEBUG,
1019 "MBO requires three arguments: mbo=<reason>:<reassoc_delay>:<cell_pref>");
1020 return -1;
1021 }
1022
1023 if (mbo_reason > MBO_TRANSITION_REASON_PREMIUM_AP) {
1024 wpa_printf(MSG_DEBUG,
1025 "Invalid MBO transition reason code %u",
1026 mbo_reason);
1027 return -1;
1028 }
1029
1030 /* Valid values for Cellular preference are: 0, 1, 255 */
1031 if (cell_pref != 0 && cell_pref != 1 && cell_pref != 255) {
1032 wpa_printf(MSG_DEBUG,
1033 "Invalid MBO cellular capability %u",
1034 cell_pref);
1035 return -1;
1036 }
1037
1038 if (reassoc_delay > 65535 ||
1039 (reassoc_delay &&
1040 !(req_mode & WNM_BSS_TM_REQ_DISASSOC_IMMINENT))) {
1041 wpa_printf(MSG_DEBUG,
1042 "MBO: Assoc retry delay is only valid in disassoc imminent mode");
1043 return -1;
1044 }
1045
1046 *mbo_pos++ = MBO_ATTR_ID_TRANSITION_REASON;
1047 *mbo_pos++ = 1;
1048 *mbo_pos++ = mbo_reason;
1049 *mbo_pos++ = MBO_ATTR_ID_CELL_DATA_PREF;
1050 *mbo_pos++ = 1;
1051 *mbo_pos++ = cell_pref;
1052
1053 if (reassoc_delay) {
1054 *mbo_pos++ = MBO_ATTR_ID_ASSOC_RETRY_DELAY;
1055 *mbo_pos++ = 2;
1056 WPA_PUT_LE16(mbo_pos, reassoc_delay);
1057 mbo_pos += 2;
1058 }
1059
1060 mbo_len = mbo_pos - mbo;
1061 }
1062#endif /* CONFIG_MBO */
1063
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001064 ret = wnm_send_bss_tm_req(hapd, sta, req_mode, disassoc_timer,
1065 valid_int, bss_term_dur, url,
1066 nei_pos > nei_rep ? nei_rep : NULL,
Dmitry Shmidt57c2d392016-02-23 13:40:19 -08001067 nei_pos - nei_rep, mbo_len ? mbo : NULL,
1068 mbo_len);
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001069 os_free(url);
1070 return ret;
1071}
1072
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -08001073#endif /* CONFIG_WNM */
1074
Dmitry Shmidt1f69aa52012-01-24 16:10:04 -08001075
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001076static int hostapd_ctrl_iface_get_key_mgmt(struct hostapd_data *hapd,
1077 char *buf, size_t buflen)
1078{
1079 int ret = 0;
1080 char *pos, *end;
1081
1082 pos = buf;
1083 end = buf + buflen;
1084
1085 WPA_ASSERT(hapd->conf->wpa_key_mgmt);
1086
1087 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_PSK) {
1088 ret = os_snprintf(pos, end - pos, "WPA-PSK ");
1089 if (os_snprintf_error(end - pos, ret))
1090 return pos - buf;
1091 pos += ret;
1092 }
1093 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_IEEE8021X) {
1094 ret = os_snprintf(pos, end - pos, "WPA-EAP ");
1095 if (os_snprintf_error(end - pos, ret))
1096 return pos - buf;
1097 pos += ret;
1098 }
1099#ifdef CONFIG_IEEE80211R
1100 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_FT_PSK) {
1101 ret = os_snprintf(pos, end - pos, "FT-PSK ");
1102 if (os_snprintf_error(end - pos, ret))
1103 return pos - buf;
1104 pos += ret;
1105 }
1106 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_FT_IEEE8021X) {
1107 ret = os_snprintf(pos, end - pos, "FT-EAP ");
1108 if (os_snprintf_error(end - pos, ret))
1109 return pos - buf;
1110 pos += ret;
1111 }
1112#ifdef CONFIG_SAE
1113 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_FT_SAE) {
1114 ret = os_snprintf(pos, end - pos, "FT-SAE ");
1115 if (os_snprintf_error(end - pos, ret))
1116 return pos - buf;
1117 pos += ret;
1118 }
1119#endif /* CONFIG_SAE */
Dmitry Shmidt9839ecd2016-11-07 11:05:47 -08001120#ifdef CONFIG_FILS
1121 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_FT_FILS_SHA256) {
1122 ret = os_snprintf(pos, end - pos, "FT-FILS-SHA256 ");
1123 if (os_snprintf_error(end - pos, ret))
1124 return pos - buf;
1125 pos += ret;
1126 }
1127 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_FT_FILS_SHA384) {
1128 ret = os_snprintf(pos, end - pos, "FT-FILS-SHA384 ");
1129 if (os_snprintf_error(end - pos, ret))
1130 return pos - buf;
1131 pos += ret;
1132 }
1133#endif /* CONFIG_FILS */
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001134#endif /* CONFIG_IEEE80211R */
1135#ifdef CONFIG_IEEE80211W
1136 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_PSK_SHA256) {
1137 ret = os_snprintf(pos, end - pos, "WPA-PSK-SHA256 ");
1138 if (os_snprintf_error(end - pos, ret))
1139 return pos - buf;
1140 pos += ret;
1141 }
1142 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_IEEE8021X_SHA256) {
1143 ret = os_snprintf(pos, end - pos, "WPA-EAP-SHA256 ");
1144 if (os_snprintf_error(end - pos, ret))
1145 return pos - buf;
1146 pos += ret;
1147 }
1148#endif /* CONFIG_IEEE80211W */
1149#ifdef CONFIG_SAE
1150 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_SAE) {
1151 ret = os_snprintf(pos, end - pos, "SAE ");
1152 if (os_snprintf_error(end - pos, ret))
1153 return pos - buf;
1154 pos += ret;
1155 }
1156#endif /* CONFIG_SAE */
1157 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_IEEE8021X_SUITE_B) {
1158 ret = os_snprintf(pos, end - pos, "WPA-EAP-SUITE-B ");
1159 if (os_snprintf_error(end - pos, ret))
1160 return pos - buf;
1161 pos += ret;
1162 }
1163 if (hapd->conf->wpa_key_mgmt &
1164 WPA_KEY_MGMT_IEEE8021X_SUITE_B_192) {
1165 ret = os_snprintf(pos, end - pos,
1166 "WPA-EAP-SUITE-B-192 ");
1167 if (os_snprintf_error(end - pos, ret))
1168 return pos - buf;
1169 pos += ret;
1170 }
Dmitry Shmidt9839ecd2016-11-07 11:05:47 -08001171#ifdef CONFIG_FILS
1172 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_FILS_SHA256) {
1173 ret = os_snprintf(pos, end - pos, "FILS-SHA256 ");
1174 if (os_snprintf_error(end - pos, ret))
1175 return pos - buf;
1176 pos += ret;
1177 }
1178 if (hapd->conf->wpa_key_mgmt & WPA_KEY_MGMT_FILS_SHA384) {
1179 ret = os_snprintf(pos, end - pos, "FILS-SHA384 ");
1180 if (os_snprintf_error(end - pos, ret))
1181 return pos - buf;
1182 pos += ret;
1183 }
1184#endif /* CONFIG_FILS */
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001185
1186 if (pos > buf && *(pos - 1) == ' ') {
1187 *(pos - 1) = '\0';
1188 pos--;
1189 }
1190
1191 return pos - buf;
1192}
1193
1194
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001195static int hostapd_ctrl_iface_get_config(struct hostapd_data *hapd,
1196 char *buf, size_t buflen)
1197{
1198 int ret;
1199 char *pos, *end;
1200
1201 pos = buf;
1202 end = buf + buflen;
1203
1204 ret = os_snprintf(pos, end - pos, "bssid=" MACSTR "\n"
1205 "ssid=%s\n",
1206 MAC2STR(hapd->own_addr),
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07001207 wpa_ssid_txt(hapd->conf->ssid.ssid,
1208 hapd->conf->ssid.ssid_len));
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001209 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001210 return pos - buf;
1211 pos += ret;
1212
1213#ifdef CONFIG_WPS
1214 ret = os_snprintf(pos, end - pos, "wps_state=%s\n",
1215 hapd->conf->wps_state == 0 ? "disabled" :
1216 (hapd->conf->wps_state == 1 ? "not configured" :
1217 "configured"));
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001218 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001219 return pos - buf;
1220 pos += ret;
1221
1222 if (hapd->conf->wps_state && hapd->conf->wpa &&
1223 hapd->conf->ssid.wpa_passphrase) {
1224 ret = os_snprintf(pos, end - pos, "passphrase=%s\n",
1225 hapd->conf->ssid.wpa_passphrase);
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001226 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001227 return pos - buf;
1228 pos += ret;
1229 }
1230
1231 if (hapd->conf->wps_state && hapd->conf->wpa &&
1232 hapd->conf->ssid.wpa_psk &&
1233 hapd->conf->ssid.wpa_psk->group) {
1234 char hex[PMK_LEN * 2 + 1];
1235 wpa_snprintf_hex(hex, sizeof(hex),
1236 hapd->conf->ssid.wpa_psk->psk, PMK_LEN);
1237 ret = os_snprintf(pos, end - pos, "psk=%s\n", hex);
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001238 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001239 return pos - buf;
1240 pos += ret;
1241 }
1242#endif /* CONFIG_WPS */
1243
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001244 if (hapd->conf->wpa) {
1245 ret = os_snprintf(pos, end - pos, "wpa=%d\n", hapd->conf->wpa);
1246 if (os_snprintf_error(end - pos, ret))
1247 return pos - buf;
1248 pos += ret;
1249 }
1250
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001251 if (hapd->conf->wpa && hapd->conf->wpa_key_mgmt) {
1252 ret = os_snprintf(pos, end - pos, "key_mgmt=");
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001253 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001254 return pos - buf;
1255 pos += ret;
1256
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001257 pos += hostapd_ctrl_iface_get_key_mgmt(hapd, pos, end - pos);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001258
1259 ret = os_snprintf(pos, end - pos, "\n");
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001260 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001261 return pos - buf;
1262 pos += ret;
1263 }
1264
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -08001265 if (hapd->conf->wpa) {
1266 ret = os_snprintf(pos, end - pos, "group_cipher=%s\n",
1267 wpa_cipher_txt(hapd->conf->wpa_group));
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001268 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001269 return pos - buf;
1270 pos += ret;
1271 }
1272
1273 if ((hapd->conf->wpa & WPA_PROTO_RSN) && hapd->conf->rsn_pairwise) {
1274 ret = os_snprintf(pos, end - pos, "rsn_pairwise_cipher=");
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001275 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001276 return pos - buf;
1277 pos += ret;
1278
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -08001279 ret = wpa_write_ciphers(pos, end, hapd->conf->rsn_pairwise,
1280 " ");
1281 if (ret < 0)
1282 return pos - buf;
1283 pos += ret;
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001284
1285 ret = os_snprintf(pos, end - pos, "\n");
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001286 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001287 return pos - buf;
1288 pos += ret;
1289 }
1290
1291 if ((hapd->conf->wpa & WPA_PROTO_WPA) && hapd->conf->wpa_pairwise) {
1292 ret = os_snprintf(pos, end - pos, "wpa_pairwise_cipher=");
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001293 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001294 return pos - buf;
1295 pos += ret;
1296
Dmitry Shmidt661b4f72014-09-29 14:58:27 -07001297 ret = wpa_write_ciphers(pos, end, hapd->conf->wpa_pairwise,
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -08001298 " ");
1299 if (ret < 0)
1300 return pos - buf;
1301 pos += ret;
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001302
1303 ret = os_snprintf(pos, end - pos, "\n");
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001304 if (os_snprintf_error(end - pos, ret))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001305 return pos - buf;
1306 pos += ret;
1307 }
1308
1309 return pos - buf;
1310}
1311
1312
1313static int hostapd_ctrl_iface_set(struct hostapd_data *hapd, char *cmd)
1314{
1315 char *value;
1316 int ret = 0;
1317
1318 value = os_strchr(cmd, ' ');
1319 if (value == NULL)
1320 return -1;
1321 *value++ = '\0';
1322
1323 wpa_printf(MSG_DEBUG, "CTRL_IFACE SET '%s'='%s'", cmd, value);
1324 if (0) {
1325#ifdef CONFIG_WPS_TESTING
1326 } else if (os_strcasecmp(cmd, "wps_version_number") == 0) {
1327 long int val;
1328 val = strtol(value, NULL, 0);
1329 if (val < 0 || val > 0xff) {
1330 ret = -1;
1331 wpa_printf(MSG_DEBUG, "WPS: Invalid "
1332 "wps_version_number %ld", val);
1333 } else {
1334 wps_version_number = val;
1335 wpa_printf(MSG_DEBUG, "WPS: Testing - force WPS "
1336 "version %u.%u",
1337 (wps_version_number & 0xf0) >> 4,
1338 wps_version_number & 0x0f);
1339 hostapd_wps_update_ie(hapd);
1340 }
1341 } else if (os_strcasecmp(cmd, "wps_testing_dummy_cred") == 0) {
1342 wps_testing_dummy_cred = atoi(value);
1343 wpa_printf(MSG_DEBUG, "WPS: Testing - dummy_cred=%d",
1344 wps_testing_dummy_cred);
Dmitry Shmidtcf32e602014-01-28 10:57:39 -08001345 } else if (os_strcasecmp(cmd, "wps_corrupt_pkhash") == 0) {
1346 wps_corrupt_pkhash = atoi(value);
1347 wpa_printf(MSG_DEBUG, "WPS: Testing - wps_corrupt_pkhash=%d",
1348 wps_corrupt_pkhash);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001349#endif /* CONFIG_WPS_TESTING */
Dmitry Shmidt04949592012-07-19 12:16:46 -07001350#ifdef CONFIG_INTERWORKING
1351 } else if (os_strcasecmp(cmd, "gas_frag_limit") == 0) {
1352 int val = atoi(value);
1353 if (val <= 0)
1354 ret = -1;
1355 else
1356 hapd->gas_frag_limit = val;
1357#endif /* CONFIG_INTERWORKING */
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -08001358#ifdef CONFIG_TESTING_OPTIONS
1359 } else if (os_strcasecmp(cmd, "ext_mgmt_frame_handling") == 0) {
1360 hapd->ext_mgmt_frame_handling = atoi(value);
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001361 } else if (os_strcasecmp(cmd, "ext_eapol_frame_io") == 0) {
1362 hapd->ext_eapol_frame_io = atoi(value);
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -08001363#endif /* CONFIG_TESTING_OPTIONS */
Dmitry Shmidt57c2d392016-02-23 13:40:19 -08001364#ifdef CONFIG_MBO
1365 } else if (os_strcasecmp(cmd, "mbo_assoc_disallow") == 0) {
1366 int val;
1367
1368 if (!hapd->conf->mbo_enabled)
1369 return -1;
1370
1371 val = atoi(value);
1372 if (val < 0 || val > 1)
1373 return -1;
1374
1375 hapd->mbo_assoc_disallow = val;
1376 ieee802_11_update_beacons(hapd->iface);
1377
1378 /*
1379 * TODO: Need to configure drivers that do AP MLME offload with
1380 * disallowing station logic.
1381 */
1382#endif /* CONFIG_MBO */
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001383 } else {
Dmitry Shmidtf21452a2014-02-26 10:55:25 -08001384 struct sta_info *sta;
Dmitry Shmidt57c2d392016-02-23 13:40:19 -08001385 struct vlan_description vlan_id;
Dmitry Shmidtf21452a2014-02-26 10:55:25 -08001386
Dmitry Shmidt04949592012-07-19 12:16:46 -07001387 ret = hostapd_set_iface(hapd->iconf, hapd->conf, cmd, value);
Dmitry Shmidtf21452a2014-02-26 10:55:25 -08001388 if (ret)
1389 return ret;
1390
1391 if (os_strcasecmp(cmd, "deny_mac_file") == 0) {
1392 for (sta = hapd->sta_list; sta; sta = sta->next) {
1393 if (hostapd_maclist_found(
1394 hapd->conf->deny_mac,
1395 hapd->conf->num_deny_mac, sta->addr,
1396 &vlan_id) &&
Dmitry Shmidt57c2d392016-02-23 13:40:19 -08001397 (!vlan_id.notempty ||
1398 !vlan_compare(&vlan_id, sta->vlan_desc)))
Dmitry Shmidtdf5a7e42014-04-02 12:59:59 -07001399 ap_sta_disconnect(
1400 hapd, sta, sta->addr,
Dmitry Shmidtf21452a2014-02-26 10:55:25 -08001401 WLAN_REASON_UNSPECIFIED);
1402 }
1403 } else if (hapd->conf->macaddr_acl == DENY_UNLESS_ACCEPTED &&
1404 os_strcasecmp(cmd, "accept_mac_file") == 0) {
1405 for (sta = hapd->sta_list; sta; sta = sta->next) {
1406 if (!hostapd_maclist_found(
1407 hapd->conf->accept_mac,
1408 hapd->conf->num_accept_mac,
1409 sta->addr, &vlan_id) ||
Dmitry Shmidt57c2d392016-02-23 13:40:19 -08001410 (vlan_id.notempty &&
1411 vlan_compare(&vlan_id, sta->vlan_desc)))
Dmitry Shmidtdf5a7e42014-04-02 12:59:59 -07001412 ap_sta_disconnect(
1413 hapd, sta, sta->addr,
Dmitry Shmidtf21452a2014-02-26 10:55:25 -08001414 WLAN_REASON_UNSPECIFIED);
1415 }
1416 }
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001417 }
1418
1419 return ret;
1420}
1421
1422
1423static int hostapd_ctrl_iface_get(struct hostapd_data *hapd, char *cmd,
1424 char *buf, size_t buflen)
1425{
1426 int res;
1427
1428 wpa_printf(MSG_DEBUG, "CTRL_IFACE GET '%s'", cmd);
1429
1430 if (os_strcmp(cmd, "version") == 0) {
1431 res = os_snprintf(buf, buflen, "%s", VERSION_STR);
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001432 if (os_snprintf_error(buflen, res))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001433 return -1;
1434 return res;
Dmitry Shmidtff787d52015-01-12 13:01:47 -08001435 } else if (os_strcmp(cmd, "tls_library") == 0) {
1436 res = tls_get_library_version(buf, buflen);
1437 if (os_snprintf_error(buflen, res))
1438 return -1;
1439 return res;
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001440 }
1441
1442 return -1;
1443}
1444
1445
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07001446static int hostapd_ctrl_iface_enable(struct hostapd_iface *iface)
1447{
1448 if (hostapd_enable_iface(iface) < 0) {
1449 wpa_printf(MSG_ERROR, "Enabling of interface failed");
1450 return -1;
1451 }
1452 return 0;
1453}
1454
1455
1456static int hostapd_ctrl_iface_reload(struct hostapd_iface *iface)
1457{
1458 if (hostapd_reload_iface(iface) < 0) {
1459 wpa_printf(MSG_ERROR, "Reloading of interface failed");
1460 return -1;
1461 }
1462 return 0;
1463}
1464
1465
1466static int hostapd_ctrl_iface_disable(struct hostapd_iface *iface)
1467{
1468 if (hostapd_disable_iface(iface) < 0) {
1469 wpa_printf(MSG_ERROR, "Disabling of interface failed");
1470 return -1;
1471 }
1472 return 0;
1473}
1474
1475
Dmitry Shmidtcce06662013-11-04 18:44:24 -08001476#ifdef CONFIG_TESTING_OPTIONS
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -08001477
Dmitry Shmidtcce06662013-11-04 18:44:24 -08001478static int hostapd_ctrl_iface_radar(struct hostapd_data *hapd, char *cmd)
1479{
1480 union wpa_event_data data;
1481 char *pos, *param;
1482 enum wpa_event_type event;
1483
1484 wpa_printf(MSG_DEBUG, "RADAR TEST: %s", cmd);
1485
1486 os_memset(&data, 0, sizeof(data));
1487
1488 param = os_strchr(cmd, ' ');
1489 if (param == NULL)
1490 return -1;
1491 *param++ = '\0';
1492
1493 if (os_strcmp(cmd, "DETECTED") == 0)
1494 event = EVENT_DFS_RADAR_DETECTED;
1495 else if (os_strcmp(cmd, "CAC-FINISHED") == 0)
1496 event = EVENT_DFS_CAC_FINISHED;
1497 else if (os_strcmp(cmd, "CAC-ABORTED") == 0)
1498 event = EVENT_DFS_CAC_ABORTED;
1499 else if (os_strcmp(cmd, "NOP-FINISHED") == 0)
1500 event = EVENT_DFS_NOP_FINISHED;
1501 else {
1502 wpa_printf(MSG_DEBUG, "Unsupported RADAR test command: %s",
1503 cmd);
1504 return -1;
1505 }
1506
1507 pos = os_strstr(param, "freq=");
1508 if (pos)
1509 data.dfs_event.freq = atoi(pos + 5);
1510
1511 pos = os_strstr(param, "ht_enabled=1");
1512 if (pos)
1513 data.dfs_event.ht_enabled = 1;
1514
1515 pos = os_strstr(param, "chan_offset=");
1516 if (pos)
1517 data.dfs_event.chan_offset = atoi(pos + 12);
1518
1519 pos = os_strstr(param, "chan_width=");
1520 if (pos)
1521 data.dfs_event.chan_width = atoi(pos + 11);
1522
1523 pos = os_strstr(param, "cf1=");
1524 if (pos)
1525 data.dfs_event.cf1 = atoi(pos + 4);
1526
1527 pos = os_strstr(param, "cf2=");
1528 if (pos)
1529 data.dfs_event.cf2 = atoi(pos + 4);
1530
1531 wpa_supplicant_event(hapd, event, &data);
1532
1533 return 0;
1534}
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -08001535
1536
1537static int hostapd_ctrl_iface_mgmt_tx(struct hostapd_data *hapd, char *cmd)
1538{
1539 size_t len;
1540 u8 *buf;
1541 int res;
1542
1543 wpa_printf(MSG_DEBUG, "External MGMT TX: %s", cmd);
1544
1545 len = os_strlen(cmd);
1546 if (len & 1)
1547 return -1;
1548 len /= 2;
1549
1550 buf = os_malloc(len);
1551 if (buf == NULL)
1552 return -1;
1553
1554 if (hexstr2bin(cmd, buf, len) < 0) {
1555 os_free(buf);
1556 return -1;
1557 }
1558
1559 res = hostapd_drv_send_mlme(hapd, buf, len, 0);
1560 os_free(buf);
1561 return res;
1562}
1563
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001564
1565static int hostapd_ctrl_iface_eapol_rx(struct hostapd_data *hapd, char *cmd)
1566{
1567 char *pos;
1568 u8 src[ETH_ALEN], *buf;
1569 int used;
1570 size_t len;
1571
1572 wpa_printf(MSG_DEBUG, "External EAPOL RX: %s", cmd);
1573
1574 pos = cmd;
1575 used = hwaddr_aton2(pos, src);
1576 if (used < 0)
1577 return -1;
1578 pos += used;
1579 while (*pos == ' ')
1580 pos++;
1581
1582 len = os_strlen(pos);
1583 if (len & 1)
1584 return -1;
1585 len /= 2;
1586
1587 buf = os_malloc(len);
1588 if (buf == NULL)
1589 return -1;
1590
1591 if (hexstr2bin(pos, buf, len) < 0) {
1592 os_free(buf);
1593 return -1;
1594 }
1595
1596 ieee802_1x_receive(hapd, src, buf, len);
1597 os_free(buf);
1598
1599 return 0;
1600}
1601
1602
1603static u16 ipv4_hdr_checksum(const void *buf, size_t len)
1604{
1605 size_t i;
1606 u32 sum = 0;
1607 const u16 *pos = buf;
1608
1609 for (i = 0; i < len / 2; i++)
1610 sum += *pos++;
1611
1612 while (sum >> 16)
1613 sum = (sum & 0xffff) + (sum >> 16);
1614
1615 return sum ^ 0xffff;
1616}
1617
1618
1619#define HWSIM_PACKETLEN 1500
1620#define HWSIM_IP_LEN (HWSIM_PACKETLEN - sizeof(struct ether_header))
1621
Dmitry Shmidt4ae50e62016-06-27 13:48:39 -07001622static void hostapd_data_test_rx(void *ctx, const u8 *src_addr, const u8 *buf,
1623 size_t len)
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001624{
1625 struct hostapd_data *hapd = ctx;
1626 const struct ether_header *eth;
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001627 struct iphdr ip;
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001628 const u8 *pos;
1629 unsigned int i;
1630
1631 if (len != HWSIM_PACKETLEN)
1632 return;
1633
1634 eth = (const struct ether_header *) buf;
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001635 os_memcpy(&ip, eth + 1, sizeof(ip));
1636 pos = &buf[sizeof(*eth) + sizeof(ip)];
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001637
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001638 if (ip.ihl != 5 || ip.version != 4 ||
1639 ntohs(ip.tot_len) != HWSIM_IP_LEN)
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001640 return;
1641
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001642 for (i = 0; i < HWSIM_IP_LEN - sizeof(ip); i++) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001643 if (*pos != (u8) i)
1644 return;
1645 pos++;
1646 }
1647
1648 wpa_msg(hapd->msg_ctx, MSG_INFO, "DATA-TEST-RX " MACSTR " " MACSTR,
1649 MAC2STR(eth->ether_dhost), MAC2STR(eth->ether_shost));
1650}
1651
1652
1653static int hostapd_ctrl_iface_data_test_config(struct hostapd_data *hapd,
1654 char *cmd)
1655{
1656 int enabled = atoi(cmd);
1657 char *pos;
1658 const char *ifname;
1659
1660 if (!enabled) {
1661 if (hapd->l2_test) {
1662 l2_packet_deinit(hapd->l2_test);
1663 hapd->l2_test = NULL;
1664 wpa_dbg(hapd->msg_ctx, MSG_DEBUG,
1665 "test data: Disabled");
1666 }
1667 return 0;
1668 }
1669
1670 if (hapd->l2_test)
1671 return 0;
1672
1673 pos = os_strstr(cmd, " ifname=");
1674 if (pos)
1675 ifname = pos + 8;
1676 else
1677 ifname = hapd->conf->iface;
1678
1679 hapd->l2_test = l2_packet_init(ifname, hapd->own_addr,
1680 ETHERTYPE_IP, hostapd_data_test_rx,
1681 hapd, 1);
1682 if (hapd->l2_test == NULL)
1683 return -1;
1684
1685 wpa_dbg(hapd->msg_ctx, MSG_DEBUG, "test data: Enabled");
1686
1687 return 0;
1688}
1689
1690
1691static int hostapd_ctrl_iface_data_test_tx(struct hostapd_data *hapd, char *cmd)
1692{
1693 u8 dst[ETH_ALEN], src[ETH_ALEN];
1694 char *pos;
1695 int used;
1696 long int val;
1697 u8 tos;
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001698 u8 buf[2 + HWSIM_PACKETLEN];
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001699 struct ether_header *eth;
1700 struct iphdr *ip;
1701 u8 *dpos;
1702 unsigned int i;
1703
1704 if (hapd->l2_test == NULL)
1705 return -1;
1706
1707 /* format: <dst> <src> <tos> */
1708
1709 pos = cmd;
1710 used = hwaddr_aton2(pos, dst);
1711 if (used < 0)
1712 return -1;
1713 pos += used;
1714 while (*pos == ' ')
1715 pos++;
1716 used = hwaddr_aton2(pos, src);
1717 if (used < 0)
1718 return -1;
1719 pos += used;
1720
1721 val = strtol(pos, NULL, 0);
1722 if (val < 0 || val > 0xff)
1723 return -1;
1724 tos = val;
1725
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001726 eth = (struct ether_header *) &buf[2];
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001727 os_memcpy(eth->ether_dhost, dst, ETH_ALEN);
1728 os_memcpy(eth->ether_shost, src, ETH_ALEN);
1729 eth->ether_type = htons(ETHERTYPE_IP);
1730 ip = (struct iphdr *) (eth + 1);
1731 os_memset(ip, 0, sizeof(*ip));
1732 ip->ihl = 5;
1733 ip->version = 4;
1734 ip->ttl = 64;
1735 ip->tos = tos;
1736 ip->tot_len = htons(HWSIM_IP_LEN);
1737 ip->protocol = 1;
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001738 ip->saddr = htonl(192U << 24 | 168 << 16 | 1 << 8 | 1);
1739 ip->daddr = htonl(192U << 24 | 168 << 16 | 1 << 8 | 2);
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001740 ip->check = ipv4_hdr_checksum(ip, sizeof(*ip));
1741 dpos = (u8 *) (ip + 1);
1742 for (i = 0; i < HWSIM_IP_LEN - sizeof(*ip); i++)
1743 *dpos++ = i;
1744
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001745 if (l2_packet_send(hapd->l2_test, dst, ETHERTYPE_IP, &buf[2],
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08001746 HWSIM_PACKETLEN) < 0)
1747 return -1;
1748
1749 wpa_dbg(hapd->msg_ctx, MSG_DEBUG, "test data: TX dst=" MACSTR
1750 " src=" MACSTR " tos=0x%x", MAC2STR(dst), MAC2STR(src), tos);
1751
1752 return 0;
1753}
1754
1755
1756static int hostapd_ctrl_iface_data_test_frame(struct hostapd_data *hapd,
1757 char *cmd)
1758{
1759 u8 *buf;
1760 struct ether_header *eth;
1761 struct l2_packet_data *l2 = NULL;
1762 size_t len;
1763 u16 ethertype;
1764 int res = -1;
1765 const char *ifname = hapd->conf->iface;
1766
1767 if (os_strncmp(cmd, "ifname=", 7) == 0) {
1768 cmd += 7;
1769 ifname = cmd;
1770 cmd = os_strchr(cmd, ' ');
1771 if (cmd == NULL)
1772 return -1;
1773 *cmd++ = '\0';
1774 }
1775
1776 len = os_strlen(cmd);
1777 if (len & 1 || len < ETH_HLEN * 2)
1778 return -1;
1779 len /= 2;
1780
1781 buf = os_malloc(len);
1782 if (buf == NULL)
1783 return -1;
1784
1785 if (hexstr2bin(cmd, buf, len) < 0)
1786 goto done;
1787
1788 eth = (struct ether_header *) buf;
1789 ethertype = ntohs(eth->ether_type);
1790
1791 l2 = l2_packet_init(ifname, hapd->own_addr, ethertype,
1792 hostapd_data_test_rx, hapd, 1);
1793 if (l2 == NULL)
1794 goto done;
1795
1796 res = l2_packet_send(l2, eth->ether_dhost, ethertype, buf, len);
1797 wpa_dbg(hapd->msg_ctx, MSG_DEBUG, "test data: TX frame res=%d", res);
1798done:
1799 if (l2)
1800 l2_packet_deinit(l2);
1801 os_free(buf);
1802
1803 return res < 0 ? -1 : 0;
1804}
1805
Dmitry Shmidtff787d52015-01-12 13:01:47 -08001806
1807static int hostapd_ctrl_test_alloc_fail(struct hostapd_data *hapd, char *cmd)
1808{
1809#ifdef WPA_TRACE_BFD
Dmitry Shmidtff787d52015-01-12 13:01:47 -08001810 char *pos;
1811
1812 wpa_trace_fail_after = atoi(cmd);
1813 pos = os_strchr(cmd, ':');
1814 if (pos) {
1815 pos++;
1816 os_strlcpy(wpa_trace_fail_func, pos,
1817 sizeof(wpa_trace_fail_func));
1818 } else {
1819 wpa_trace_fail_after = 0;
1820 }
1821
1822 return 0;
1823#else /* WPA_TRACE_BFD */
1824 return -1;
1825#endif /* WPA_TRACE_BFD */
1826}
1827
1828
1829static int hostapd_ctrl_get_alloc_fail(struct hostapd_data *hapd,
1830 char *buf, size_t buflen)
1831{
1832#ifdef WPA_TRACE_BFD
Dmitry Shmidtff787d52015-01-12 13:01:47 -08001833 return os_snprintf(buf, buflen, "%u:%s", wpa_trace_fail_after,
1834 wpa_trace_fail_func);
1835#else /* WPA_TRACE_BFD */
1836 return -1;
1837#endif /* WPA_TRACE_BFD */
1838}
1839
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001840
1841static int hostapd_ctrl_test_fail(struct hostapd_data *hapd, char *cmd)
1842{
1843#ifdef WPA_TRACE_BFD
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001844 char *pos;
1845
1846 wpa_trace_test_fail_after = atoi(cmd);
1847 pos = os_strchr(cmd, ':');
1848 if (pos) {
1849 pos++;
1850 os_strlcpy(wpa_trace_test_fail_func, pos,
1851 sizeof(wpa_trace_test_fail_func));
1852 } else {
1853 wpa_trace_test_fail_after = 0;
1854 }
1855
1856 return 0;
1857#else /* WPA_TRACE_BFD */
1858 return -1;
1859#endif /* WPA_TRACE_BFD */
1860}
1861
1862
1863static int hostapd_ctrl_get_fail(struct hostapd_data *hapd,
1864 char *buf, size_t buflen)
1865{
1866#ifdef WPA_TRACE_BFD
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001867 return os_snprintf(buf, buflen, "%u:%s", wpa_trace_test_fail_after,
1868 wpa_trace_test_fail_func);
1869#else /* WPA_TRACE_BFD */
1870 return -1;
1871#endif /* WPA_TRACE_BFD */
1872}
1873
Dmitry Shmidtcce06662013-11-04 18:44:24 -08001874#endif /* CONFIG_TESTING_OPTIONS */
1875
1876
Dmitry Shmidtd30ac602014-06-30 09:54:22 -07001877static int hostapd_ctrl_iface_chan_switch(struct hostapd_iface *iface,
1878 char *pos)
Dmitry Shmidte0e48dc2013-11-18 12:00:06 -08001879{
1880#ifdef NEED_AP_MLME
1881 struct csa_settings settings;
Dmitry Shmidtd30ac602014-06-30 09:54:22 -07001882 int ret;
1883 unsigned int i;
Dmitry Shmidte0e48dc2013-11-18 12:00:06 -08001884
Dmitry Shmidtd30ac602014-06-30 09:54:22 -07001885 ret = hostapd_parse_csa_settings(pos, &settings);
Dmitry Shmidte0e48dc2013-11-18 12:00:06 -08001886 if (ret)
1887 return ret;
1888
Dmitry Shmidtd30ac602014-06-30 09:54:22 -07001889 for (i = 0; i < iface->num_bss; i++) {
1890 ret = hostapd_switch_channel(iface->bss[i], &settings);
1891 if (ret) {
1892 /* FIX: What do we do if CSA fails in the middle of
1893 * submitting multi-BSS CSA requests? */
1894 return ret;
1895 }
1896 }
1897
1898 return 0;
Dmitry Shmidte0e48dc2013-11-18 12:00:06 -08001899#else /* NEED_AP_MLME */
1900 return -1;
1901#endif /* NEED_AP_MLME */
1902}
1903
1904
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -08001905static int hostapd_ctrl_iface_mib(struct hostapd_data *hapd, char *reply,
1906 int reply_size, const char *param)
1907{
1908#ifdef RADIUS_SERVER
1909 if (os_strcmp(param, "radius_server") == 0) {
1910 return radius_server_get_mib(hapd->radius_srv, reply,
1911 reply_size);
1912 }
1913#endif /* RADIUS_SERVER */
1914 return -1;
1915}
1916
1917
Dmitry Shmidtdf5a7e42014-04-02 12:59:59 -07001918static int hostapd_ctrl_iface_vendor(struct hostapd_data *hapd, char *cmd,
1919 char *buf, size_t buflen)
1920{
1921 int ret;
1922 char *pos;
1923 u8 *data = NULL;
1924 unsigned int vendor_id, subcmd;
1925 struct wpabuf *reply;
1926 size_t data_len = 0;
1927
1928 /* cmd: <vendor id> <subcommand id> [<hex formatted data>] */
1929 vendor_id = strtoul(cmd, &pos, 16);
Dmitry Shmidt57c2d392016-02-23 13:40:19 -08001930 if (!isblank((unsigned char) *pos))
Dmitry Shmidtdf5a7e42014-04-02 12:59:59 -07001931 return -EINVAL;
1932
1933 subcmd = strtoul(pos, &pos, 10);
1934
1935 if (*pos != '\0') {
Dmitry Shmidt57c2d392016-02-23 13:40:19 -08001936 if (!isblank((unsigned char) *pos++))
Dmitry Shmidtdf5a7e42014-04-02 12:59:59 -07001937 return -EINVAL;
1938 data_len = os_strlen(pos);
1939 }
1940
1941 if (data_len) {
1942 data_len /= 2;
1943 data = os_malloc(data_len);
1944 if (!data)
1945 return -ENOBUFS;
1946
1947 if (hexstr2bin(pos, data, data_len)) {
1948 wpa_printf(MSG_DEBUG,
1949 "Vendor command: wrong parameter format");
1950 os_free(data);
1951 return -EINVAL;
1952 }
1953 }
1954
1955 reply = wpabuf_alloc((buflen - 1) / 2);
1956 if (!reply) {
1957 os_free(data);
1958 return -ENOBUFS;
1959 }
1960
1961 ret = hostapd_drv_vendor_cmd(hapd, vendor_id, subcmd, data, data_len,
1962 reply);
1963
1964 if (ret == 0)
1965 ret = wpa_snprintf_hex(buf, buflen, wpabuf_head_u8(reply),
1966 wpabuf_len(reply));
1967
1968 wpabuf_free(reply);
1969 os_free(data);
1970
1971 return ret;
1972}
1973
1974
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001975static int hostapd_ctrl_iface_eapol_reauth(struct hostapd_data *hapd,
1976 const char *cmd)
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001977{
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001978 u8 addr[ETH_ALEN];
1979 struct sta_info *sta;
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07001980
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08001981 if (hwaddr_aton(cmd, addr))
1982 return -1;
1983
1984 sta = ap_get_sta(hapd, addr);
1985 if (!sta || !sta->eapol_sm)
1986 return -1;
1987
1988 eapol_auth_reauthenticate(sta->eapol_sm);
1989 return 0;
1990}
1991
1992
1993static int hostapd_ctrl_iface_eapol_set(struct hostapd_data *hapd, char *cmd)
1994{
1995 u8 addr[ETH_ALEN];
1996 struct sta_info *sta;
1997 char *pos = cmd, *param;
1998
1999 if (hwaddr_aton(pos, addr) || pos[17] != ' ')
2000 return -1;
2001 pos += 18;
2002 param = pos;
2003 pos = os_strchr(pos, ' ');
2004 if (!pos)
2005 return -1;
2006 *pos++ = '\0';
2007
2008 sta = ap_get_sta(hapd, addr);
2009 if (!sta || !sta->eapol_sm)
2010 return -1;
2011
2012 return eapol_auth_set_conf(sta->eapol_sm, param, pos);
2013}
2014
2015
2016static int hostapd_ctrl_iface_log_level(struct hostapd_data *hapd, char *cmd,
2017 char *buf, size_t buflen)
2018{
2019 char *pos, *end, *stamp;
2020 int ret;
2021
2022 /* cmd: "LOG_LEVEL [<level>]" */
2023 if (*cmd == '\0') {
2024 pos = buf;
2025 end = buf + buflen;
2026 ret = os_snprintf(pos, end - pos, "Current level: %s\n"
2027 "Timestamp: %d\n",
2028 debug_level_str(wpa_debug_level),
2029 wpa_debug_timestamp);
2030 if (os_snprintf_error(end - pos, ret))
2031 ret = 0;
2032
2033 return ret;
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002034 }
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002035
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002036 while (*cmd == ' ')
2037 cmd++;
2038
2039 stamp = os_strchr(cmd, ' ');
2040 if (stamp) {
2041 *stamp++ = '\0';
2042 while (*stamp == ' ') {
2043 stamp++;
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002044 }
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002045 }
2046
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002047 if (os_strlen(cmd)) {
2048 int level = str_to_debug_level(cmd);
2049 if (level < 0)
2050 return -1;
2051 wpa_debug_level = level;
2052 }
2053
2054 if (stamp && os_strlen(stamp))
2055 wpa_debug_timestamp = atoi(stamp);
2056
2057 os_memcpy(buf, "OK\n", 3);
2058 return 3;
2059}
2060
2061
2062#ifdef NEED_AP_MLME
2063static int hostapd_ctrl_iface_track_sta_list(struct hostapd_data *hapd,
2064 char *buf, size_t buflen)
2065{
2066 struct hostapd_iface *iface = hapd->iface;
2067 char *pos, *end;
2068 struct hostapd_sta_info *info;
2069 struct os_reltime now;
2070
Dmitry Shmidt7d175302016-09-06 13:11:34 -07002071 if (!iface->num_sta_seen)
2072 return 0;
2073
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002074 sta_track_expire(iface, 0);
2075
2076 pos = buf;
2077 end = buf + buflen;
2078
2079 os_get_reltime(&now);
2080 dl_list_for_each_reverse(info, &iface->sta_seen,
2081 struct hostapd_sta_info, list) {
2082 struct os_reltime age;
2083 int ret;
2084
2085 os_reltime_sub(&now, &info->last_seen, &age);
Dmitry Shmidt9839ecd2016-11-07 11:05:47 -08002086 ret = os_snprintf(pos, end - pos, MACSTR " %u %d\n",
2087 MAC2STR(info->addr), (unsigned int) age.sec,
2088 info->ssi_signal);
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002089 if (os_snprintf_error(end - pos, ret))
2090 break;
2091 pos += ret;
2092 }
2093
2094 return pos - buf;
2095}
2096#endif /* NEED_AP_MLME */
2097
2098
Dmitry Shmidt849734c2016-05-27 09:59:01 -07002099static int hostapd_ctrl_iface_req_lci(struct hostapd_data *hapd,
2100 const char *cmd)
2101{
2102 u8 addr[ETH_ALEN];
2103
2104 if (hwaddr_aton(cmd, addr)) {
2105 wpa_printf(MSG_INFO, "CTRL: REQ_LCI: Invalid MAC address");
2106 return -1;
2107 }
2108
2109 return hostapd_send_lci_req(hapd, addr);
2110}
2111
2112
Dmitry Shmidt4ae50e62016-06-27 13:48:39 -07002113static int hostapd_ctrl_iface_req_range(struct hostapd_data *hapd, char *cmd)
Dmitry Shmidt849734c2016-05-27 09:59:01 -07002114{
2115 u8 addr[ETH_ALEN];
2116 char *token, *context = NULL;
2117 int random_interval, min_ap;
2118 u8 responders[ETH_ALEN * RRM_RANGE_REQ_MAX_RESPONDERS];
2119 unsigned int n_responders;
2120
2121 token = str_token(cmd, " ", &context);
2122 if (!token || hwaddr_aton(token, addr)) {
2123 wpa_printf(MSG_INFO,
2124 "CTRL: REQ_RANGE - Bad destination address");
2125 return -1;
2126 }
2127
2128 token = str_token(cmd, " ", &context);
2129 if (!token)
2130 return -1;
2131
2132 random_interval = atoi(token);
2133 if (random_interval < 0 || random_interval > 0xffff)
2134 return -1;
2135
2136 token = str_token(cmd, " ", &context);
2137 if (!token)
2138 return -1;
2139
2140 min_ap = atoi(token);
2141 if (min_ap <= 0 || min_ap > WLAN_RRM_RANGE_REQ_MAX_MIN_AP)
2142 return -1;
2143
2144 n_responders = 0;
2145 while ((token = str_token(cmd, " ", &context))) {
2146 if (n_responders == RRM_RANGE_REQ_MAX_RESPONDERS) {
2147 wpa_printf(MSG_INFO,
2148 "CTRL: REQ_RANGE: Too many responders");
2149 return -1;
2150 }
2151
2152 if (hwaddr_aton(token, responders + n_responders * ETH_ALEN)) {
2153 wpa_printf(MSG_INFO,
2154 "CTRL: REQ_RANGE: Bad responder address");
2155 return -1;
2156 }
2157
2158 n_responders++;
2159 }
2160
2161 if (!n_responders) {
2162 wpa_printf(MSG_INFO,
2163 "CTRL: REQ_RANGE - No FTM responder address");
2164 return -1;
2165 }
2166
2167 return hostapd_send_range_req(hapd, addr, random_interval, min_ap,
2168 responders, n_responders);
2169}
2170
2171
2172static int hostapd_ctrl_iface_set_neighbor(struct hostapd_data *hapd, char *buf)
2173{
2174 struct wpa_ssid_value ssid;
2175 u8 bssid[ETH_ALEN];
2176 struct wpabuf *nr, *lci = NULL, *civic = NULL;
Dmitry Shmidt9839ecd2016-11-07 11:05:47 -08002177 int stationary = 0;
Dmitry Shmidt849734c2016-05-27 09:59:01 -07002178 char *tmp;
2179 int ret;
2180
2181 if (!(hapd->conf->radio_measurements[0] &
2182 WLAN_RRM_CAPS_NEIGHBOR_REPORT)) {
2183 wpa_printf(MSG_ERROR,
2184 "CTRL: SET_NEIGHBOR: Neighbor report is not enabled");
2185 return -1;
2186 }
2187
2188 if (hwaddr_aton(buf, bssid)) {
2189 wpa_printf(MSG_ERROR, "CTRL: SET_NEIGHBOR: Bad BSSID");
2190 return -1;
2191 }
2192
2193 tmp = os_strstr(buf, "ssid=");
2194 if (!tmp || ssid_parse(tmp + 5, &ssid)) {
2195 wpa_printf(MSG_ERROR,
2196 "CTRL: SET_NEIGHBOR: Bad or missing SSID");
2197 return -1;
2198 }
2199 buf = os_strchr(tmp + 6, tmp[5] == '"' ? '"' : ' ');
2200 if (!buf)
2201 return -1;
2202
2203 tmp = os_strstr(buf, "nr=");
2204 if (!tmp) {
2205 wpa_printf(MSG_ERROR,
2206 "CTRL: SET_NEIGHBOR: Missing Neighbor Report element");
2207 return -1;
2208 }
2209
2210 buf = os_strchr(tmp, ' ');
2211 if (buf)
2212 *buf++ = '\0';
2213
2214 nr = wpabuf_parse_bin(tmp + 3);
2215 if (!nr) {
2216 wpa_printf(MSG_ERROR,
2217 "CTRL: SET_NEIGHBOR: Bad Neighbor Report element");
2218 return -1;
2219 }
2220
2221 if (!buf)
2222 goto set;
2223
2224 tmp = os_strstr(buf, "lci=");
2225 if (tmp) {
2226 buf = os_strchr(tmp, ' ');
2227 if (buf)
2228 *buf++ = '\0';
2229 lci = wpabuf_parse_bin(tmp + 4);
2230 if (!lci) {
2231 wpa_printf(MSG_ERROR,
2232 "CTRL: SET_NEIGHBOR: Bad LCI subelement");
2233 wpabuf_free(nr);
2234 return -1;
2235 }
2236 }
2237
2238 if (!buf)
2239 goto set;
2240
2241 tmp = os_strstr(buf, "civic=");
2242 if (tmp) {
2243 buf = os_strchr(tmp, ' ');
2244 if (buf)
2245 *buf++ = '\0';
2246 civic = wpabuf_parse_bin(tmp + 6);
2247 if (!civic) {
2248 wpa_printf(MSG_ERROR,
2249 "CTRL: SET_NEIGHBOR: Bad civic subelement");
2250 wpabuf_free(nr);
2251 wpabuf_free(lci);
2252 return -1;
2253 }
2254 }
2255
Dmitry Shmidt9839ecd2016-11-07 11:05:47 -08002256 if (!buf)
2257 goto set;
2258
2259 if (os_strstr(buf, "stat"))
2260 stationary = 1;
2261
Dmitry Shmidt849734c2016-05-27 09:59:01 -07002262set:
Dmitry Shmidt9839ecd2016-11-07 11:05:47 -08002263 ret = hostapd_neighbor_set(hapd, bssid, &ssid, nr, lci, civic,
2264 stationary);
Dmitry Shmidt849734c2016-05-27 09:59:01 -07002265
2266 wpabuf_free(nr);
2267 wpabuf_free(lci);
2268 wpabuf_free(civic);
2269
2270 return ret;
2271}
2272
2273
2274static int hostapd_ctrl_iface_remove_neighbor(struct hostapd_data *hapd,
2275 char *buf)
2276{
2277 struct wpa_ssid_value ssid;
2278 u8 bssid[ETH_ALEN];
2279 char *tmp;
2280
2281 if (hwaddr_aton(buf, bssid)) {
2282 wpa_printf(MSG_ERROR, "CTRL: REMOVE_NEIGHBOR: Bad BSSID");
2283 return -1;
2284 }
2285
2286 tmp = os_strstr(buf, "ssid=");
2287 if (!tmp || ssid_parse(tmp + 5, &ssid)) {
2288 wpa_printf(MSG_ERROR,
2289 "CTRL: REMOVE_NEIGHBORr: Bad or missing SSID");
2290 return -1;
2291 }
2292
2293 return hostapd_neighbor_remove(hapd, bssid, &ssid);
2294}
2295
2296
Dmitry Shmidt58d12ad2016-07-28 10:07:03 -07002297static int hostapd_ctrl_driver_flags(struct hostapd_iface *iface, char *buf,
2298 size_t buflen)
2299{
2300 int ret, i;
2301 char *pos, *end;
2302
2303 ret = os_snprintf(buf, buflen, "%016llX:\n",
2304 (long long unsigned) iface->drv_flags);
2305 if (os_snprintf_error(buflen, ret))
2306 return -1;
2307
2308 pos = buf + ret;
2309 end = buf + buflen;
2310
2311 for (i = 0; i < 64; i++) {
2312 if (iface->drv_flags & (1LLU << i)) {
2313 ret = os_snprintf(pos, end - pos, "%s\n",
2314 driver_flag_to_string(1LLU << i));
2315 if (os_snprintf_error(end - pos, ret))
2316 return -1;
2317 pos += ret;
2318 }
2319 }
2320
2321 return pos - buf;
2322}
2323
2324
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002325static int hostapd_ctrl_iface_receive_process(struct hostapd_data *hapd,
2326 char *buf, char *reply,
2327 int reply_size,
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002328 struct sockaddr_storage *from,
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002329 socklen_t fromlen)
2330{
2331 int reply_len, res;
2332
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002333 os_memcpy(reply, "OK\n", 3);
2334 reply_len = 3;
2335
2336 if (os_strcmp(buf, "PING") == 0) {
2337 os_memcpy(reply, "PONG\n", 5);
2338 reply_len = 5;
2339 } else if (os_strncmp(buf, "RELOG", 5) == 0) {
2340 if (wpa_debug_reopen_file() < 0)
2341 reply_len = -1;
Dmitry Shmidtcce06662013-11-04 18:44:24 -08002342 } else if (os_strcmp(buf, "STATUS") == 0) {
2343 reply_len = hostapd_ctrl_iface_status(hapd, reply,
2344 reply_size);
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -08002345 } else if (os_strcmp(buf, "STATUS-DRIVER") == 0) {
2346 reply_len = hostapd_drv_status(hapd, reply, reply_size);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002347 } else if (os_strcmp(buf, "MIB") == 0) {
2348 reply_len = ieee802_11_get_mib(hapd, reply, reply_size);
2349 if (reply_len >= 0) {
2350 res = wpa_get_mib(hapd->wpa_auth, reply + reply_len,
2351 reply_size - reply_len);
2352 if (res < 0)
2353 reply_len = -1;
2354 else
2355 reply_len += res;
2356 }
2357 if (reply_len >= 0) {
2358 res = ieee802_1x_get_mib(hapd, reply + reply_len,
2359 reply_size - reply_len);
2360 if (res < 0)
2361 reply_len = -1;
2362 else
2363 reply_len += res;
2364 }
2365#ifndef CONFIG_NO_RADIUS
2366 if (reply_len >= 0) {
2367 res = radius_client_get_mib(hapd->radius,
2368 reply + reply_len,
2369 reply_size - reply_len);
2370 if (res < 0)
2371 reply_len = -1;
2372 else
2373 reply_len += res;
2374 }
2375#endif /* CONFIG_NO_RADIUS */
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -08002376 } else if (os_strncmp(buf, "MIB ", 4) == 0) {
2377 reply_len = hostapd_ctrl_iface_mib(hapd, reply, reply_size,
2378 buf + 4);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002379 } else if (os_strcmp(buf, "STA-FIRST") == 0) {
2380 reply_len = hostapd_ctrl_iface_sta_first(hapd, reply,
2381 reply_size);
2382 } else if (os_strncmp(buf, "STA ", 4) == 0) {
2383 reply_len = hostapd_ctrl_iface_sta(hapd, buf + 4, reply,
2384 reply_size);
2385 } else if (os_strncmp(buf, "STA-NEXT ", 9) == 0) {
2386 reply_len = hostapd_ctrl_iface_sta_next(hapd, buf + 9, reply,
2387 reply_size);
2388 } else if (os_strcmp(buf, "ATTACH") == 0) {
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002389 if (hostapd_ctrl_iface_attach(hapd, from, fromlen))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002390 reply_len = -1;
2391 } else if (os_strcmp(buf, "DETACH") == 0) {
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002392 if (hostapd_ctrl_iface_detach(hapd, from, fromlen))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002393 reply_len = -1;
2394 } else if (os_strncmp(buf, "LEVEL ", 6) == 0) {
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002395 if (hostapd_ctrl_iface_level(hapd, from, fromlen,
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002396 buf + 6))
2397 reply_len = -1;
2398 } else if (os_strncmp(buf, "NEW_STA ", 8) == 0) {
2399 if (hostapd_ctrl_iface_new_sta(hapd, buf + 8))
2400 reply_len = -1;
2401 } else if (os_strncmp(buf, "DEAUTHENTICATE ", 15) == 0) {
2402 if (hostapd_ctrl_iface_deauthenticate(hapd, buf + 15))
2403 reply_len = -1;
2404 } else if (os_strncmp(buf, "DISASSOCIATE ", 13) == 0) {
2405 if (hostapd_ctrl_iface_disassociate(hapd, buf + 13))
2406 reply_len = -1;
Dmitry Shmidtaca489e2016-09-28 15:44:14 -07002407#ifdef CONFIG_TAXONOMY
2408 } else if (os_strncmp(buf, "SIGNATURE ", 10) == 0) {
2409 reply_len = hostapd_ctrl_iface_signature(hapd, buf + 10,
2410 reply, reply_size);
2411#endif /* CONFIG_TAXONOMY */
Dmitry Shmidt849734c2016-05-27 09:59:01 -07002412 } else if (os_strncmp(buf, "POLL_STA ", 9) == 0) {
2413 if (hostapd_ctrl_iface_poll_sta(hapd, buf + 9))
2414 reply_len = -1;
Dmitry Shmidt7f656022015-02-25 14:36:37 -08002415 } else if (os_strcmp(buf, "STOP_AP") == 0) {
2416 if (hostapd_ctrl_iface_stop_ap(hapd))
2417 reply_len = -1;
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002418#ifdef CONFIG_IEEE80211W
2419#ifdef NEED_AP_MLME
2420 } else if (os_strncmp(buf, "SA_QUERY ", 9) == 0) {
2421 if (hostapd_ctrl_iface_sa_query(hapd, buf + 9))
2422 reply_len = -1;
2423#endif /* NEED_AP_MLME */
2424#endif /* CONFIG_IEEE80211W */
2425#ifdef CONFIG_WPS
2426 } else if (os_strncmp(buf, "WPS_PIN ", 8) == 0) {
2427 if (hostapd_ctrl_iface_wps_pin(hapd, buf + 8))
2428 reply_len = -1;
2429 } else if (os_strncmp(buf, "WPS_CHECK_PIN ", 14) == 0) {
2430 reply_len = hostapd_ctrl_iface_wps_check_pin(
2431 hapd, buf + 14, reply, reply_size);
2432 } else if (os_strcmp(buf, "WPS_PBC") == 0) {
2433 if (hostapd_wps_button_pushed(hapd, NULL))
2434 reply_len = -1;
Dmitry Shmidt04949592012-07-19 12:16:46 -07002435 } else if (os_strcmp(buf, "WPS_CANCEL") == 0) {
2436 if (hostapd_wps_cancel(hapd))
2437 reply_len = -1;
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002438 } else if (os_strncmp(buf, "WPS_AP_PIN ", 11) == 0) {
2439 reply_len = hostapd_ctrl_iface_wps_ap_pin(hapd, buf + 11,
2440 reply, reply_size);
2441 } else if (os_strncmp(buf, "WPS_CONFIG ", 11) == 0) {
2442 if (hostapd_ctrl_iface_wps_config(hapd, buf + 11) < 0)
2443 reply_len = -1;
Dmitry Shmidtb7b4d0e2013-08-26 12:09:05 -07002444 } else if (os_strncmp(buf, "WPS_GET_STATUS", 13) == 0) {
2445 reply_len = hostapd_ctrl_iface_wps_get_status(hapd, reply,
2446 reply_size);
Dmitry Shmidt04949592012-07-19 12:16:46 -07002447#ifdef CONFIG_WPS_NFC
2448 } else if (os_strncmp(buf, "WPS_NFC_TAG_READ ", 17) == 0) {
2449 if (hostapd_ctrl_iface_wps_nfc_tag_read(hapd, buf + 17))
2450 reply_len = -1;
2451 } else if (os_strncmp(buf, "WPS_NFC_CONFIG_TOKEN ", 21) == 0) {
2452 reply_len = hostapd_ctrl_iface_wps_nfc_config_token(
2453 hapd, buf + 21, reply, reply_size);
2454 } else if (os_strncmp(buf, "WPS_NFC_TOKEN ", 14) == 0) {
2455 reply_len = hostapd_ctrl_iface_wps_nfc_token(
2456 hapd, buf + 14, reply, reply_size);
Dmitry Shmidtf8623282013-02-20 14:34:59 -08002457 } else if (os_strncmp(buf, "NFC_GET_HANDOVER_SEL ", 21) == 0) {
2458 reply_len = hostapd_ctrl_iface_nfc_get_handover_sel(
2459 hapd, buf + 21, reply, reply_size);
2460 } else if (os_strncmp(buf, "NFC_REPORT_HANDOVER ", 20) == 0) {
2461 if (hostapd_ctrl_iface_nfc_report_handover(hapd, buf + 20))
2462 reply_len = -1;
Dmitry Shmidt04949592012-07-19 12:16:46 -07002463#endif /* CONFIG_WPS_NFC */
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002464#endif /* CONFIG_WPS */
Dmitry Shmidt051af732013-10-22 13:52:46 -07002465#ifdef CONFIG_INTERWORKING
2466 } else if (os_strncmp(buf, "SET_QOS_MAP_SET ", 16) == 0) {
2467 if (hostapd_ctrl_iface_set_qos_map_set(hapd, buf + 16))
2468 reply_len = -1;
2469 } else if (os_strncmp(buf, "SEND_QOS_MAP_CONF ", 18) == 0) {
2470 if (hostapd_ctrl_iface_send_qos_map_conf(hapd, buf + 18))
2471 reply_len = -1;
2472#endif /* CONFIG_INTERWORKING */
Dmitry Shmidtf21452a2014-02-26 10:55:25 -08002473#ifdef CONFIG_HS20
2474 } else if (os_strncmp(buf, "HS20_WNM_NOTIF ", 15) == 0) {
2475 if (hostapd_ctrl_iface_hs20_wnm_notif(hapd, buf + 15))
2476 reply_len = -1;
2477 } else if (os_strncmp(buf, "HS20_DEAUTH_REQ ", 16) == 0) {
2478 if (hostapd_ctrl_iface_hs20_deauth_req(hapd, buf + 16))
2479 reply_len = -1;
2480#endif /* CONFIG_HS20 */
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -08002481#ifdef CONFIG_WNM
2482 } else if (os_strncmp(buf, "DISASSOC_IMMINENT ", 18) == 0) {
2483 if (hostapd_ctrl_iface_disassoc_imminent(hapd, buf + 18))
2484 reply_len = -1;
Dmitry Shmidt1f69aa52012-01-24 16:10:04 -08002485 } else if (os_strncmp(buf, "ESS_DISASSOC ", 13) == 0) {
2486 if (hostapd_ctrl_iface_ess_disassoc(hapd, buf + 13))
2487 reply_len = -1;
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002488 } else if (os_strncmp(buf, "BSS_TM_REQ ", 11) == 0) {
2489 if (hostapd_ctrl_iface_bss_tm_req(hapd, buf + 11))
2490 reply_len = -1;
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -08002491#endif /* CONFIG_WNM */
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002492 } else if (os_strcmp(buf, "GET_CONFIG") == 0) {
2493 reply_len = hostapd_ctrl_iface_get_config(hapd, reply,
2494 reply_size);
2495 } else if (os_strncmp(buf, "SET ", 4) == 0) {
2496 if (hostapd_ctrl_iface_set(hapd, buf + 4))
2497 reply_len = -1;
2498 } else if (os_strncmp(buf, "GET ", 4) == 0) {
2499 reply_len = hostapd_ctrl_iface_get(hapd, buf + 4, reply,
2500 reply_size);
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07002501 } else if (os_strncmp(buf, "ENABLE", 6) == 0) {
2502 if (hostapd_ctrl_iface_enable(hapd->iface))
2503 reply_len = -1;
2504 } else if (os_strncmp(buf, "RELOAD", 6) == 0) {
2505 if (hostapd_ctrl_iface_reload(hapd->iface))
2506 reply_len = -1;
2507 } else if (os_strncmp(buf, "DISABLE", 7) == 0) {
2508 if (hostapd_ctrl_iface_disable(hapd->iface))
2509 reply_len = -1;
Dmitry Shmidt7f656022015-02-25 14:36:37 -08002510 } else if (os_strcmp(buf, "UPDATE_BEACON") == 0) {
2511 if (ieee802_11_set_beacon(hapd))
2512 reply_len = -1;
Dmitry Shmidtcce06662013-11-04 18:44:24 -08002513#ifdef CONFIG_TESTING_OPTIONS
2514 } else if (os_strncmp(buf, "RADAR ", 6) == 0) {
2515 if (hostapd_ctrl_iface_radar(hapd, buf + 6))
2516 reply_len = -1;
Dmitry Shmidtfb79edc2014-01-10 10:45:54 -08002517 } else if (os_strncmp(buf, "MGMT_TX ", 8) == 0) {
2518 if (hostapd_ctrl_iface_mgmt_tx(hapd, buf + 8))
2519 reply_len = -1;
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002520 } else if (os_strncmp(buf, "EAPOL_RX ", 9) == 0) {
2521 if (hostapd_ctrl_iface_eapol_rx(hapd, buf + 9) < 0)
2522 reply_len = -1;
2523 } else if (os_strncmp(buf, "DATA_TEST_CONFIG ", 17) == 0) {
2524 if (hostapd_ctrl_iface_data_test_config(hapd, buf + 17) < 0)
2525 reply_len = -1;
2526 } else if (os_strncmp(buf, "DATA_TEST_TX ", 13) == 0) {
2527 if (hostapd_ctrl_iface_data_test_tx(hapd, buf + 13) < 0)
2528 reply_len = -1;
2529 } else if (os_strncmp(buf, "DATA_TEST_FRAME ", 16) == 0) {
2530 if (hostapd_ctrl_iface_data_test_frame(hapd, buf + 16) < 0)
2531 reply_len = -1;
Dmitry Shmidtff787d52015-01-12 13:01:47 -08002532 } else if (os_strncmp(buf, "TEST_ALLOC_FAIL ", 16) == 0) {
2533 if (hostapd_ctrl_test_alloc_fail(hapd, buf + 16) < 0)
2534 reply_len = -1;
2535 } else if (os_strcmp(buf, "GET_ALLOC_FAIL") == 0) {
2536 reply_len = hostapd_ctrl_get_alloc_fail(hapd, reply,
2537 reply_size);
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002538 } else if (os_strncmp(buf, "TEST_FAIL ", 10) == 0) {
2539 if (hostapd_ctrl_test_fail(hapd, buf + 10) < 0)
2540 reply_len = -1;
2541 } else if (os_strcmp(buf, "GET_FAIL") == 0) {
2542 reply_len = hostapd_ctrl_get_fail(hapd, reply, reply_size);
Dmitry Shmidtcce06662013-11-04 18:44:24 -08002543#endif /* CONFIG_TESTING_OPTIONS */
Dmitry Shmidte0e48dc2013-11-18 12:00:06 -08002544 } else if (os_strncmp(buf, "CHAN_SWITCH ", 12) == 0) {
Dmitry Shmidtd30ac602014-06-30 09:54:22 -07002545 if (hostapd_ctrl_iface_chan_switch(hapd->iface, buf + 12))
Dmitry Shmidte0e48dc2013-11-18 12:00:06 -08002546 reply_len = -1;
Dmitry Shmidtdf5a7e42014-04-02 12:59:59 -07002547 } else if (os_strncmp(buf, "VENDOR ", 7) == 0) {
2548 reply_len = hostapd_ctrl_iface_vendor(hapd, buf + 7, reply,
2549 reply_size);
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002550 } else if (os_strcmp(buf, "ERP_FLUSH") == 0) {
2551 ieee802_1x_erp_flush(hapd);
2552#ifdef RADIUS_SERVER
2553 radius_server_erp_flush(hapd->radius_srv);
2554#endif /* RADIUS_SERVER */
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002555 } else if (os_strncmp(buf, "EAPOL_REAUTH ", 13) == 0) {
2556 if (hostapd_ctrl_iface_eapol_reauth(hapd, buf + 13))
2557 reply_len = -1;
2558 } else if (os_strncmp(buf, "EAPOL_SET ", 10) == 0) {
2559 if (hostapd_ctrl_iface_eapol_set(hapd, buf + 10))
2560 reply_len = -1;
2561 } else if (os_strncmp(buf, "LOG_LEVEL", 9) == 0) {
2562 reply_len = hostapd_ctrl_iface_log_level(
2563 hapd, buf + 9, reply, reply_size);
2564#ifdef NEED_AP_MLME
2565 } else if (os_strcmp(buf, "TRACK_STA_LIST") == 0) {
2566 reply_len = hostapd_ctrl_iface_track_sta_list(
2567 hapd, reply, reply_size);
2568#endif /* NEED_AP_MLME */
Dmitry Shmidte4663042016-04-04 10:07:49 -07002569 } else if (os_strcmp(buf, "PMKSA") == 0) {
2570 reply_len = hostapd_ctrl_iface_pmksa_list(hapd, reply,
2571 reply_size);
2572 } else if (os_strcmp(buf, "PMKSA_FLUSH") == 0) {
2573 hostapd_ctrl_iface_pmksa_flush(hapd);
Dmitry Shmidt849734c2016-05-27 09:59:01 -07002574 } else if (os_strncmp(buf, "SET_NEIGHBOR ", 13) == 0) {
2575 if (hostapd_ctrl_iface_set_neighbor(hapd, buf + 13))
2576 reply_len = -1;
2577 } else if (os_strncmp(buf, "REMOVE_NEIGHBOR ", 16) == 0) {
2578 if (hostapd_ctrl_iface_remove_neighbor(hapd, buf + 16))
2579 reply_len = -1;
2580 } else if (os_strncmp(buf, "REQ_LCI ", 8) == 0) {
2581 if (hostapd_ctrl_iface_req_lci(hapd, buf + 8))
2582 reply_len = -1;
2583 } else if (os_strncmp(buf, "REQ_RANGE ", 10) == 0) {
2584 if (hostapd_ctrl_iface_req_range(hapd, buf + 10))
2585 reply_len = -1;
Dmitry Shmidt58d12ad2016-07-28 10:07:03 -07002586 } else if (os_strcmp(buf, "DRIVER_FLAGS") == 0) {
2587 reply_len = hostapd_ctrl_driver_flags(hapd->iface, reply,
2588 reply_size);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002589 } else {
2590 os_memcpy(reply, "UNKNOWN COMMAND\n", 16);
2591 reply_len = 16;
2592 }
2593
2594 if (reply_len < 0) {
2595 os_memcpy(reply, "FAIL\n", 5);
2596 reply_len = 5;
2597 }
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002598
2599 return reply_len;
2600}
2601
2602
2603static void hostapd_ctrl_iface_receive(int sock, void *eloop_ctx,
2604 void *sock_ctx)
2605{
2606 struct hostapd_data *hapd = eloop_ctx;
2607 char buf[4096];
2608 int res;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002609 struct sockaddr_storage from;
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002610 socklen_t fromlen = sizeof(from);
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002611 char *reply, *pos = buf;
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002612 const int reply_size = 4096;
2613 int reply_len;
2614 int level = MSG_DEBUG;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002615#ifdef CONFIG_CTRL_IFACE_UDP
2616 unsigned char lcookie[COOKIE_LEN];
2617#endif /* CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002618
2619 res = recvfrom(sock, buf, sizeof(buf) - 1, 0,
2620 (struct sockaddr *) &from, &fromlen);
2621 if (res < 0) {
2622 wpa_printf(MSG_ERROR, "recvfrom(ctrl_iface): %s",
2623 strerror(errno));
2624 return;
2625 }
2626 buf[res] = '\0';
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002627
2628 reply = os_malloc(reply_size);
2629 if (reply == NULL) {
2630 if (sendto(sock, "FAIL\n", 5, 0, (struct sockaddr *) &from,
2631 fromlen) < 0) {
2632 wpa_printf(MSG_DEBUG, "CTRL: sendto failed: %s",
2633 strerror(errno));
2634 }
2635 return;
2636 }
2637
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002638#ifdef CONFIG_CTRL_IFACE_UDP
2639 if (os_strcmp(buf, "GET_COOKIE") == 0) {
2640 os_memcpy(reply, "COOKIE=", 7);
2641 wpa_snprintf_hex(reply + 7, 2 * COOKIE_LEN + 1,
2642 cookie, COOKIE_LEN);
2643 reply_len = 7 + 2 * COOKIE_LEN;
2644 goto done;
2645 }
2646
2647 if (os_strncmp(buf, "COOKIE=", 7) != 0 ||
2648 hexstr2bin(buf + 7, lcookie, COOKIE_LEN) < 0) {
2649 wpa_printf(MSG_DEBUG,
2650 "CTRL: No cookie in the request - drop request");
2651 os_free(reply);
2652 return;
2653 }
2654
2655 if (os_memcmp(cookie, lcookie, COOKIE_LEN) != 0) {
2656 wpa_printf(MSG_DEBUG,
2657 "CTRL: Invalid cookie in the request - drop request");
2658 os_free(reply);
2659 return;
2660 }
2661
2662 pos = buf + 7 + 2 * COOKIE_LEN;
2663 while (*pos == ' ')
2664 pos++;
2665#endif /* CONFIG_CTRL_IFACE_UDP */
2666
2667 if (os_strcmp(pos, "PING") == 0)
2668 level = MSG_EXCESSIVE;
2669 wpa_hexdump_ascii(level, "RX ctrl_iface", pos, res);
2670
2671 reply_len = hostapd_ctrl_iface_receive_process(hapd, pos,
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08002672 reply, reply_size,
2673 &from, fromlen);
2674
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002675#ifdef CONFIG_CTRL_IFACE_UDP
2676done:
2677#endif /* CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002678 if (sendto(sock, reply, reply_len, 0, (struct sockaddr *) &from,
2679 fromlen) < 0) {
2680 wpa_printf(MSG_DEBUG, "CTRL: sendto failed: %s",
2681 strerror(errno));
2682 }
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002683 os_free(reply);
2684}
2685
2686
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002687#ifndef CONFIG_CTRL_IFACE_UDP
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002688static char * hostapd_ctrl_iface_path(struct hostapd_data *hapd)
2689{
2690 char *buf;
2691 size_t len;
2692
2693 if (hapd->conf->ctrl_interface == NULL)
2694 return NULL;
2695
2696 len = os_strlen(hapd->conf->ctrl_interface) +
2697 os_strlen(hapd->conf->iface) + 2;
2698 buf = os_malloc(len);
2699 if (buf == NULL)
2700 return NULL;
2701
2702 os_snprintf(buf, len, "%s/%s",
2703 hapd->conf->ctrl_interface, hapd->conf->iface);
2704 buf[len - 1] = '\0';
2705 return buf;
2706}
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002707#endif /* CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002708
2709
Dmitry Shmidt7a53dbb2015-06-11 13:13:53 -07002710static void hostapd_ctrl_iface_msg_cb(void *ctx, int level,
2711 enum wpa_msg_type type,
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002712 const char *txt, size_t len)
2713{
2714 struct hostapd_data *hapd = ctx;
2715 if (hapd == NULL)
2716 return;
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02002717 hostapd_ctrl_iface_send(hapd, level, type, txt, len);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002718}
2719
2720
2721int hostapd_ctrl_iface_init(struct hostapd_data *hapd)
2722{
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002723#ifdef CONFIG_CTRL_IFACE_UDP
2724 int port = HOSTAPD_CTRL_IFACE_PORT;
2725 char p[32] = { 0 };
2726 char port_str[40], *tmp;
2727 char *pos;
2728 struct addrinfo hints = { 0 }, *res, *saveres;
2729 int n;
2730
2731 if (hapd->ctrl_sock > -1) {
2732 wpa_printf(MSG_DEBUG, "ctrl_iface already exists!");
2733 return 0;
2734 }
2735
2736 if (hapd->conf->ctrl_interface == NULL)
2737 return 0;
2738
2739 pos = os_strstr(hapd->conf->ctrl_interface, "udp:");
2740 if (pos) {
2741 pos += 4;
2742 port = atoi(pos);
2743 if (port <= 0) {
2744 wpa_printf(MSG_ERROR, "Invalid ctrl_iface UDP port");
2745 goto fail;
2746 }
2747 }
2748
2749 dl_list_init(&hapd->ctrl_dst);
2750 hapd->ctrl_sock = -1;
2751 os_get_random(cookie, COOKIE_LEN);
2752
2753#ifdef CONFIG_CTRL_IFACE_UDP_REMOTE
2754 hints.ai_flags = AI_PASSIVE;
2755#endif /* CONFIG_CTRL_IFACE_UDP_REMOTE */
2756
2757#ifdef CONFIG_CTRL_IFACE_UDP_IPV6
2758 hints.ai_family = AF_INET6;
2759#else /* CONFIG_CTRL_IFACE_UDP_IPV6 */
2760 hints.ai_family = AF_INET;
2761#endif /* CONFIG_CTRL_IFACE_UDP_IPV6 */
2762 hints.ai_socktype = SOCK_DGRAM;
2763
2764try_again:
2765 os_snprintf(p, sizeof(p), "%d", port);
2766 n = getaddrinfo(NULL, p, &hints, &res);
2767 if (n) {
2768 wpa_printf(MSG_ERROR, "getaddrinfo(): %s", gai_strerror(n));
2769 goto fail;
2770 }
2771
2772 saveres = res;
2773 hapd->ctrl_sock = socket(res->ai_family, res->ai_socktype,
2774 res->ai_protocol);
2775 if (hapd->ctrl_sock < 0) {
2776 wpa_printf(MSG_ERROR, "socket(PF_INET): %s", strerror(errno));
2777 goto fail;
2778 }
2779
2780 if (bind(hapd->ctrl_sock, res->ai_addr, res->ai_addrlen) < 0) {
2781 port--;
2782 if ((HOSTAPD_CTRL_IFACE_PORT - port) <
2783 HOSTAPD_CTRL_IFACE_PORT_LIMIT && !pos)
2784 goto try_again;
2785 wpa_printf(MSG_ERROR, "bind(AF_INET): %s", strerror(errno));
2786 goto fail;
2787 }
2788
2789 freeaddrinfo(saveres);
2790
2791 os_snprintf(port_str, sizeof(port_str), "udp:%d", port);
2792 tmp = os_strdup(port_str);
2793 if (tmp) {
2794 os_free(hapd->conf->ctrl_interface);
2795 hapd->conf->ctrl_interface = tmp;
2796 }
2797 wpa_printf(MSG_DEBUG, "ctrl_iface_init UDP port: %d", port);
2798
2799 if (eloop_register_read_sock(hapd->ctrl_sock,
2800 hostapd_ctrl_iface_receive, hapd, NULL) <
2801 0) {
2802 hostapd_ctrl_iface_deinit(hapd);
2803 return -1;
2804 }
2805
2806 hapd->msg_ctx = hapd;
2807 wpa_msg_register_cb(hostapd_ctrl_iface_msg_cb);
2808
2809 return 0;
2810
2811fail:
2812 if (hapd->ctrl_sock >= 0)
2813 close(hapd->ctrl_sock);
2814 return -1;
2815#else /* CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002816 struct sockaddr_un addr;
2817 int s = -1;
2818 char *fname = NULL;
2819
Dmitry Shmidt04949592012-07-19 12:16:46 -07002820 if (hapd->ctrl_sock > -1) {
2821 wpa_printf(MSG_DEBUG, "ctrl_iface already exists!");
2822 return 0;
2823 }
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002824
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002825 dl_list_init(&hapd->ctrl_dst);
2826
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002827 if (hapd->conf->ctrl_interface == NULL)
2828 return 0;
2829
2830 if (mkdir(hapd->conf->ctrl_interface, S_IRWXU | S_IRWXG) < 0) {
2831 if (errno == EEXIST) {
2832 wpa_printf(MSG_DEBUG, "Using existing control "
2833 "interface directory.");
2834 } else {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002835 wpa_printf(MSG_ERROR, "mkdir[ctrl_interface]: %s",
2836 strerror(errno));
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002837 goto fail;
2838 }
2839 }
2840
2841 if (hapd->conf->ctrl_interface_gid_set &&
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -08002842 chown(hapd->conf->ctrl_interface, -1,
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002843 hapd->conf->ctrl_interface_gid) < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002844 wpa_printf(MSG_ERROR, "chown[ctrl_interface]: %s",
2845 strerror(errno));
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002846 return -1;
2847 }
2848
Dmitry Shmidt0ccb66e2013-03-29 16:41:28 -07002849 if (!hapd->conf->ctrl_interface_gid_set &&
2850 hapd->iface->interfaces->ctrl_iface_group &&
2851 chown(hapd->conf->ctrl_interface, -1,
2852 hapd->iface->interfaces->ctrl_iface_group) < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002853 wpa_printf(MSG_ERROR, "chown[ctrl_interface]: %s",
2854 strerror(errno));
Dmitry Shmidt0ccb66e2013-03-29 16:41:28 -07002855 return -1;
2856 }
2857
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -08002858#ifdef ANDROID
2859 /*
2860 * Android is using umask 0077 which would leave the control interface
2861 * directory without group access. This breaks things since Wi-Fi
2862 * framework assumes that this directory can be accessed by other
2863 * applications in the wifi group. Fix this by adding group access even
2864 * if umask value would prevent this.
2865 */
2866 if (chmod(hapd->conf->ctrl_interface, S_IRWXU | S_IRWXG) < 0) {
2867 wpa_printf(MSG_ERROR, "CTRL: Could not chmod directory: %s",
2868 strerror(errno));
2869 /* Try to continue anyway */
2870 }
2871#endif /* ANDROID */
2872
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002873 if (os_strlen(hapd->conf->ctrl_interface) + 1 +
2874 os_strlen(hapd->conf->iface) >= sizeof(addr.sun_path))
2875 goto fail;
2876
2877 s = socket(PF_UNIX, SOCK_DGRAM, 0);
2878 if (s < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002879 wpa_printf(MSG_ERROR, "socket(PF_UNIX): %s", strerror(errno));
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002880 goto fail;
2881 }
2882
2883 os_memset(&addr, 0, sizeof(addr));
2884#ifdef __FreeBSD__
2885 addr.sun_len = sizeof(addr);
2886#endif /* __FreeBSD__ */
2887 addr.sun_family = AF_UNIX;
2888 fname = hostapd_ctrl_iface_path(hapd);
2889 if (fname == NULL)
2890 goto fail;
2891 os_strlcpy(addr.sun_path, fname, sizeof(addr.sun_path));
2892 if (bind(s, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
2893 wpa_printf(MSG_DEBUG, "ctrl_iface bind(PF_UNIX) failed: %s",
2894 strerror(errno));
2895 if (connect(s, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
2896 wpa_printf(MSG_DEBUG, "ctrl_iface exists, but does not"
2897 " allow connections - assuming it was left"
2898 "over from forced program termination");
2899 if (unlink(fname) < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002900 wpa_printf(MSG_ERROR,
2901 "Could not unlink existing ctrl_iface socket '%s': %s",
2902 fname, strerror(errno));
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002903 goto fail;
2904 }
2905 if (bind(s, (struct sockaddr *) &addr, sizeof(addr)) <
2906 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002907 wpa_printf(MSG_ERROR,
2908 "hostapd-ctrl-iface: bind(PF_UNIX): %s",
2909 strerror(errno));
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002910 goto fail;
2911 }
2912 wpa_printf(MSG_DEBUG, "Successfully replaced leftover "
2913 "ctrl_iface socket '%s'", fname);
2914 } else {
2915 wpa_printf(MSG_INFO, "ctrl_iface exists and seems to "
2916 "be in use - cannot override it");
2917 wpa_printf(MSG_INFO, "Delete '%s' manually if it is "
2918 "not used anymore", fname);
2919 os_free(fname);
2920 fname = NULL;
2921 goto fail;
2922 }
2923 }
2924
2925 if (hapd->conf->ctrl_interface_gid_set &&
Dmitry Shmidta54fa5f2013-01-15 13:53:35 -08002926 chown(fname, -1, hapd->conf->ctrl_interface_gid) < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002927 wpa_printf(MSG_ERROR, "chown[ctrl_interface/ifname]: %s",
2928 strerror(errno));
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002929 goto fail;
2930 }
2931
Dmitry Shmidt0ccb66e2013-03-29 16:41:28 -07002932 if (!hapd->conf->ctrl_interface_gid_set &&
2933 hapd->iface->interfaces->ctrl_iface_group &&
2934 chown(fname, -1, hapd->iface->interfaces->ctrl_iface_group) < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002935 wpa_printf(MSG_ERROR, "chown[ctrl_interface/ifname]: %s",
2936 strerror(errno));
Dmitry Shmidt0ccb66e2013-03-29 16:41:28 -07002937 goto fail;
2938 }
2939
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002940 if (chmod(fname, S_IRWXU | S_IRWXG) < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08002941 wpa_printf(MSG_ERROR, "chmod[ctrl_interface/ifname]: %s",
2942 strerror(errno));
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002943 goto fail;
2944 }
2945 os_free(fname);
2946
2947 hapd->ctrl_sock = s;
Dmitry Shmidtff787d52015-01-12 13:01:47 -08002948 if (eloop_register_read_sock(s, hostapd_ctrl_iface_receive, hapd,
2949 NULL) < 0) {
2950 hostapd_ctrl_iface_deinit(hapd);
2951 return -1;
2952 }
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002953 hapd->msg_ctx = hapd;
2954 wpa_msg_register_cb(hostapd_ctrl_iface_msg_cb);
2955
2956 return 0;
2957
2958fail:
2959 if (s >= 0)
2960 close(s);
2961 if (fname) {
2962 unlink(fname);
2963 os_free(fname);
2964 }
2965 return -1;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002966#endif /* CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002967}
2968
2969
2970void hostapd_ctrl_iface_deinit(struct hostapd_data *hapd)
2971{
2972 struct wpa_ctrl_dst *dst, *prev;
2973
2974 if (hapd->ctrl_sock > -1) {
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002975#ifndef CONFIG_CTRL_IFACE_UDP
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002976 char *fname;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002977#endif /* !CONFIG_CTRL_IFACE_UDP */
2978
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002979 eloop_unregister_read_sock(hapd->ctrl_sock);
2980 close(hapd->ctrl_sock);
2981 hapd->ctrl_sock = -1;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08002982#ifndef CONFIG_CTRL_IFACE_UDP
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002983 fname = hostapd_ctrl_iface_path(hapd);
2984 if (fname)
2985 unlink(fname);
2986 os_free(fname);
2987
2988 if (hapd->conf->ctrl_interface &&
2989 rmdir(hapd->conf->ctrl_interface) < 0) {
2990 if (errno == ENOTEMPTY) {
2991 wpa_printf(MSG_DEBUG, "Control interface "
2992 "directory not empty - leaving it "
2993 "behind");
2994 } else {
Dmitry Shmidtb7b4d0e2013-08-26 12:09:05 -07002995 wpa_printf(MSG_ERROR,
2996 "rmdir[ctrl_interface=%s]: %s",
2997 hapd->conf->ctrl_interface,
2998 strerror(errno));
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07002999 }
3000 }
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003001#endif /* !CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003002 }
3003
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003004 dl_list_for_each_safe(dst, prev, &hapd->ctrl_dst, struct wpa_ctrl_dst,
3005 list)
3006 os_free(dst);
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08003007
3008#ifdef CONFIG_TESTING_OPTIONS
3009 l2_packet_deinit(hapd->l2_test);
3010 hapd->l2_test = NULL;
3011#endif /* CONFIG_TESTING_OPTIONS */
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003012}
3013
3014
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003015static int hostapd_ctrl_iface_add(struct hapd_interfaces *interfaces,
3016 char *buf)
3017{
3018 if (hostapd_add_iface(interfaces, buf) < 0) {
3019 wpa_printf(MSG_ERROR, "Adding interface %s failed", buf);
3020 return -1;
3021 }
3022 return 0;
3023}
3024
3025
3026static int hostapd_ctrl_iface_remove(struct hapd_interfaces *interfaces,
3027 char *buf)
3028{
3029 if (hostapd_remove_iface(interfaces, buf) < 0) {
3030 wpa_printf(MSG_ERROR, "Removing interface %s failed", buf);
3031 return -1;
3032 }
3033 return 0;
3034}
3035
3036
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003037static int hostapd_global_ctrl_iface_attach(struct hapd_interfaces *interfaces,
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003038 struct sockaddr_storage *from,
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003039 socklen_t fromlen)
3040{
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003041 return ctrl_iface_attach(&interfaces->global_ctrl_dst, from, fromlen);
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003042}
3043
3044
3045static int hostapd_global_ctrl_iface_detach(struct hapd_interfaces *interfaces,
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003046 struct sockaddr_storage *from,
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003047 socklen_t fromlen)
3048{
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003049 return ctrl_iface_detach(&interfaces->global_ctrl_dst, from, fromlen);
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003050}
3051
3052
Dmitry Shmidtcf32e602014-01-28 10:57:39 -08003053static void hostapd_ctrl_iface_flush(struct hapd_interfaces *interfaces)
3054{
3055#ifdef CONFIG_WPS_TESTING
3056 wps_version_number = 0x20;
3057 wps_testing_dummy_cred = 0;
3058 wps_corrupt_pkhash = 0;
3059#endif /* CONFIG_WPS_TESTING */
3060}
3061
3062
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08003063#ifdef CONFIG_FST
3064
3065static int
3066hostapd_global_ctrl_iface_fst_attach(struct hapd_interfaces *interfaces,
3067 const char *cmd)
3068{
3069 char ifname[IFNAMSIZ + 1];
3070 struct fst_iface_cfg cfg;
3071 struct hostapd_data *hapd;
3072 struct fst_wpa_obj iface_obj;
3073
3074 if (!fst_parse_attach_command(cmd, ifname, sizeof(ifname), &cfg)) {
3075 hapd = hostapd_get_iface(interfaces, ifname);
3076 if (hapd) {
3077 if (hapd->iface->fst) {
3078 wpa_printf(MSG_INFO, "FST: Already attached");
3079 return -1;
3080 }
3081 fst_hostapd_fill_iface_obj(hapd, &iface_obj);
3082 hapd->iface->fst = fst_attach(ifname, hapd->own_addr,
3083 &iface_obj, &cfg);
3084 if (hapd->iface->fst)
3085 return 0;
3086 }
3087 }
3088
3089 return -EINVAL;
3090}
3091
3092
3093static int
3094hostapd_global_ctrl_iface_fst_detach(struct hapd_interfaces *interfaces,
3095 const char *cmd)
3096{
3097 char ifname[IFNAMSIZ + 1];
3098 struct hostapd_data * hapd;
3099
3100 if (!fst_parse_detach_command(cmd, ifname, sizeof(ifname))) {
3101 hapd = hostapd_get_iface(interfaces, ifname);
3102 if (hapd) {
3103 if (!fst_iface_detach(ifname)) {
3104 hapd->iface->fst = NULL;
3105 hapd->iface->fst_ies = NULL;
3106 return 0;
3107 }
3108 }
3109 }
3110
3111 return -EINVAL;
3112}
3113
3114#endif /* CONFIG_FST */
3115
3116
3117static struct hostapd_data *
3118hostapd_interfaces_get_hapd(struct hapd_interfaces *interfaces,
3119 const char *ifname)
3120{
3121 size_t i, j;
3122
3123 for (i = 0; i < interfaces->count; i++) {
3124 struct hostapd_iface *iface = interfaces->iface[i];
3125
3126 for (j = 0; j < iface->num_bss; j++) {
3127 struct hostapd_data *hapd;
3128
3129 hapd = iface->bss[j];
3130 if (os_strcmp(ifname, hapd->conf->iface) == 0)
3131 return hapd;
3132 }
3133 }
3134
3135 return NULL;
3136}
3137
3138
3139static int hostapd_ctrl_iface_dup_param(struct hostapd_data *src_hapd,
3140 struct hostapd_data *dst_hapd,
3141 const char *param)
3142{
3143 int res;
3144 char *value;
3145
3146 value = os_zalloc(HOSTAPD_CLI_DUP_VALUE_MAX_LEN);
3147 if (!value) {
3148 wpa_printf(MSG_ERROR,
3149 "DUP: cannot allocate buffer to stringify %s",
3150 param);
3151 goto error_return;
3152 }
3153
3154 if (os_strcmp(param, "wpa") == 0) {
3155 os_snprintf(value, HOSTAPD_CLI_DUP_VALUE_MAX_LEN, "%d",
3156 src_hapd->conf->wpa);
3157 } else if (os_strcmp(param, "wpa_key_mgmt") == 0 &&
3158 src_hapd->conf->wpa_key_mgmt) {
3159 res = hostapd_ctrl_iface_get_key_mgmt(
3160 src_hapd, value, HOSTAPD_CLI_DUP_VALUE_MAX_LEN);
3161 if (os_snprintf_error(HOSTAPD_CLI_DUP_VALUE_MAX_LEN, res))
3162 goto error_stringify;
3163 } else if (os_strcmp(param, "wpa_pairwise") == 0 &&
3164 src_hapd->conf->wpa_pairwise) {
3165 res = wpa_write_ciphers(value,
3166 value + HOSTAPD_CLI_DUP_VALUE_MAX_LEN,
3167 src_hapd->conf->wpa_pairwise, " ");
3168 if (res < 0)
3169 goto error_stringify;
3170 } else if (os_strcmp(param, "rsn_pairwise") == 0 &&
3171 src_hapd->conf->rsn_pairwise) {
3172 res = wpa_write_ciphers(value,
3173 value + HOSTAPD_CLI_DUP_VALUE_MAX_LEN,
3174 src_hapd->conf->rsn_pairwise, " ");
3175 if (res < 0)
3176 goto error_stringify;
3177 } else if (os_strcmp(param, "wpa_passphrase") == 0 &&
3178 src_hapd->conf->ssid.wpa_passphrase) {
3179 os_snprintf(value, HOSTAPD_CLI_DUP_VALUE_MAX_LEN, "%s",
3180 src_hapd->conf->ssid.wpa_passphrase);
3181 } else if (os_strcmp(param, "wpa_psk") == 0 &&
3182 src_hapd->conf->ssid.wpa_psk_set) {
3183 wpa_snprintf_hex(value, HOSTAPD_CLI_DUP_VALUE_MAX_LEN,
3184 src_hapd->conf->ssid.wpa_psk->psk, PMK_LEN);
3185 } else {
3186 wpa_printf(MSG_WARNING, "DUP: %s cannot be duplicated", param);
3187 goto error_return;
3188 }
3189
3190 res = hostapd_set_iface(dst_hapd->iconf, dst_hapd->conf, param, value);
3191 os_free(value);
3192 return res;
3193
3194error_stringify:
3195 wpa_printf(MSG_ERROR, "DUP: cannot stringify %s", param);
3196error_return:
3197 os_free(value);
3198 return -1;
3199}
3200
3201
3202static int
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003203hostapd_global_ctrl_iface_interfaces(struct hapd_interfaces *interfaces,
3204 const char *input,
3205 char *reply, int reply_size)
3206{
3207 size_t i, j;
3208 int res;
3209 char *pos, *end;
3210 struct hostapd_iface *iface;
3211 int show_ctrl = 0;
3212
3213 if (input)
3214 show_ctrl = !!os_strstr(input, "ctrl");
3215
3216 pos = reply;
3217 end = reply + reply_size;
3218
3219 for (i = 0; i < interfaces->count; i++) {
3220 iface = interfaces->iface[i];
3221
3222 for (j = 0; j < iface->num_bss; j++) {
3223 struct hostapd_bss_config *conf;
3224
3225 conf = iface->conf->bss[j];
3226 if (show_ctrl)
3227 res = os_snprintf(pos, end - pos,
3228 "%s ctrl_iface=%s\n",
3229 conf->iface,
3230 conf->ctrl_interface ?
3231 conf->ctrl_interface : "N/A");
3232 else
3233 res = os_snprintf(pos, end - pos, "%s\n",
3234 conf->iface);
3235 if (os_snprintf_error(end - pos, res)) {
3236 *pos = '\0';
3237 return pos - reply;
3238 }
3239 pos += res;
3240 }
3241 }
3242
3243 return pos - reply;
3244}
3245
3246
3247static int
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08003248hostapd_global_ctrl_iface_dup_network(struct hapd_interfaces *interfaces,
3249 char *cmd)
3250{
3251 char *p_start = cmd, *p_end;
3252 struct hostapd_data *src_hapd, *dst_hapd;
3253
3254 /* cmd: "<src ifname> <dst ifname> <variable name> */
3255
3256 p_end = os_strchr(p_start, ' ');
3257 if (!p_end) {
3258 wpa_printf(MSG_ERROR, "DUP: no src ifname found in cmd: '%s'",
3259 cmd);
3260 return -1;
3261 }
3262
3263 *p_end = '\0';
3264 src_hapd = hostapd_interfaces_get_hapd(interfaces, p_start);
3265 if (!src_hapd) {
3266 wpa_printf(MSG_ERROR, "DUP: no src ifname found: '%s'",
3267 p_start);
3268 return -1;
3269 }
3270
3271 p_start = p_end + 1;
3272 p_end = os_strchr(p_start, ' ');
3273 if (!p_end) {
3274 wpa_printf(MSG_ERROR, "DUP: no dst ifname found in cmd: '%s'",
3275 cmd);
3276 return -1;
3277 }
3278
3279 *p_end = '\0';
3280 dst_hapd = hostapd_interfaces_get_hapd(interfaces, p_start);
3281 if (!dst_hapd) {
3282 wpa_printf(MSG_ERROR, "DUP: no dst ifname found: '%s'",
3283 p_start);
3284 return -1;
3285 }
3286
3287 p_start = p_end + 1;
3288 return hostapd_ctrl_iface_dup_param(src_hapd, dst_hapd, p_start);
3289}
3290
3291
3292static int hostapd_global_ctrl_iface_ifname(struct hapd_interfaces *interfaces,
3293 const char *ifname,
3294 char *buf, char *reply,
3295 int reply_size,
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003296 struct sockaddr_storage *from,
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08003297 socklen_t fromlen)
3298{
3299 struct hostapd_data *hapd;
3300
3301 hapd = hostapd_interfaces_get_hapd(interfaces, ifname);
3302 if (hapd == NULL) {
3303 int res;
3304
3305 res = os_snprintf(reply, reply_size, "FAIL-NO-IFNAME-MATCH\n");
3306 if (os_snprintf_error(reply_size, res))
3307 return -1;
3308 return res;
3309 }
3310
3311 return hostapd_ctrl_iface_receive_process(hapd, buf, reply,reply_size,
3312 from, fromlen);
3313}
3314
3315
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003316static void hostapd_global_ctrl_iface_receive(int sock, void *eloop_ctx,
3317 void *sock_ctx)
3318{
3319 void *interfaces = eloop_ctx;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003320 char buffer[256], *buf = buffer;
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003321 int res;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003322 struct sockaddr_storage from;
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003323 socklen_t fromlen = sizeof(from);
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003324 char *reply;
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003325 int reply_len;
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003326 const int reply_size = 4096;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003327#ifdef CONFIG_CTRL_IFACE_UDP
3328 unsigned char lcookie[COOKIE_LEN];
3329#endif /* CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003330
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003331 res = recvfrom(sock, buffer, sizeof(buffer) - 1, 0,
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003332 (struct sockaddr *) &from, &fromlen);
3333 if (res < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08003334 wpa_printf(MSG_ERROR, "recvfrom(ctrl_iface): %s",
3335 strerror(errno));
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003336 return;
3337 }
3338 buf[res] = '\0';
Dmitry Shmidtcce06662013-11-04 18:44:24 -08003339 wpa_printf(MSG_DEBUG, "Global ctrl_iface command: %s", buf);
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003340
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003341 reply = os_malloc(reply_size);
3342 if (reply == NULL) {
3343 if (sendto(sock, "FAIL\n", 5, 0, (struct sockaddr *) &from,
3344 fromlen) < 0) {
3345 wpa_printf(MSG_DEBUG, "CTRL: sendto failed: %s",
3346 strerror(errno));
3347 }
3348 return;
3349 }
3350
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003351 os_memcpy(reply, "OK\n", 3);
3352 reply_len = 3;
3353
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003354#ifdef CONFIG_CTRL_IFACE_UDP
3355 if (os_strcmp(buf, "GET_COOKIE") == 0) {
3356 os_memcpy(reply, "COOKIE=", 7);
3357 wpa_snprintf_hex(reply + 7, 2 * COOKIE_LEN + 1,
3358 gcookie, COOKIE_LEN);
3359 reply_len = 7 + 2 * COOKIE_LEN;
3360 goto send_reply;
3361 }
3362
3363 if (os_strncmp(buf, "COOKIE=", 7) != 0 ||
3364 hexstr2bin(buf + 7, lcookie, COOKIE_LEN) < 0) {
3365 wpa_printf(MSG_DEBUG,
3366 "CTRL: No cookie in the request - drop request");
3367 os_free(reply);
3368 return;
3369 }
3370
3371 if (os_memcmp(gcookie, lcookie, COOKIE_LEN) != 0) {
3372 wpa_printf(MSG_DEBUG,
3373 "CTRL: Invalid cookie in the request - drop request");
3374 os_free(reply);
3375 return;
3376 }
3377
3378 buf += 7 + 2 * COOKIE_LEN;
3379 while (*buf == ' ')
3380 buf++;
3381#endif /* CONFIG_CTRL_IFACE_UDP */
3382
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08003383 if (os_strncmp(buf, "IFNAME=", 7) == 0) {
3384 char *pos = os_strchr(buf + 7, ' ');
3385
3386 if (pos) {
3387 *pos++ = '\0';
3388 reply_len = hostapd_global_ctrl_iface_ifname(
3389 interfaces, buf + 7, pos, reply, reply_size,
3390 &from, fromlen);
3391 goto send_reply;
3392 }
3393 }
3394
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003395 if (os_strcmp(buf, "PING") == 0) {
3396 os_memcpy(reply, "PONG\n", 5);
3397 reply_len = 5;
Dmitry Shmidtcce06662013-11-04 18:44:24 -08003398 } else if (os_strncmp(buf, "RELOG", 5) == 0) {
3399 if (wpa_debug_reopen_file() < 0)
3400 reply_len = -1;
Dmitry Shmidtcf32e602014-01-28 10:57:39 -08003401 } else if (os_strcmp(buf, "FLUSH") == 0) {
3402 hostapd_ctrl_iface_flush(interfaces);
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003403 } else if (os_strncmp(buf, "ADD ", 4) == 0) {
3404 if (hostapd_ctrl_iface_add(interfaces, buf + 4) < 0)
3405 reply_len = -1;
3406 } else if (os_strncmp(buf, "REMOVE ", 7) == 0) {
3407 if (hostapd_ctrl_iface_remove(interfaces, buf + 7) < 0)
3408 reply_len = -1;
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003409 } else if (os_strcmp(buf, "ATTACH") == 0) {
3410 if (hostapd_global_ctrl_iface_attach(interfaces, &from,
3411 fromlen))
3412 reply_len = -1;
3413 } else if (os_strcmp(buf, "DETACH") == 0) {
3414 if (hostapd_global_ctrl_iface_detach(interfaces, &from,
3415 fromlen))
3416 reply_len = -1;
Dmitry Shmidt7f93d6f2014-02-21 11:22:49 -08003417#ifdef CONFIG_MODULE_TESTS
3418 } else if (os_strcmp(buf, "MODULE_TESTS") == 0) {
Dmitry Shmidt7f93d6f2014-02-21 11:22:49 -08003419 if (hapd_module_tests() < 0)
3420 reply_len = -1;
3421#endif /* CONFIG_MODULE_TESTS */
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08003422#ifdef CONFIG_FST
3423 } else if (os_strncmp(buf, "FST-ATTACH ", 11) == 0) {
3424 if (!hostapd_global_ctrl_iface_fst_attach(interfaces, buf + 11))
3425 reply_len = os_snprintf(reply, reply_size, "OK\n");
3426 else
3427 reply_len = -1;
3428 } else if (os_strncmp(buf, "FST-DETACH ", 11) == 0) {
3429 if (!hostapd_global_ctrl_iface_fst_detach(interfaces, buf + 11))
3430 reply_len = os_snprintf(reply, reply_size, "OK\n");
3431 else
3432 reply_len = -1;
3433 } else if (os_strncmp(buf, "FST-MANAGER ", 12) == 0) {
3434 reply_len = fst_ctrl_iface_receive(buf + 12, reply, reply_size);
3435#endif /* CONFIG_FST */
3436 } else if (os_strncmp(buf, "DUP_NETWORK ", 12) == 0) {
3437 if (!hostapd_global_ctrl_iface_dup_network(interfaces,
3438 buf + 12))
3439 reply_len = os_snprintf(reply, reply_size, "OK\n");
3440 else
3441 reply_len = -1;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003442 } else if (os_strncmp(buf, "INTERFACES", 10) == 0) {
3443 reply_len = hostapd_global_ctrl_iface_interfaces(
3444 interfaces, buf + 10, reply, sizeof(buffer));
3445 } else if (os_strcmp(buf, "TERMINATE") == 0) {
3446 eloop_terminate();
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003447 } else {
3448 wpa_printf(MSG_DEBUG, "Unrecognized global ctrl_iface command "
3449 "ignored");
3450 reply_len = -1;
3451 }
3452
Dmitry Shmidtd80a4012015-11-05 16:35:40 -08003453send_reply:
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003454 if (reply_len < 0) {
3455 os_memcpy(reply, "FAIL\n", 5);
3456 reply_len = 5;
3457 }
3458
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08003459 if (sendto(sock, reply, reply_len, 0, (struct sockaddr *) &from,
3460 fromlen) < 0) {
3461 wpa_printf(MSG_DEBUG, "CTRL: sendto failed: %s",
3462 strerror(errno));
3463 }
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003464 os_free(reply);
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003465}
3466
3467
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003468#ifndef CONFIG_CTRL_IFACE_UDP
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003469static char * hostapd_global_ctrl_iface_path(struct hapd_interfaces *interface)
3470{
3471 char *buf;
3472 size_t len;
3473
3474 if (interface->global_iface_path == NULL)
3475 return NULL;
3476
3477 len = os_strlen(interface->global_iface_path) +
3478 os_strlen(interface->global_iface_name) + 2;
3479 buf = os_malloc(len);
3480 if (buf == NULL)
3481 return NULL;
3482
3483 os_snprintf(buf, len, "%s/%s", interface->global_iface_path,
3484 interface->global_iface_name);
3485 buf[len - 1] = '\0';
3486 return buf;
3487}
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003488#endif /* CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003489
3490
3491int hostapd_global_ctrl_iface_init(struct hapd_interfaces *interface)
3492{
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003493#ifdef CONFIG_CTRL_IFACE_UDP
3494 int port = HOSTAPD_GLOBAL_CTRL_IFACE_PORT;
3495 char p[32] = { 0 };
3496 char *pos;
3497 struct addrinfo hints = { 0 }, *res, *saveres;
3498 int n;
3499
3500 if (interface->global_ctrl_sock > -1) {
3501 wpa_printf(MSG_DEBUG, "ctrl_iface already exists!");
3502 return 0;
3503 }
3504
3505 if (interface->global_iface_path == NULL)
3506 return 0;
3507
3508 pos = os_strstr(interface->global_iface_path, "udp:");
3509 if (pos) {
3510 pos += 4;
3511 port = atoi(pos);
3512 if (port <= 0) {
3513 wpa_printf(MSG_ERROR, "Invalid global ctrl UDP port");
3514 goto fail;
3515 }
3516 }
3517
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003518 os_get_random(gcookie, COOKIE_LEN);
3519
3520#ifdef CONFIG_CTRL_IFACE_UDP_REMOTE
3521 hints.ai_flags = AI_PASSIVE;
3522#endif /* CONFIG_CTRL_IFACE_UDP_REMOTE */
3523
3524#ifdef CONFIG_CTRL_IFACE_UDP_IPV6
3525 hints.ai_family = AF_INET6;
3526#else /* CONFIG_CTRL_IFACE_UDP_IPV6 */
3527 hints.ai_family = AF_INET;
3528#endif /* CONFIG_CTRL_IFACE_UDP_IPV6 */
3529 hints.ai_socktype = SOCK_DGRAM;
3530
3531try_again:
3532 os_snprintf(p, sizeof(p), "%d", port);
3533 n = getaddrinfo(NULL, p, &hints, &res);
3534 if (n) {
3535 wpa_printf(MSG_ERROR, "getaddrinfo(): %s", gai_strerror(n));
3536 goto fail;
3537 }
3538
3539 saveres = res;
3540 interface->global_ctrl_sock = socket(res->ai_family, res->ai_socktype,
3541 res->ai_protocol);
3542 if (interface->global_ctrl_sock < 0) {
3543 wpa_printf(MSG_ERROR, "socket(PF_INET): %s", strerror(errno));
3544 goto fail;
3545 }
3546
3547 if (bind(interface->global_ctrl_sock, res->ai_addr, res->ai_addrlen) <
3548 0) {
3549 port++;
3550 if ((port - HOSTAPD_GLOBAL_CTRL_IFACE_PORT) <
3551 HOSTAPD_GLOBAL_CTRL_IFACE_PORT_LIMIT && !pos)
3552 goto try_again;
3553 wpa_printf(MSG_ERROR, "bind(AF_INET): %s", strerror(errno));
3554 goto fail;
3555 }
3556
3557 freeaddrinfo(saveres);
3558
3559 wpa_printf(MSG_DEBUG, "global ctrl_iface_init UDP port: %d", port);
3560
3561 if (eloop_register_read_sock(interface->global_ctrl_sock,
3562 hostapd_global_ctrl_iface_receive,
3563 interface, NULL) < 0) {
3564 hostapd_global_ctrl_iface_deinit(interface);
3565 return -1;
3566 }
3567
3568 return 0;
3569
3570fail:
3571 if (interface->global_ctrl_sock >= 0)
3572 close(interface->global_ctrl_sock);
3573 return -1;
3574#else /* CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003575 struct sockaddr_un addr;
3576 int s = -1;
3577 char *fname = NULL;
3578
3579 if (interface->global_iface_path == NULL) {
3580 wpa_printf(MSG_DEBUG, "ctrl_iface not configured!");
3581 return 0;
3582 }
3583
3584 if (mkdir(interface->global_iface_path, S_IRWXU | S_IRWXG) < 0) {
3585 if (errno == EEXIST) {
3586 wpa_printf(MSG_DEBUG, "Using existing control "
3587 "interface directory.");
3588 } else {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08003589 wpa_printf(MSG_ERROR, "mkdir[ctrl_interface]: %s",
3590 strerror(errno));
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003591 goto fail;
3592 }
Dmitry Shmidt0ccb66e2013-03-29 16:41:28 -07003593 } else if (interface->ctrl_iface_group &&
3594 chown(interface->global_iface_path, -1,
3595 interface->ctrl_iface_group) < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08003596 wpa_printf(MSG_ERROR, "chown[ctrl_interface]: %s",
3597 strerror(errno));
Dmitry Shmidt0ccb66e2013-03-29 16:41:28 -07003598 goto fail;
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003599 }
3600
3601 if (os_strlen(interface->global_iface_path) + 1 +
3602 os_strlen(interface->global_iface_name) >= sizeof(addr.sun_path))
3603 goto fail;
3604
3605 s = socket(PF_UNIX, SOCK_DGRAM, 0);
3606 if (s < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08003607 wpa_printf(MSG_ERROR, "socket(PF_UNIX): %s", strerror(errno));
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003608 goto fail;
3609 }
3610
3611 os_memset(&addr, 0, sizeof(addr));
3612#ifdef __FreeBSD__
3613 addr.sun_len = sizeof(addr);
3614#endif /* __FreeBSD__ */
3615 addr.sun_family = AF_UNIX;
3616 fname = hostapd_global_ctrl_iface_path(interface);
3617 if (fname == NULL)
3618 goto fail;
3619 os_strlcpy(addr.sun_path, fname, sizeof(addr.sun_path));
3620 if (bind(s, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
3621 wpa_printf(MSG_DEBUG, "ctrl_iface bind(PF_UNIX) failed: %s",
3622 strerror(errno));
3623 if (connect(s, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
3624 wpa_printf(MSG_DEBUG, "ctrl_iface exists, but does not"
3625 " allow connections - assuming it was left"
3626 "over from forced program termination");
3627 if (unlink(fname) < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08003628 wpa_printf(MSG_ERROR,
3629 "Could not unlink existing ctrl_iface socket '%s': %s",
3630 fname, strerror(errno));
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003631 goto fail;
3632 }
3633 if (bind(s, (struct sockaddr *) &addr, sizeof(addr)) <
3634 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08003635 wpa_printf(MSG_ERROR, "bind(PF_UNIX): %s",
3636 strerror(errno));
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003637 goto fail;
3638 }
3639 wpa_printf(MSG_DEBUG, "Successfully replaced leftover "
3640 "ctrl_iface socket '%s'", fname);
3641 } else {
3642 wpa_printf(MSG_INFO, "ctrl_iface exists and seems to "
3643 "be in use - cannot override it");
3644 wpa_printf(MSG_INFO, "Delete '%s' manually if it is "
3645 "not used anymore", fname);
3646 os_free(fname);
3647 fname = NULL;
3648 goto fail;
3649 }
3650 }
3651
Dmitry Shmidt0ccb66e2013-03-29 16:41:28 -07003652 if (interface->ctrl_iface_group &&
3653 chown(fname, -1, interface->ctrl_iface_group) < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08003654 wpa_printf(MSG_ERROR, "chown[ctrl_interface]: %s",
3655 strerror(errno));
Dmitry Shmidt0ccb66e2013-03-29 16:41:28 -07003656 goto fail;
3657 }
3658
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003659 if (chmod(fname, S_IRWXU | S_IRWXG) < 0) {
Dmitry Shmidt6c0da2b2015-01-05 13:08:17 -08003660 wpa_printf(MSG_ERROR, "chmod[ctrl_interface/ifname]: %s",
3661 strerror(errno));
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003662 goto fail;
3663 }
3664 os_free(fname);
3665
3666 interface->global_ctrl_sock = s;
3667 eloop_register_read_sock(s, hostapd_global_ctrl_iface_receive,
3668 interface, NULL);
3669
3670 return 0;
3671
3672fail:
3673 if (s >= 0)
3674 close(s);
3675 if (fname) {
3676 unlink(fname);
3677 os_free(fname);
3678 }
3679 return -1;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003680#endif /* CONFIG_CTRL_IFACE_UDP */
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003681}
3682
3683
3684void hostapd_global_ctrl_iface_deinit(struct hapd_interfaces *interfaces)
3685{
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003686#ifndef CONFIG_CTRL_IFACE_UDP
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003687 char *fname = NULL;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003688#endif /* CONFIG_CTRL_IFACE_UDP */
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003689 struct wpa_ctrl_dst *dst, *prev;
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003690
3691 if (interfaces->global_ctrl_sock > -1) {
3692 eloop_unregister_read_sock(interfaces->global_ctrl_sock);
3693 close(interfaces->global_ctrl_sock);
3694 interfaces->global_ctrl_sock = -1;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003695#ifndef CONFIG_CTRL_IFACE_UDP
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003696 fname = hostapd_global_ctrl_iface_path(interfaces);
3697 if (fname) {
3698 unlink(fname);
3699 os_free(fname);
3700 }
3701
3702 if (interfaces->global_iface_path &&
3703 rmdir(interfaces->global_iface_path) < 0) {
3704 if (errno == ENOTEMPTY) {
3705 wpa_printf(MSG_DEBUG, "Control interface "
3706 "directory not empty - leaving it "
3707 "behind");
3708 } else {
Dmitry Shmidtb7b4d0e2013-08-26 12:09:05 -07003709 wpa_printf(MSG_ERROR,
3710 "rmdir[ctrl_interface=%s]: %s",
3711 interfaces->global_iface_path,
3712 strerror(errno));
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003713 }
3714 }
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003715#endif /* CONFIG_CTRL_IFACE_UDP */
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003716 }
3717
3718 os_free(interfaces->global_iface_path);
3719 interfaces->global_iface_path = NULL;
3720
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003721 dl_list_for_each_safe(dst, prev, &interfaces->global_ctrl_dst,
3722 struct wpa_ctrl_dst, list)
3723 os_free(dst);
Dmitry Shmidt61d9df32012-08-29 16:22:06 -07003724}
3725
3726
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003727static void hostapd_ctrl_iface_send(struct hostapd_data *hapd, int level,
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003728 enum wpa_msg_type type,
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003729 const char *buf, size_t len)
3730{
3731 struct wpa_ctrl_dst *dst, *next;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003732 struct dl_list *ctrl_dst;
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003733 struct msghdr msg;
3734 int idx;
3735 struct iovec io[2];
3736 char levelstr[10];
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003737 int s;
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003738
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003739 if (type != WPA_MSG_ONLY_GLOBAL) {
3740 s = hapd->ctrl_sock;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003741 ctrl_dst = &hapd->ctrl_dst;
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003742 } else {
3743 s = hapd->iface->interfaces->global_ctrl_sock;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003744 ctrl_dst = &hapd->iface->interfaces->global_ctrl_dst;
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003745 }
3746
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003747 if (s < 0 || dl_list_empty(ctrl_dst))
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003748 return;
3749
3750 os_snprintf(levelstr, sizeof(levelstr), "<%d>", level);
3751 io[0].iov_base = levelstr;
3752 io[0].iov_len = os_strlen(levelstr);
3753 io[1].iov_base = (char *) buf;
3754 io[1].iov_len = len;
3755 os_memset(&msg, 0, sizeof(msg));
3756 msg.msg_iov = io;
3757 msg.msg_iovlen = 2;
3758
3759 idx = 0;
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003760 dl_list_for_each_safe(dst, next, ctrl_dst, struct wpa_ctrl_dst, list) {
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003761 if (level >= dst->debug_level) {
Dmitry Shmidt31a29cc2016-03-09 15:58:17 -08003762 sockaddr_print(MSG_DEBUG, "CTRL_IFACE monitor send",
3763 &dst->addr, dst->addrlen);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003764 msg.msg_name = &dst->addr;
3765 msg.msg_namelen = dst->addrlen;
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003766 if (sendmsg(s, &msg, 0) < 0) {
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003767 int _errno = errno;
3768 wpa_printf(MSG_INFO, "CTRL_IFACE monitor[%d]: "
3769 "%d - %s",
3770 idx, errno, strerror(errno));
3771 dst->errors++;
3772 if (dst->errors > 10 || _errno == ENOENT) {
Anton Nayshtutf715e8d2014-11-16 16:52:49 +02003773 if (type != WPA_MSG_ONLY_GLOBAL)
3774 hostapd_ctrl_iface_detach(
3775 hapd, &dst->addr,
3776 dst->addrlen);
3777 else
3778 hostapd_global_ctrl_iface_detach(
3779 hapd->iface->interfaces,
3780 &dst->addr,
3781 dst->addrlen);
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003782 }
3783 } else
3784 dst->errors = 0;
3785 }
3786 idx++;
Dmitry Shmidt8d520ff2011-05-09 14:06:53 -07003787 }
3788}
3789
3790#endif /* CONFIG_NATIVE_WINDOWS */