1/*
2 * WPA Supplicant - wired Ethernet driver interface
3 * Copyright (c) 2005-2007, Jouni Malinen <j@w1.fi>
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 *
9 * Alternatively, this software may be distributed under the terms of BSD
10 * license.
11 *
12 * See README and COPYING for more details.
13 */
14
15#include "includes.h"
16#include <sys/ioctl.h>
17#include <net/if.h>
18#ifdef __linux__
19#include <netpacket/packet.h>
20#endif /* __linux__ */
21#if defined(__FreeBSD__) || defined(__DragonFly__)
22#include <net/if_dl.h>
23#endif /* defined(__FreeBSD__) || defined(__DragonFly__) */
24
25#include "common.h"
26#include "driver.h"
27
28
29static const u8 pae_group_addr[ETH_ALEN] =
30{ 0x01, 0x80, 0xc2, 0x00, 0x00, 0x03 };
31
32
33struct wpa_driver_wired_data {
34	void *ctx;
35	int pf_sock;
36	char ifname[IFNAMSIZ + 1];
37	int membership, multi, iff_allmulti, iff_up;
38};
39
40
41static int wpa_driver_wired_get_ssid(void *priv, u8 *ssid)
42{
43	ssid[0] = 0;
44	return 0;
45}
46
47
48static int wpa_driver_wired_get_bssid(void *priv, u8 *bssid)
49{
50	/* Report PAE group address as the "BSSID" for wired connection. */
51	os_memcpy(bssid, pae_group_addr, ETH_ALEN);
52	return 0;
53}
54
55
56static int wpa_driver_wired_get_ifflags(const char *ifname, int *flags)
57{
58	struct ifreq ifr;
59	int s;
60
61	s = socket(PF_INET, SOCK_DGRAM, 0);
62	if (s < 0) {
63		perror("socket");
64		return -1;
65	}
66
67	os_memset(&ifr, 0, sizeof(ifr));
68	os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
69	if (ioctl(s, SIOCGIFFLAGS, (caddr_t) &ifr) < 0) {
70		perror("ioctl[SIOCGIFFLAGS]");
71		close(s);
72		return -1;
73	}
74	close(s);
75	*flags = ifr.ifr_flags & 0xffff;
76	return 0;
77}
78
79
80static int wpa_driver_wired_set_ifflags(const char *ifname, int flags)
81{
82	struct ifreq ifr;
83	int s;
84
85	s = socket(PF_INET, SOCK_DGRAM, 0);
86	if (s < 0) {
87		perror("socket");
88		return -1;
89	}
90
91	os_memset(&ifr, 0, sizeof(ifr));
92	os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
93	ifr.ifr_flags = flags & 0xffff;
94	if (ioctl(s, SIOCSIFFLAGS, (caddr_t) &ifr) < 0) {
95		perror("ioctl[SIOCSIFFLAGS]");
96		close(s);
97		return -1;
98	}
99	close(s);
100	return 0;
101}
102
103
104static int wpa_driver_wired_multi(const char *ifname, const u8 *addr, int add)
105{
106	struct ifreq ifr;
107	int s;
108
109	s = socket(PF_INET, SOCK_DGRAM, 0);
110	if (s < 0) {
111		perror("socket");
112		return -1;
113	}
114
115	os_memset(&ifr, 0, sizeof(ifr));
116	os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
117#ifdef __linux__
118	ifr.ifr_hwaddr.sa_family = AF_UNSPEC;
119	os_memcpy(ifr.ifr_hwaddr.sa_data, addr, ETH_ALEN);
120#endif /* __linux__ */
121#if defined(__FreeBSD__) || defined(__DragonFly__)
122	{
123		struct sockaddr_dl *dlp;
124		dlp = (struct sockaddr_dl *) &ifr.ifr_addr;
125		dlp->sdl_len = sizeof(struct sockaddr_dl);
126		dlp->sdl_family = AF_LINK;
127		dlp->sdl_index = 0;
128		dlp->sdl_nlen = 0;
129		dlp->sdl_alen = ETH_ALEN;
130		dlp->sdl_slen = 0;
131		os_memcpy(LLADDR(dlp), addr, ETH_ALEN);
132	}
133#endif /* defined(__FreeBSD__) || defined(__DragonFly__) */
134#if defined(__NetBSD__) || defined(__OpenBSD__) || defined(__APPLE__)
135	{
136		struct sockaddr *sap;
137		sap = (struct sockaddr *) &ifr.ifr_addr;
138		sap->sa_len = sizeof(struct sockaddr);
139		sap->sa_family = AF_UNSPEC;
140		os_memcpy(sap->sa_data, addr, ETH_ALEN);
141	}
142#endif /* defined(__NetBSD__) || defined(__OpenBSD__) || defined(__APPLE__) */
143
144	if (ioctl(s, add ? SIOCADDMULTI : SIOCDELMULTI, (caddr_t) &ifr) < 0) {
145		perror("ioctl[SIOC{ADD/DEL}MULTI]");
146		close(s);
147		return -1;
148	}
149	close(s);
150	return 0;
151}
152
153
154static int wpa_driver_wired_membership(struct wpa_driver_wired_data *drv,
155				       const u8 *addr, int add)
156{
157#ifdef __linux__
158	struct packet_mreq mreq;
159
160	if (drv->pf_sock == -1)
161		return -1;
162
163	os_memset(&mreq, 0, sizeof(mreq));
164	mreq.mr_ifindex = if_nametoindex(drv->ifname);
165	mreq.mr_type = PACKET_MR_MULTICAST;
166	mreq.mr_alen = ETH_ALEN;
167	os_memcpy(mreq.mr_address, addr, ETH_ALEN);
168
169	if (setsockopt(drv->pf_sock, SOL_PACKET,
170		       add ? PACKET_ADD_MEMBERSHIP : PACKET_DROP_MEMBERSHIP,
171		       &mreq, sizeof(mreq)) < 0) {
172		perror("setsockopt");
173		return -1;
174	}
175	return 0;
176#else /* __linux__ */
177	return -1;
178#endif /* __linux__ */
179}
180
181
182static void * wpa_driver_wired_init(void *ctx, const char *ifname)
183{
184	struct wpa_driver_wired_data *drv;
185	int flags;
186
187	drv = os_zalloc(sizeof(*drv));
188	if (drv == NULL)
189		return NULL;
190	os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
191	drv->ctx = ctx;
192
193#ifdef __linux__
194	drv->pf_sock = socket(PF_PACKET, SOCK_DGRAM, 0);
195	if (drv->pf_sock < 0)
196		perror("socket(PF_PACKET)");
197#else /* __linux__ */
198	drv->pf_sock = -1;
199#endif /* __linux__ */
200
201	if (wpa_driver_wired_get_ifflags(ifname, &flags) == 0 &&
202	    !(flags & IFF_UP) &&
203	    wpa_driver_wired_set_ifflags(ifname, flags | IFF_UP) == 0) {
204		drv->iff_up = 1;
205	}
206
207	if (wpa_driver_wired_membership(drv, pae_group_addr, 1) == 0) {
208		wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
209			   "packet socket", __func__);
210		drv->membership = 1;
211	} else if (wpa_driver_wired_multi(ifname, pae_group_addr, 1) == 0) {
212		wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
213			   "SIOCADDMULTI", __func__);
214		drv->multi = 1;
215	} else if (wpa_driver_wired_get_ifflags(ifname, &flags) < 0) {
216		wpa_printf(MSG_INFO, "%s: Could not get interface "
217			   "flags", __func__);
218		os_free(drv);
219		return NULL;
220	} else if (flags & IFF_ALLMULTI) {
221		wpa_printf(MSG_DEBUG, "%s: Interface is already configured "
222			   "for multicast", __func__);
223	} else if (wpa_driver_wired_set_ifflags(ifname,
224						flags | IFF_ALLMULTI) < 0) {
225		wpa_printf(MSG_INFO, "%s: Failed to enable allmulti",
226			   __func__);
227		os_free(drv);
228		return NULL;
229	} else {
230		wpa_printf(MSG_DEBUG, "%s: Enabled allmulti mode",
231			   __func__);
232		drv->iff_allmulti = 1;
233	}
234
235	return drv;
236}
237
238
239static void wpa_driver_wired_deinit(void *priv)
240{
241	struct wpa_driver_wired_data *drv = priv;
242	int flags;
243
244	if (drv->membership &&
245	    wpa_driver_wired_membership(drv, pae_group_addr, 0) < 0) {
246		wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
247			   "group (PACKET)", __func__);
248	}
249
250	if (drv->multi &&
251	    wpa_driver_wired_multi(drv->ifname, pae_group_addr, 0) < 0) {
252		wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
253			   "group (SIOCDELMULTI)", __func__);
254	}
255
256	if (drv->iff_allmulti &&
257	    (wpa_driver_wired_get_ifflags(drv->ifname, &flags) < 0 ||
258	     wpa_driver_wired_set_ifflags(drv->ifname,
259					  flags & ~IFF_ALLMULTI) < 0)) {
260		wpa_printf(MSG_DEBUG, "%s: Failed to disable allmulti mode",
261			   __func__);
262	}
263
264	if (drv->iff_up &&
265	    wpa_driver_wired_get_ifflags(drv->ifname, &flags) == 0 &&
266	    (flags & IFF_UP) &&
267	    wpa_driver_wired_set_ifflags(drv->ifname, flags & ~IFF_UP) < 0) {
268		wpa_printf(MSG_DEBUG, "%s: Failed to set the interface down",
269			   __func__);
270	}
271
272	if (drv->pf_sock != -1)
273		close(drv->pf_sock);
274
275	os_free(drv);
276}
277
278
279const struct wpa_driver_ops wpa_driver_wired_ops = {
280	.name = "wired",
281	.desc = "wpa_supplicant wired Ethernet driver",
282	.get_ssid = wpa_driver_wired_get_ssid,
283	.get_bssid = wpa_driver_wired_get_bssid,
284	.init = wpa_driver_wired_init,
285	.deinit = wpa_driver_wired_deinit,
286};
287