30#ifdef _MSC_VER
31#pragma pack(push, 1)
32#endif /* _MSC_VER */
33
34struct ieee8023_hdr {
35 u8 dest[6];
36 u8 src[6];
37 u16 ethertype;
38} STRUCT_PACKED;
39
40#ifdef _MSC_VER
41#pragma pack(pop)
42#endif /* _MSC_VER */
43
44static const u8 pae_group_addr[ETH_ALEN] =
45{ 0x01, 0x80, 0xc2, 0x00, 0x00, 0x03 };
46
47
48struct wpa_driver_wired_data {
49 char ifname[IFNAMSIZ + 1];
50 void *ctx;
51
52 int sock; /* raw packet socket for driver access */
53 int dhcp_sock; /* socket for dhcp packets */
54 int use_pae_group_addr;
55
56 int pf_sock;
57 int membership, multi, iff_allmulti, iff_up;
58};
59
60
61/* TODO: detecting new devices should eventually be changed from using DHCP
62 * snooping to trigger on any packet from a new layer 2 MAC address, e.g.,
63 * based on ebtables, etc. */
64
65struct dhcp_message {
66 u_int8_t op;
67 u_int8_t htype;
68 u_int8_t hlen;
69 u_int8_t hops;
70 u_int32_t xid;
71 u_int16_t secs;
72 u_int16_t flags;
73 u_int32_t ciaddr;
74 u_int32_t yiaddr;
75 u_int32_t siaddr;
76 u_int32_t giaddr;
77 u_int8_t chaddr[16];
78 u_int8_t sname[64];
79 u_int8_t file[128];
80 u_int32_t cookie;
81 u_int8_t options[308]; /* 312 - cookie */
82};
83
84
85static int wired_multicast_membership(int sock, int ifindex,
86 const u8 *addr, int add)
87{
88#ifdef __linux__
89 struct packet_mreq mreq;
90
91 if (sock < 0)
92 return -1;
93
94 os_memset(&mreq, 0, sizeof(mreq));
95 mreq.mr_ifindex = ifindex;
96 mreq.mr_type = PACKET_MR_MULTICAST;
97 mreq.mr_alen = ETH_ALEN;
98 os_memcpy(mreq.mr_address, addr, ETH_ALEN);
99
100 if (setsockopt(sock, SOL_PACKET,
101 add ? PACKET_ADD_MEMBERSHIP : PACKET_DROP_MEMBERSHIP,
102 &mreq, sizeof(mreq)) < 0) {
103 wpa_printf(MSG_ERROR, "setsockopt: %s", strerror(errno));
104 return -1;
105 }
106 return 0;
107#else /* __linux__ */
108 return -1;
109#endif /* __linux__ */
110}
111
112
113#ifdef __linux__
114static void handle_data(void *ctx, unsigned char *buf, size_t len)
115{
116#ifdef HOSTAPD
117 struct ieee8023_hdr *hdr;
118 u8 *pos, *sa;
119 size_t left;
120 union wpa_event_data event;
121
122 /* must contain at least ieee8023_hdr 6 byte source, 6 byte dest,
123 * 2 byte ethertype */
124 if (len < 14) {
125 wpa_printf(MSG_MSGDUMP, "handle_data: too short (%lu)",
126 (unsigned long) len);
127 return;
128 }
129
130 hdr = (struct ieee8023_hdr *) buf;
131
132 switch (ntohs(hdr->ethertype)) {
133 case ETH_P_PAE:
134 wpa_printf(MSG_MSGDUMP, "Received EAPOL packet");
135 sa = hdr->src;
136 os_memset(&event, 0, sizeof(event));
137 event.new_sta.addr = sa;
138 wpa_supplicant_event(ctx, EVENT_NEW_STA, &event);
139
140 pos = (u8 *) (hdr + 1);
141 left = len - sizeof(*hdr);
142 drv_event_eapol_rx(ctx, sa, pos, left);
143 break;
144
145 default:
146 wpa_printf(MSG_DEBUG, "Unknown ethertype 0x%04x in data frame",
147 ntohs(hdr->ethertype));
148 break;
149 }
150#endif /* HOSTAPD */
151}
152
153
154static void handle_read(int sock, void *eloop_ctx, void *sock_ctx)
155{
156 int len;
157 unsigned char buf[3000];
158
159 len = recv(sock, buf, sizeof(buf), 0);
160 if (len < 0) {
161 wpa_printf(MSG_ERROR, "recv: %s", strerror(errno));
162 return;
163 }
164
165 handle_data(eloop_ctx, buf, len);
166}
167
168
169static void handle_dhcp(int sock, void *eloop_ctx, void *sock_ctx)
170{
171 int len;
172 unsigned char buf[3000];
173 struct dhcp_message *msg;
174 u8 *mac_address;
175 union wpa_event_data event;
176
177 len = recv(sock, buf, sizeof(buf), 0);
178 if (len < 0) {
179 wpa_printf(MSG_ERROR, "recv: %s", strerror(errno));
180 return;
181 }
182
183 /* must contain at least dhcp_message->chaddr */
184 if (len < 44) {
185 wpa_printf(MSG_MSGDUMP, "handle_dhcp: too short (%d)", len);
186 return;
187 }
188
189 msg = (struct dhcp_message *) buf;
190 mac_address = (u8 *) &(msg->chaddr);
191
192 wpa_printf(MSG_MSGDUMP, "Got DHCP broadcast packet from " MACSTR,
193 MAC2STR(mac_address));
194
195 os_memset(&event, 0, sizeof(event));
196 event.new_sta.addr = mac_address;
197 wpa_supplicant_event(eloop_ctx, EVENT_NEW_STA, &event);
198}
199#endif /* __linux__ */
200
201
202static int wired_init_sockets(struct wpa_driver_wired_data *drv, u8 *own_addr)
203{
204#ifdef __linux__
205 struct ifreq ifr;
206 struct sockaddr_ll addr;
207 struct sockaddr_in addr2;
208 int n = 1;
209
210 drv->sock = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_PAE));
211 if (drv->sock < 0) {
212 wpa_printf(MSG_ERROR, "socket[PF_PACKET,SOCK_RAW]: %s",
213 strerror(errno));
214 return -1;
215 }
216
217 if (eloop_register_read_sock(drv->sock, handle_read, drv->ctx, NULL)) {
218 wpa_printf(MSG_INFO, "Could not register read socket");
219 return -1;
220 }
221
222 os_memset(&ifr, 0, sizeof(ifr));
223 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
224 if (ioctl(drv->sock, SIOCGIFINDEX, &ifr) != 0) {
225 wpa_printf(MSG_ERROR, "ioctl(SIOCGIFINDEX): %s",
226 strerror(errno));
227 return -1;
228 }
229
230 os_memset(&addr, 0, sizeof(addr));
231 addr.sll_family = AF_PACKET;
232 addr.sll_ifindex = ifr.ifr_ifindex;
233 wpa_printf(MSG_DEBUG, "Opening raw packet socket for ifindex %d",
234 addr.sll_ifindex);
235
236 if (bind(drv->sock, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
237 wpa_printf(MSG_ERROR, "bind: %s", strerror(errno));
238 return -1;
239 }
240
241 /* filter multicast address */
242 if (wired_multicast_membership(drv->sock, ifr.ifr_ifindex,
243 pae_group_addr, 1) < 0) {
244 wpa_printf(MSG_ERROR, "wired: Failed to add multicast group "
245 "membership");
246 return -1;
247 }
248
249 os_memset(&ifr, 0, sizeof(ifr));
250 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
251 if (ioctl(drv->sock, SIOCGIFHWADDR, &ifr) != 0) {
252 wpa_printf(MSG_ERROR, "ioctl(SIOCGIFHWADDR): %s",
253 strerror(errno));
254 return -1;
255 }
256
257 if (ifr.ifr_hwaddr.sa_family != ARPHRD_ETHER) {
258 wpa_printf(MSG_INFO, "Invalid HW-addr family 0x%04x",
259 ifr.ifr_hwaddr.sa_family);
260 return -1;
261 }
262 os_memcpy(own_addr, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
263
264 /* setup dhcp listen socket for sta detection */
265 if ((drv->dhcp_sock = socket(PF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
266 wpa_printf(MSG_ERROR, "socket call failed for dhcp: %s",
267 strerror(errno));
268 return -1;
269 }
270
271 if (eloop_register_read_sock(drv->dhcp_sock, handle_dhcp, drv->ctx,
272 NULL)) {
273 wpa_printf(MSG_INFO, "Could not register read socket");
274 return -1;
275 }
276
277 os_memset(&addr2, 0, sizeof(addr2));
278 addr2.sin_family = AF_INET;
279 addr2.sin_port = htons(67);
280 addr2.sin_addr.s_addr = INADDR_ANY;
281
282 if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_REUSEADDR, (char *) &n,
283 sizeof(n)) == -1) {
284 wpa_printf(MSG_ERROR, "setsockopt[SOL_SOCKET,SO_REUSEADDR]: %s",
285 strerror(errno));
286 return -1;
287 }
288 if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_BROADCAST, (char *) &n,
289 sizeof(n)) == -1) {
290 wpa_printf(MSG_ERROR, "setsockopt[SOL_SOCKET,SO_BROADCAST]: %s",
291 strerror(errno));
292 return -1;
293 }
294
295 os_memset(&ifr, 0, sizeof(ifr));
296 os_strlcpy(ifr.ifr_ifrn.ifrn_name, drv->ifname, IFNAMSIZ);
297 if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_BINDTODEVICE,
298 (char *) &ifr, sizeof(ifr)) < 0) {
299 wpa_printf(MSG_ERROR,
300 "setsockopt[SOL_SOCKET,SO_BINDTODEVICE]: %s",
301 strerror(errno));
302 return -1;
303 }
304
305 if (bind(drv->dhcp_sock, (struct sockaddr *) &addr2,
306 sizeof(struct sockaddr)) == -1) {
307 wpa_printf(MSG_ERROR, "bind: %s", strerror(errno));
308 return -1;
309 }
310
311 return 0;
312#else /* __linux__ */
313 return -1;
314#endif /* __linux__ */
315}
316
317
318static int wired_send_eapol(void *priv, const u8 *addr,
319 const u8 *data, size_t data_len, int encrypt,
320 const u8 *own_addr, u32 flags)
321{
322 struct wpa_driver_wired_data *drv = priv;
323 struct ieee8023_hdr *hdr;
324 size_t len;
325 u8 *pos;
326 int res;
327
328 len = sizeof(*hdr) + data_len;
329 hdr = os_zalloc(len);
330 if (hdr == NULL) {
331 wpa_printf(MSG_INFO,
332 "malloc() failed for wired_send_eapol(len=%lu)",
333 (unsigned long) len);
334 return -1;
335 }
336
337 os_memcpy(hdr->dest, drv->use_pae_group_addr ? pae_group_addr : addr,
338 ETH_ALEN);
339 os_memcpy(hdr->src, own_addr, ETH_ALEN);
340 hdr->ethertype = htons(ETH_P_PAE);
341
342 pos = (u8 *) (hdr + 1);
343 os_memcpy(pos, data, data_len);
344
345 res = send(drv->sock, (u8 *) hdr, len, 0);
346 os_free(hdr);
347
348 if (res < 0) {
349 wpa_printf(MSG_ERROR,
350 "wired_send_eapol - packet len: %lu - failed: send: %s",
351 (unsigned long) len, strerror(errno));
352 }
353
354 return res;
355}
356
357
358static void * wired_driver_hapd_init(struct hostapd_data *hapd,
359 struct wpa_init_params *params)
360{
361 struct wpa_driver_wired_data *drv;
362
363 drv = os_zalloc(sizeof(struct wpa_driver_wired_data));
364 if (drv == NULL) {
365 wpa_printf(MSG_INFO,
366 "Could not allocate memory for wired driver data");
367 return NULL;
368 }
369
370 drv->ctx = hapd;
371 os_strlcpy(drv->ifname, params->ifname, sizeof(drv->ifname));
372 drv->use_pae_group_addr = params->use_pae_group_addr;
373
374 if (wired_init_sockets(drv, params->own_addr)) {
375 os_free(drv);
376 return NULL;
377 }
378
379 return drv;
380}
381
382
383static void wired_driver_hapd_deinit(void *priv)
384{
385 struct wpa_driver_wired_data *drv = priv;
386
387 if (drv->sock >= 0) {
388 eloop_unregister_read_sock(drv->sock);
389 close(drv->sock);
390 }
391
392 if (drv->dhcp_sock >= 0) {
393 eloop_unregister_read_sock(drv->dhcp_sock);
394 close(drv->dhcp_sock);
395 }
396
397 os_free(drv);
398}
399
400
401static int wpa_driver_wired_get_ssid(void *priv, u8 *ssid)
402{
403 ssid[0] = 0;
404 return 0;
405}
406
407
408static int wpa_driver_wired_get_bssid(void *priv, u8 *bssid)
409{
410 /* Report PAE group address as the "BSSID" for wired connection. */
411 os_memcpy(bssid, pae_group_addr, ETH_ALEN);
412 return 0;
413}
414
415
416static int wpa_driver_wired_get_capa(void *priv, struct wpa_driver_capa *capa)
417{
418 os_memset(capa, 0, sizeof(*capa));
419 capa->flags = WPA_DRIVER_FLAGS_WIRED;
420 return 0;
421}
422
423
424static int wpa_driver_wired_get_ifflags(const char *ifname, int *flags)
425{
426 struct ifreq ifr;
427 int s;
428
429 s = socket(PF_INET, SOCK_DGRAM, 0);
430 if (s < 0) {
431 wpa_printf(MSG_ERROR, "socket: %s", strerror(errno));
432 return -1;
433 }
434
435 os_memset(&ifr, 0, sizeof(ifr));
436 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
437 if (ioctl(s, SIOCGIFFLAGS, (caddr_t) &ifr) < 0) {
438 wpa_printf(MSG_ERROR, "ioctl[SIOCGIFFLAGS]: %s",
439 strerror(errno));
440 close(s);
441 return -1;
442 }
443 close(s);
444 *flags = ifr.ifr_flags & 0xffff;
445 return 0;
446}
447
448
449static int wpa_driver_wired_set_ifflags(const char *ifname, int flags)
450{
451 struct ifreq ifr;
452 int s;
453
454 s = socket(PF_INET, SOCK_DGRAM, 0);
455 if (s < 0) {
456 wpa_printf(MSG_ERROR, "socket: %s", strerror(errno));
457 return -1;
458 }
459
460 os_memset(&ifr, 0, sizeof(ifr));
461 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
462 ifr.ifr_flags = flags & 0xffff;
463 if (ioctl(s, SIOCSIFFLAGS, (caddr_t) &ifr) < 0) {
464 wpa_printf(MSG_ERROR, "ioctl[SIOCSIFFLAGS]: %s",
465 strerror(errno));
466 close(s);
467 return -1;
468 }
469 close(s);
470 return 0;
471}
472
| 31#ifdef _MSC_VER
32#pragma pack(push, 1)
33#endif /* _MSC_VER */
34
35struct ieee8023_hdr {
36 u8 dest[6];
37 u8 src[6];
38 u16 ethertype;
39} STRUCT_PACKED;
40
41#ifdef _MSC_VER
42#pragma pack(pop)
43#endif /* _MSC_VER */
44
45static const u8 pae_group_addr[ETH_ALEN] =
46{ 0x01, 0x80, 0xc2, 0x00, 0x00, 0x03 };
47
48
49struct wpa_driver_wired_data {
50 char ifname[IFNAMSIZ + 1];
51 void *ctx;
52
53 int sock; /* raw packet socket for driver access */
54 int dhcp_sock; /* socket for dhcp packets */
55 int use_pae_group_addr;
56
57 int pf_sock;
58 int membership, multi, iff_allmulti, iff_up;
59};
60
61
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. */
65
66struct dhcp_message {
67 u_int8_t op;
68 u_int8_t htype;
69 u_int8_t hlen;
70 u_int8_t hops;
71 u_int32_t xid;
72 u_int16_t secs;
73 u_int16_t flags;
74 u_int32_t ciaddr;
75 u_int32_t yiaddr;
76 u_int32_t siaddr;
77 u_int32_t giaddr;
78 u_int8_t chaddr[16];
79 u_int8_t sname[64];
80 u_int8_t file[128];
81 u_int32_t cookie;
82 u_int8_t options[308]; /* 312 - cookie */
83};
84
85
86static int wired_multicast_membership(int sock, int ifindex,
87 const u8 *addr, int add)
88{
89#ifdef __linux__
90 struct packet_mreq mreq;
91
92 if (sock < 0)
93 return -1;
94
95 os_memset(&mreq, 0, sizeof(mreq));
96 mreq.mr_ifindex = ifindex;
97 mreq.mr_type = PACKET_MR_MULTICAST;
98 mreq.mr_alen = ETH_ALEN;
99 os_memcpy(mreq.mr_address, addr, ETH_ALEN);
100
101 if (setsockopt(sock, SOL_PACKET,
102 add ? PACKET_ADD_MEMBERSHIP : PACKET_DROP_MEMBERSHIP,
103 &mreq, sizeof(mreq)) < 0) {
104 wpa_printf(MSG_ERROR, "setsockopt: %s", strerror(errno));
105 return -1;
106 }
107 return 0;
108#else /* __linux__ */
109 return -1;
110#endif /* __linux__ */
111}
112
113
114#ifdef __linux__
115static void handle_data(void *ctx, unsigned char *buf, size_t len)
116{
117#ifdef HOSTAPD
118 struct ieee8023_hdr *hdr;
119 u8 *pos, *sa;
120 size_t left;
121 union wpa_event_data event;
122
123 /* must contain at least ieee8023_hdr 6 byte source, 6 byte dest,
124 * 2 byte ethertype */
125 if (len < 14) {
126 wpa_printf(MSG_MSGDUMP, "handle_data: too short (%lu)",
127 (unsigned long) len);
128 return;
129 }
130
131 hdr = (struct ieee8023_hdr *) buf;
132
133 switch (ntohs(hdr->ethertype)) {
134 case ETH_P_PAE:
135 wpa_printf(MSG_MSGDUMP, "Received EAPOL packet");
136 sa = hdr->src;
137 os_memset(&event, 0, sizeof(event));
138 event.new_sta.addr = sa;
139 wpa_supplicant_event(ctx, EVENT_NEW_STA, &event);
140
141 pos = (u8 *) (hdr + 1);
142 left = len - sizeof(*hdr);
143 drv_event_eapol_rx(ctx, sa, pos, left);
144 break;
145
146 default:
147 wpa_printf(MSG_DEBUG, "Unknown ethertype 0x%04x in data frame",
148 ntohs(hdr->ethertype));
149 break;
150 }
151#endif /* HOSTAPD */
152}
153
154
155static void handle_read(int sock, void *eloop_ctx, void *sock_ctx)
156{
157 int len;
158 unsigned char buf[3000];
159
160 len = recv(sock, buf, sizeof(buf), 0);
161 if (len < 0) {
162 wpa_printf(MSG_ERROR, "recv: %s", strerror(errno));
163 return;
164 }
165
166 handle_data(eloop_ctx, buf, len);
167}
168
169
170static void handle_dhcp(int sock, void *eloop_ctx, void *sock_ctx)
171{
172 int len;
173 unsigned char buf[3000];
174 struct dhcp_message *msg;
175 u8 *mac_address;
176 union wpa_event_data event;
177
178 len = recv(sock, buf, sizeof(buf), 0);
179 if (len < 0) {
180 wpa_printf(MSG_ERROR, "recv: %s", strerror(errno));
181 return;
182 }
183
184 /* must contain at least dhcp_message->chaddr */
185 if (len < 44) {
186 wpa_printf(MSG_MSGDUMP, "handle_dhcp: too short (%d)", len);
187 return;
188 }
189
190 msg = (struct dhcp_message *) buf;
191 mac_address = (u8 *) &(msg->chaddr);
192
193 wpa_printf(MSG_MSGDUMP, "Got DHCP broadcast packet from " MACSTR,
194 MAC2STR(mac_address));
195
196 os_memset(&event, 0, sizeof(event));
197 event.new_sta.addr = mac_address;
198 wpa_supplicant_event(eloop_ctx, EVENT_NEW_STA, &event);
199}
200#endif /* __linux__ */
201
202
203static int wired_init_sockets(struct wpa_driver_wired_data *drv, u8 *own_addr)
204{
205#ifdef __linux__
206 struct ifreq ifr;
207 struct sockaddr_ll addr;
208 struct sockaddr_in addr2;
209 int n = 1;
210
211 drv->sock = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_PAE));
212 if (drv->sock < 0) {
213 wpa_printf(MSG_ERROR, "socket[PF_PACKET,SOCK_RAW]: %s",
214 strerror(errno));
215 return -1;
216 }
217
218 if (eloop_register_read_sock(drv->sock, handle_read, drv->ctx, NULL)) {
219 wpa_printf(MSG_INFO, "Could not register read socket");
220 return -1;
221 }
222
223 os_memset(&ifr, 0, sizeof(ifr));
224 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
225 if (ioctl(drv->sock, SIOCGIFINDEX, &ifr) != 0) {
226 wpa_printf(MSG_ERROR, "ioctl(SIOCGIFINDEX): %s",
227 strerror(errno));
228 return -1;
229 }
230
231 os_memset(&addr, 0, sizeof(addr));
232 addr.sll_family = AF_PACKET;
233 addr.sll_ifindex = ifr.ifr_ifindex;
234 wpa_printf(MSG_DEBUG, "Opening raw packet socket for ifindex %d",
235 addr.sll_ifindex);
236
237 if (bind(drv->sock, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
238 wpa_printf(MSG_ERROR, "bind: %s", strerror(errno));
239 return -1;
240 }
241
242 /* filter multicast address */
243 if (wired_multicast_membership(drv->sock, ifr.ifr_ifindex,
244 pae_group_addr, 1) < 0) {
245 wpa_printf(MSG_ERROR, "wired: Failed to add multicast group "
246 "membership");
247 return -1;
248 }
249
250 os_memset(&ifr, 0, sizeof(ifr));
251 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
252 if (ioctl(drv->sock, SIOCGIFHWADDR, &ifr) != 0) {
253 wpa_printf(MSG_ERROR, "ioctl(SIOCGIFHWADDR): %s",
254 strerror(errno));
255 return -1;
256 }
257
258 if (ifr.ifr_hwaddr.sa_family != ARPHRD_ETHER) {
259 wpa_printf(MSG_INFO, "Invalid HW-addr family 0x%04x",
260 ifr.ifr_hwaddr.sa_family);
261 return -1;
262 }
263 os_memcpy(own_addr, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
264
265 /* setup dhcp listen socket for sta detection */
266 if ((drv->dhcp_sock = socket(PF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
267 wpa_printf(MSG_ERROR, "socket call failed for dhcp: %s",
268 strerror(errno));
269 return -1;
270 }
271
272 if (eloop_register_read_sock(drv->dhcp_sock, handle_dhcp, drv->ctx,
273 NULL)) {
274 wpa_printf(MSG_INFO, "Could not register read socket");
275 return -1;
276 }
277
278 os_memset(&addr2, 0, sizeof(addr2));
279 addr2.sin_family = AF_INET;
280 addr2.sin_port = htons(67);
281 addr2.sin_addr.s_addr = INADDR_ANY;
282
283 if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_REUSEADDR, (char *) &n,
284 sizeof(n)) == -1) {
285 wpa_printf(MSG_ERROR, "setsockopt[SOL_SOCKET,SO_REUSEADDR]: %s",
286 strerror(errno));
287 return -1;
288 }
289 if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_BROADCAST, (char *) &n,
290 sizeof(n)) == -1) {
291 wpa_printf(MSG_ERROR, "setsockopt[SOL_SOCKET,SO_BROADCAST]: %s",
292 strerror(errno));
293 return -1;
294 }
295
296 os_memset(&ifr, 0, sizeof(ifr));
297 os_strlcpy(ifr.ifr_ifrn.ifrn_name, drv->ifname, IFNAMSIZ);
298 if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_BINDTODEVICE,
299 (char *) &ifr, sizeof(ifr)) < 0) {
300 wpa_printf(MSG_ERROR,
301 "setsockopt[SOL_SOCKET,SO_BINDTODEVICE]: %s",
302 strerror(errno));
303 return -1;
304 }
305
306 if (bind(drv->dhcp_sock, (struct sockaddr *) &addr2,
307 sizeof(struct sockaddr)) == -1) {
308 wpa_printf(MSG_ERROR, "bind: %s", strerror(errno));
309 return -1;
310 }
311
312 return 0;
313#else /* __linux__ */
314 return -1;
315#endif /* __linux__ */
316}
317
318
319static int wired_send_eapol(void *priv, const u8 *addr,
320 const u8 *data, size_t data_len, int encrypt,
321 const u8 *own_addr, u32 flags)
322{
323 struct wpa_driver_wired_data *drv = priv;
324 struct ieee8023_hdr *hdr;
325 size_t len;
326 u8 *pos;
327 int res;
328
329 len = sizeof(*hdr) + data_len;
330 hdr = os_zalloc(len);
331 if (hdr == NULL) {
332 wpa_printf(MSG_INFO,
333 "malloc() failed for wired_send_eapol(len=%lu)",
334 (unsigned long) len);
335 return -1;
336 }
337
338 os_memcpy(hdr->dest, drv->use_pae_group_addr ? pae_group_addr : addr,
339 ETH_ALEN);
340 os_memcpy(hdr->src, own_addr, ETH_ALEN);
341 hdr->ethertype = htons(ETH_P_PAE);
342
343 pos = (u8 *) (hdr + 1);
344 os_memcpy(pos, data, data_len);
345
346 res = send(drv->sock, (u8 *) hdr, len, 0);
347 os_free(hdr);
348
349 if (res < 0) {
350 wpa_printf(MSG_ERROR,
351 "wired_send_eapol - packet len: %lu - failed: send: %s",
352 (unsigned long) len, strerror(errno));
353 }
354
355 return res;
356}
357
358
359static void * wired_driver_hapd_init(struct hostapd_data *hapd,
360 struct wpa_init_params *params)
361{
362 struct wpa_driver_wired_data *drv;
363
364 drv = os_zalloc(sizeof(struct wpa_driver_wired_data));
365 if (drv == NULL) {
366 wpa_printf(MSG_INFO,
367 "Could not allocate memory for wired driver data");
368 return NULL;
369 }
370
371 drv->ctx = hapd;
372 os_strlcpy(drv->ifname, params->ifname, sizeof(drv->ifname));
373 drv->use_pae_group_addr = params->use_pae_group_addr;
374
375 if (wired_init_sockets(drv, params->own_addr)) {
376 os_free(drv);
377 return NULL;
378 }
379
380 return drv;
381}
382
383
384static void wired_driver_hapd_deinit(void *priv)
385{
386 struct wpa_driver_wired_data *drv = priv;
387
388 if (drv->sock >= 0) {
389 eloop_unregister_read_sock(drv->sock);
390 close(drv->sock);
391 }
392
393 if (drv->dhcp_sock >= 0) {
394 eloop_unregister_read_sock(drv->dhcp_sock);
395 close(drv->dhcp_sock);
396 }
397
398 os_free(drv);
399}
400
401
402static int wpa_driver_wired_get_ssid(void *priv, u8 *ssid)
403{
404 ssid[0] = 0;
405 return 0;
406}
407
408
409static int wpa_driver_wired_get_bssid(void *priv, u8 *bssid)
410{
411 /* Report PAE group address as the "BSSID" for wired connection. */
412 os_memcpy(bssid, pae_group_addr, ETH_ALEN);
413 return 0;
414}
415
416
417static int wpa_driver_wired_get_capa(void *priv, struct wpa_driver_capa *capa)
418{
419 os_memset(capa, 0, sizeof(*capa));
420 capa->flags = WPA_DRIVER_FLAGS_WIRED;
421 return 0;
422}
423
424
425static int wpa_driver_wired_get_ifflags(const char *ifname, int *flags)
426{
427 struct ifreq ifr;
428 int s;
429
430 s = socket(PF_INET, SOCK_DGRAM, 0);
431 if (s < 0) {
432 wpa_printf(MSG_ERROR, "socket: %s", strerror(errno));
433 return -1;
434 }
435
436 os_memset(&ifr, 0, sizeof(ifr));
437 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
438 if (ioctl(s, SIOCGIFFLAGS, (caddr_t) &ifr) < 0) {
439 wpa_printf(MSG_ERROR, "ioctl[SIOCGIFFLAGS]: %s",
440 strerror(errno));
441 close(s);
442 return -1;
443 }
444 close(s);
445 *flags = ifr.ifr_flags & 0xffff;
446 return 0;
447}
448
449
450static int wpa_driver_wired_set_ifflags(const char *ifname, int flags)
451{
452 struct ifreq ifr;
453 int s;
454
455 s = socket(PF_INET, SOCK_DGRAM, 0);
456 if (s < 0) {
457 wpa_printf(MSG_ERROR, "socket: %s", strerror(errno));
458 return -1;
459 }
460
461 os_memset(&ifr, 0, sizeof(ifr));
462 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
463 ifr.ifr_flags = flags & 0xffff;
464 if (ioctl(s, SIOCSIFFLAGS, (caddr_t) &ifr) < 0) {
465 wpa_printf(MSG_ERROR, "ioctl[SIOCSIFFLAGS]: %s",
466 strerror(errno));
467 close(s);
468 return -1;
469 }
470 close(s);
471 return 0;
472}
473
|
561
562 drv = os_zalloc(sizeof(*drv));
563 if (drv == NULL)
564 return NULL;
565 os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
566 drv->ctx = ctx;
567
568#ifdef __linux__
569 drv->pf_sock = socket(PF_PACKET, SOCK_DGRAM, 0);
570 if (drv->pf_sock < 0)
571 wpa_printf(MSG_ERROR, "socket(PF_PACKET): %s", strerror(errno));
572#else /* __linux__ */
573 drv->pf_sock = -1;
574#endif /* __linux__ */
575
576 if (wpa_driver_wired_get_ifflags(ifname, &flags) == 0 &&
577 !(flags & IFF_UP) &&
578 wpa_driver_wired_set_ifflags(ifname, flags | IFF_UP) == 0) {
579 drv->iff_up = 1;
580 }
581
582 if (wired_multicast_membership(drv->pf_sock,
583 if_nametoindex(drv->ifname),
584 pae_group_addr, 1) == 0) {
585 wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
586 "packet socket", __func__);
587 drv->membership = 1;
588 } else if (wpa_driver_wired_multi(ifname, pae_group_addr, 1) == 0) {
589 wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
590 "SIOCADDMULTI", __func__);
591 drv->multi = 1;
592 } else if (wpa_driver_wired_get_ifflags(ifname, &flags) < 0) {
593 wpa_printf(MSG_INFO, "%s: Could not get interface "
594 "flags", __func__);
595 os_free(drv);
596 return NULL;
597 } else if (flags & IFF_ALLMULTI) {
598 wpa_printf(MSG_DEBUG, "%s: Interface is already configured "
599 "for multicast", __func__);
600 } else if (wpa_driver_wired_set_ifflags(ifname,
601 flags | IFF_ALLMULTI) < 0) {
602 wpa_printf(MSG_INFO, "%s: Failed to enable allmulti",
603 __func__);
604 os_free(drv);
605 return NULL;
606 } else {
607 wpa_printf(MSG_DEBUG, "%s: Enabled allmulti mode",
608 __func__);
609 drv->iff_allmulti = 1;
610 }
611#if defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__)
612 {
613 int status;
614 wpa_printf(MSG_DEBUG, "%s: waiting for link to become active",
615 __func__);
616 while (wpa_driver_wired_get_ifstatus(ifname, &status) == 0 &&
617 status == 0)
618 sleep(1);
619 }
620#endif /* defined(__FreeBSD__) || defined(__DragonFly__) || defined(FreeBSD_kernel__) */
621
622 return drv;
623}
624
625
626static void wpa_driver_wired_deinit(void *priv)
627{
628 struct wpa_driver_wired_data *drv = priv;
629 int flags;
630
631 if (drv->membership &&
632 wired_multicast_membership(drv->pf_sock,
633 if_nametoindex(drv->ifname),
634 pae_group_addr, 0) < 0) {
635 wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
636 "group (PACKET)", __func__);
637 }
638
639 if (drv->multi &&
640 wpa_driver_wired_multi(drv->ifname, pae_group_addr, 0) < 0) {
641 wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
642 "group (SIOCDELMULTI)", __func__);
643 }
644
645 if (drv->iff_allmulti &&
646 (wpa_driver_wired_get_ifflags(drv->ifname, &flags) < 0 ||
647 wpa_driver_wired_set_ifflags(drv->ifname,
648 flags & ~IFF_ALLMULTI) < 0)) {
649 wpa_printf(MSG_DEBUG, "%s: Failed to disable allmulti mode",
650 __func__);
651 }
652
653 if (drv->iff_up &&
654 wpa_driver_wired_get_ifflags(drv->ifname, &flags) == 0 &&
655 (flags & IFF_UP) &&
656 wpa_driver_wired_set_ifflags(drv->ifname, flags & ~IFF_UP) < 0) {
657 wpa_printf(MSG_DEBUG, "%s: Failed to set the interface down",
658 __func__);
659 }
660
661 if (drv->pf_sock != -1)
662 close(drv->pf_sock);
663
664 os_free(drv);
665}
666
667
668const struct wpa_driver_ops wpa_driver_wired_ops = {
669 .name = "wired",
670 .desc = "Wired Ethernet driver",
671 .hapd_init = wired_driver_hapd_init,
672 .hapd_deinit = wired_driver_hapd_deinit,
673 .hapd_send_eapol = wired_send_eapol,
674 .get_ssid = wpa_driver_wired_get_ssid,
675 .get_bssid = wpa_driver_wired_get_bssid,
676 .get_capa = wpa_driver_wired_get_capa,
677 .init = wpa_driver_wired_init,
678 .deinit = wpa_driver_wired_deinit,
679};
| 563
564 drv = os_zalloc(sizeof(*drv));
565 if (drv == NULL)
566 return NULL;
567 os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
568 drv->ctx = ctx;
569
570#ifdef __linux__
571 drv->pf_sock = socket(PF_PACKET, SOCK_DGRAM, 0);
572 if (drv->pf_sock < 0)
573 wpa_printf(MSG_ERROR, "socket(PF_PACKET): %s", strerror(errno));
574#else /* __linux__ */
575 drv->pf_sock = -1;
576#endif /* __linux__ */
577
578 if (wpa_driver_wired_get_ifflags(ifname, &flags) == 0 &&
579 !(flags & IFF_UP) &&
580 wpa_driver_wired_set_ifflags(ifname, flags | IFF_UP) == 0) {
581 drv->iff_up = 1;
582 }
583
584 if (wired_multicast_membership(drv->pf_sock,
585 if_nametoindex(drv->ifname),
586 pae_group_addr, 1) == 0) {
587 wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
588 "packet socket", __func__);
589 drv->membership = 1;
590 } else if (wpa_driver_wired_multi(ifname, pae_group_addr, 1) == 0) {
591 wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
592 "SIOCADDMULTI", __func__);
593 drv->multi = 1;
594 } else if (wpa_driver_wired_get_ifflags(ifname, &flags) < 0) {
595 wpa_printf(MSG_INFO, "%s: Could not get interface "
596 "flags", __func__);
597 os_free(drv);
598 return NULL;
599 } else if (flags & IFF_ALLMULTI) {
600 wpa_printf(MSG_DEBUG, "%s: Interface is already configured "
601 "for multicast", __func__);
602 } else if (wpa_driver_wired_set_ifflags(ifname,
603 flags | IFF_ALLMULTI) < 0) {
604 wpa_printf(MSG_INFO, "%s: Failed to enable allmulti",
605 __func__);
606 os_free(drv);
607 return NULL;
608 } else {
609 wpa_printf(MSG_DEBUG, "%s: Enabled allmulti mode",
610 __func__);
611 drv->iff_allmulti = 1;
612 }
613#if defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__)
614 {
615 int status;
616 wpa_printf(MSG_DEBUG, "%s: waiting for link to become active",
617 __func__);
618 while (wpa_driver_wired_get_ifstatus(ifname, &status) == 0 &&
619 status == 0)
620 sleep(1);
621 }
622#endif /* defined(__FreeBSD__) || defined(__DragonFly__) || defined(FreeBSD_kernel__) */
623
624 return drv;
625}
626
627
628static void wpa_driver_wired_deinit(void *priv)
629{
630 struct wpa_driver_wired_data *drv = priv;
631 int flags;
632
633 if (drv->membership &&
634 wired_multicast_membership(drv->pf_sock,
635 if_nametoindex(drv->ifname),
636 pae_group_addr, 0) < 0) {
637 wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
638 "group (PACKET)", __func__);
639 }
640
641 if (drv->multi &&
642 wpa_driver_wired_multi(drv->ifname, pae_group_addr, 0) < 0) {
643 wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
644 "group (SIOCDELMULTI)", __func__);
645 }
646
647 if (drv->iff_allmulti &&
648 (wpa_driver_wired_get_ifflags(drv->ifname, &flags) < 0 ||
649 wpa_driver_wired_set_ifflags(drv->ifname,
650 flags & ~IFF_ALLMULTI) < 0)) {
651 wpa_printf(MSG_DEBUG, "%s: Failed to disable allmulti mode",
652 __func__);
653 }
654
655 if (drv->iff_up &&
656 wpa_driver_wired_get_ifflags(drv->ifname, &flags) == 0 &&
657 (flags & IFF_UP) &&
658 wpa_driver_wired_set_ifflags(drv->ifname, flags & ~IFF_UP) < 0) {
659 wpa_printf(MSG_DEBUG, "%s: Failed to set the interface down",
660 __func__);
661 }
662
663 if (drv->pf_sock != -1)
664 close(drv->pf_sock);
665
666 os_free(drv);
667}
668
669
670const struct wpa_driver_ops wpa_driver_wired_ops = {
671 .name = "wired",
672 .desc = "Wired Ethernet driver",
673 .hapd_init = wired_driver_hapd_init,
674 .hapd_deinit = wired_driver_hapd_deinit,
675 .hapd_send_eapol = wired_send_eapol,
676 .get_ssid = wpa_driver_wired_get_ssid,
677 .get_bssid = wpa_driver_wired_get_bssid,
678 .get_capa = wpa_driver_wired_get_capa,
679 .init = wpa_driver_wired_init,
680 .deinit = wpa_driver_wired_deinit,
681};
|