2 * WPA Supplicant - wired Ethernet driver interface
3 * Copyright (c) 2005-2007, Jouni Malinen <j@w1.fi>
4 * Copyright (c) 2004, Gunter Burchardt <tira@isx.de>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
10 * Alternatively, this software may be distributed under the terms of BSD
13 * See README and COPYING for more details.
17 #include <sys/ioctl.h>
20 #include <netpacket/packet.h>
21 #include <net/if_arp.h>
23 #endif /* __linux__ */
25 #include <net/if_dl.h>
26 #endif /* __FreeBSD__ */
33 #include "../../hostapd/hostapd.h"
34 #include "../../hostapd/config.h"
35 #include "../../hostapd/sta_info.h"
36 #include "../../hostapd/accounting.h"
39 static const u8 pae_group_addr[ETH_ALEN] =
40 { 0x01, 0x80, 0xc2, 0x00, 0x00, 0x03 };
43 struct wpa_driver_wired_data {
45 struct hostapd_data *hapd;
46 char iface[IFNAMSIZ + 1];
48 int sock; /* raw packet socket for driver access */
49 int dhcp_sock; /* socket for dhcp packets */
50 int use_pae_group_addr;
54 char ifname[IFNAMSIZ + 1];
55 int membership, multi, iff_allmulti, iff_up;
62 /* TODO: detecting new devices should eventually be changed from using DHCP
63 * snooping to trigger on any packet from a new layer 2 MAC address, e.g.,
64 * based on ebtables, etc. */
82 u_int8_t options[308]; /* 312 - cookie */
86 static void wired_possible_new_sta(struct hostapd_data *hapd, u8 *addr)
90 sta = ap_get_sta(hapd, addr);
94 wpa_printf(MSG_DEBUG, "Data frame from unknown STA " MACSTR
95 " - adding a new STA", MAC2STR(addr));
96 sta = ap_sta_add(hapd, addr);
98 hostapd_new_assoc_sta(hapd, sta, 0);
100 wpa_printf(MSG_DEBUG, "Failed to add STA entry for " MACSTR,
106 static void handle_data(struct hostapd_data *hapd, unsigned char *buf,
109 struct ieee8023_hdr *hdr;
113 /* must contain at least ieee8023_hdr 6 byte source, 6 byte dest,
114 * 2 byte ethertype */
116 wpa_printf(MSG_MSGDUMP, "handle_data: too short (%lu)",
117 (unsigned long) len);
121 hdr = (struct ieee8023_hdr *) buf;
123 switch (ntohs(hdr->ethertype)) {
125 wpa_printf(MSG_MSGDUMP, "Received EAPOL packet");
127 wired_possible_new_sta(hapd, sa);
129 pos = (u8 *) (hdr + 1);
130 left = len - sizeof(*hdr);
132 hostapd_eapol_receive(hapd, sa, pos, left);
136 wpa_printf(MSG_DEBUG, "Unknown ethertype 0x%04x in data frame",
137 ntohs(hdr->ethertype));
143 static void handle_read(int sock, void *eloop_ctx, void *sock_ctx)
145 struct hostapd_data *hapd = (struct hostapd_data *) eloop_ctx;
147 unsigned char buf[3000];
149 len = recv(sock, buf, sizeof(buf), 0);
155 handle_data(hapd, buf, len);
159 static void handle_dhcp(int sock, void *eloop_ctx, void *sock_ctx)
161 struct hostapd_data *hapd = (struct hostapd_data *) eloop_ctx;
163 unsigned char buf[3000];
164 struct dhcp_message *msg;
167 len = recv(sock, buf, sizeof(buf), 0);
173 /* must contain at least dhcp_message->chaddr */
175 wpa_printf(MSG_MSGDUMP, "handle_dhcp: too short (%d)", len);
179 msg = (struct dhcp_message *) buf;
180 mac_address = (u8 *) &(msg->chaddr);
182 wpa_printf(MSG_MSGDUMP, "Got DHCP broadcast packet from " MACSTR,
183 MAC2STR(mac_address));
185 wired_possible_new_sta(hapd, mac_address);
189 static int wired_init_sockets(struct wpa_driver_wired_data *drv)
191 struct hostapd_data *hapd = drv->hapd;
193 struct sockaddr_ll addr;
194 struct sockaddr_in addr2;
195 struct packet_mreq mreq;
198 drv->sock = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_PAE));
200 perror("socket[PF_PACKET,SOCK_RAW]");
204 if (eloop_register_read_sock(drv->sock, handle_read, hapd, NULL)) {
205 printf("Could not register read socket\n");
209 memset(&ifr, 0, sizeof(ifr));
210 os_strlcpy(ifr.ifr_name, drv->iface, sizeof(ifr.ifr_name));
211 if (ioctl(drv->sock, SIOCGIFINDEX, &ifr) != 0) {
212 perror("ioctl(SIOCGIFINDEX)");
216 memset(&addr, 0, sizeof(addr));
217 addr.sll_family = AF_PACKET;
218 addr.sll_ifindex = ifr.ifr_ifindex;
219 wpa_printf(MSG_DEBUG, "Opening raw packet socket for ifindex %d",
222 if (bind(drv->sock, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
227 /* filter multicast address */
228 memset(&mreq, 0, sizeof(mreq));
229 mreq.mr_ifindex = ifr.ifr_ifindex;
230 mreq.mr_type = PACKET_MR_MULTICAST;
232 memcpy(mreq.mr_address, pae_group_addr, mreq.mr_alen);
234 if (setsockopt(drv->sock, SOL_PACKET, PACKET_ADD_MEMBERSHIP, &mreq,
236 perror("setsockopt[SOL_SOCKET,PACKET_ADD_MEMBERSHIP]");
240 memset(&ifr, 0, sizeof(ifr));
241 os_strlcpy(ifr.ifr_name, drv->iface, sizeof(ifr.ifr_name));
242 if (ioctl(drv->sock, SIOCGIFHWADDR, &ifr) != 0) {
243 perror("ioctl(SIOCGIFHWADDR)");
247 if (ifr.ifr_hwaddr.sa_family != ARPHRD_ETHER) {
248 printf("Invalid HW-addr family 0x%04x\n",
249 ifr.ifr_hwaddr.sa_family);
252 memcpy(hapd->own_addr, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
254 /* setup dhcp listen socket for sta detection */
255 if ((drv->dhcp_sock = socket(PF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
256 perror("socket call failed for dhcp");
260 if (eloop_register_read_sock(drv->dhcp_sock, handle_dhcp, hapd, NULL))
262 printf("Could not register read socket\n");
266 memset(&addr2, 0, sizeof(addr2));
267 addr2.sin_family = AF_INET;
268 addr2.sin_port = htons(67);
269 addr2.sin_addr.s_addr = INADDR_ANY;
271 if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_REUSEADDR, (char *) &n,
273 perror("setsockopt[SOL_SOCKET,SO_REUSEADDR]");
276 if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_BROADCAST, (char *) &n,
278 perror("setsockopt[SOL_SOCKET,SO_BROADCAST]");
282 memset(&ifr, 0, sizeof(ifr));
283 os_strlcpy(ifr.ifr_ifrn.ifrn_name, drv->iface, IFNAMSIZ);
284 if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_BINDTODEVICE,
285 (char *) &ifr, sizeof(ifr)) < 0) {
286 perror("setsockopt[SOL_SOCKET,SO_BINDTODEVICE]");
290 if (bind(drv->dhcp_sock, (struct sockaddr *) &addr2,
291 sizeof(struct sockaddr)) == -1) {
300 static int wired_send_eapol(void *priv, const u8 *addr,
301 const u8 *data, size_t data_len, int encrypt,
304 struct wpa_driver_wired_data *drv = priv;
305 struct ieee8023_hdr *hdr;
310 len = sizeof(*hdr) + data_len;
311 hdr = os_zalloc(len);
313 printf("malloc() failed for wired_send_eapol(len=%lu)\n",
314 (unsigned long) len);
318 memcpy(hdr->dest, drv->use_pae_group_addr ? pae_group_addr : addr,
320 memcpy(hdr->src, own_addr, ETH_ALEN);
321 hdr->ethertype = htons(ETH_P_PAE);
323 pos = (u8 *) (hdr + 1);
324 memcpy(pos, data, data_len);
326 res = send(drv->sock, (u8 *) hdr, len, 0);
330 perror("wired_send_eapol: send");
331 printf("wired_send_eapol - packet len: %lu - failed\n",
332 (unsigned long) len);
339 static void * wired_driver_hapd_init(struct hostapd_data *hapd)
341 struct wpa_driver_wired_data *drv;
343 drv = os_zalloc(sizeof(struct wpa_driver_wired_data));
345 printf("Could not allocate memory for wired driver data\n");
350 os_strlcpy(drv->iface, hapd->conf->iface, sizeof(drv->iface));
351 drv->use_pae_group_addr = hapd->conf->use_pae_group_addr;
353 if (wired_init_sockets(drv)) {
362 static void wired_driver_hapd_deinit(void *priv)
364 struct wpa_driver_wired_data *drv = priv;
369 if (drv->dhcp_sock >= 0)
370 close(drv->dhcp_sock);
377 static int wpa_driver_wired_get_ssid(void *priv, u8 *ssid)
384 static int wpa_driver_wired_get_bssid(void *priv, u8 *bssid)
386 /* Report PAE group address as the "BSSID" for wired connection. */
387 os_memcpy(bssid, pae_group_addr, ETH_ALEN);
392 static int wpa_driver_wired_get_capa(void *priv, struct wpa_driver_capa *capa)
394 os_memset(capa, 0, sizeof(*capa));
395 capa->flags = WPA_DRIVER_FLAGS_WIRED;
400 static int wpa_driver_wired_get_ifflags(const char *ifname, int *flags)
405 s = socket(PF_INET, SOCK_DGRAM, 0);
411 os_memset(&ifr, 0, sizeof(ifr));
412 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
413 if (ioctl(s, SIOCGIFFLAGS, (caddr_t) &ifr) < 0) {
414 perror("ioctl[SIOCGIFFLAGS]");
419 *flags = ifr.ifr_flags & 0xffff;
424 static int wpa_driver_wired_set_ifflags(const char *ifname, int flags)
429 s = socket(PF_INET, SOCK_DGRAM, 0);
435 os_memset(&ifr, 0, sizeof(ifr));
436 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
437 ifr.ifr_flags = flags & 0xffff;
438 if (ioctl(s, SIOCSIFFLAGS, (caddr_t) &ifr) < 0) {
439 perror("ioctl[SIOCSIFFLAGS]");
448 static int wpa_driver_wired_multi(const char *ifname, const u8 *addr, int add)
453 s = socket(PF_INET, SOCK_DGRAM, 0);
459 os_memset(&ifr, 0, sizeof(ifr));
460 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
462 ifr.ifr_hwaddr.sa_family = AF_UNSPEC;
463 os_memcpy(ifr.ifr_hwaddr.sa_data, addr, ETH_ALEN);
464 #endif /* __linux__ */
467 struct sockaddr_dl *dlp;
468 dlp = (struct sockaddr_dl *) &ifr.ifr_addr;
469 dlp->sdl_len = sizeof(struct sockaddr_dl);
470 dlp->sdl_family = AF_LINK;
473 dlp->sdl_alen = ETH_ALEN;
475 os_memcpy(LLADDR(dlp), addr, ETH_ALEN);
477 #endif /* __FreeBSD__ */
479 if (ioctl(s, add ? SIOCADDMULTI : SIOCDELMULTI, (caddr_t) &ifr) < 0) {
480 perror("ioctl[SIOC{ADD/DEL}MULTI]");
489 static int wpa_driver_wired_membership(struct wpa_driver_wired_data *drv,
490 const u8 *addr, int add)
493 struct packet_mreq mreq;
495 if (drv->pf_sock == -1)
498 os_memset(&mreq, 0, sizeof(mreq));
499 mreq.mr_ifindex = if_nametoindex(drv->ifname);
500 mreq.mr_type = PACKET_MR_MULTICAST;
501 mreq.mr_alen = ETH_ALEN;
502 os_memcpy(mreq.mr_address, addr, ETH_ALEN);
504 if (setsockopt(drv->pf_sock, SOL_PACKET,
505 add ? PACKET_ADD_MEMBERSHIP : PACKET_DROP_MEMBERSHIP,
506 &mreq, sizeof(mreq)) < 0) {
507 perror("setsockopt");
511 #else /* __linux__ */
513 #endif /* __linux__ */
517 static void * wpa_driver_wired_init(void *ctx, const char *ifname)
519 struct wpa_driver_wired_data *drv;
522 drv = os_zalloc(sizeof(*drv));
525 os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
529 drv->pf_sock = socket(PF_PACKET, SOCK_DGRAM, 0);
530 if (drv->pf_sock < 0)
531 perror("socket(PF_PACKET)");
532 #else /* __linux__ */
534 #endif /* __linux__ */
536 if (wpa_driver_wired_get_ifflags(ifname, &flags) == 0 &&
538 wpa_driver_wired_set_ifflags(ifname, flags | IFF_UP) == 0) {
542 if (wpa_driver_wired_membership(drv, pae_group_addr, 1) == 0) {
543 wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
544 "packet socket", __func__);
546 } else if (wpa_driver_wired_multi(ifname, pae_group_addr, 1) == 0) {
547 wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
548 "SIOCADDMULTI", __func__);
550 } else if (wpa_driver_wired_get_ifflags(ifname, &flags) < 0) {
551 wpa_printf(MSG_INFO, "%s: Could not get interface "
555 } else if (flags & IFF_ALLMULTI) {
556 wpa_printf(MSG_DEBUG, "%s: Interface is already configured "
557 "for multicast", __func__);
558 } else if (wpa_driver_wired_set_ifflags(ifname,
559 flags | IFF_ALLMULTI) < 0) {
560 wpa_printf(MSG_INFO, "%s: Failed to enable allmulti",
565 wpa_printf(MSG_DEBUG, "%s: Enabled allmulti mode",
567 drv->iff_allmulti = 1;
574 static void wpa_driver_wired_deinit(void *priv)
576 struct wpa_driver_wired_data *drv = priv;
579 if (drv->membership &&
580 wpa_driver_wired_membership(drv, pae_group_addr, 0) < 0) {
581 wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
582 "group (PACKET)", __func__);
586 wpa_driver_wired_multi(drv->ifname, pae_group_addr, 0) < 0) {
587 wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
588 "group (SIOCDELMULTI)", __func__);
591 if (drv->iff_allmulti &&
592 (wpa_driver_wired_get_ifflags(drv->ifname, &flags) < 0 ||
593 wpa_driver_wired_set_ifflags(drv->ifname,
594 flags & ~IFF_ALLMULTI) < 0)) {
595 wpa_printf(MSG_DEBUG, "%s: Failed to disable allmulti mode",
600 wpa_driver_wired_get_ifflags(drv->ifname, &flags) == 0 &&
602 wpa_driver_wired_set_ifflags(drv->ifname, flags & ~IFF_UP) < 0) {
603 wpa_printf(MSG_DEBUG, "%s: Failed to set the interface down",
607 if (drv->pf_sock != -1)
615 const struct wpa_driver_ops wpa_driver_wired_ops = {
617 .desc = "Wired Ethernet driver",
619 .hapd_init = wired_driver_hapd_init,
620 .hapd_deinit = wired_driver_hapd_deinit,
621 .hapd_send_eapol = wired_send_eapol,
623 .get_ssid = wpa_driver_wired_get_ssid,
624 .get_bssid = wpa_driver_wired_get_bssid,
625 .get_capa = wpa_driver_wired_get_capa,
626 .init = wpa_driver_wired_init,
627 .deinit = wpa_driver_wired_deinit,