1526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt/* 2526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * WPA Supplicant - Layer2 packet handling with WinPcap RX thread 3526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * Copyright (c) 2003-2006, Jouni Malinen <j@w1.fi> 4526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * 5526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * This program is free software; you can redistribute it and/or modify 6526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * it under the terms of the GNU General Public License version 2 as 7526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * published by the Free Software Foundation. 8526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * 9526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * Alternatively, this software may be distributed under the terms of BSD 10526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * license. 11526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * 12526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * See README and COPYING for more details. 13526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * 14526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * This l2_packet implementation is explicitly for WinPcap and Windows events. 15526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * l2_packet_pcap.c has support for WinPcap, but it requires polling to receive 16526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * frames which means relatively long latency for EAPOL RX processing. The 17526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * implementation here uses a separate thread to allow WinPcap to be receiving 18526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * all the time to reduce latency for EAPOL receiving from about 100 ms to 3 ms 19526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * when comparing l2_packet_pcap.c to l2_packet_winpcap.c. Extra sleep of 50 ms 20526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * is added in to receive thread whenever no EAPOL frames has been received for 21526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * a while. Whenever an EAPOL handshake is expected, this sleep is removed. 22526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * 23526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * The RX thread receives a frame and signals main thread through Windows event 24526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * about the availability of a new frame. Processing the received frame is 25526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * synchronized with pair of Windows events so that no extra buffer or queuing 26526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * mechanism is needed. This implementation requires Windows specific event 27526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * loop implementation, i.e., eloop_win.c. 28526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * 29526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * WinPcap has pcap_getevent() that could, in theory at least, be used to 30526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * implement this kind of waiting with a simpler single-thread design. However, 31526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * that event handle is not really signaled immediately when receiving each 32526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * frame, so it does not really work for this kind of use. 33526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt */ 34526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 35526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt#include "includes.h" 36526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt#include <pcap.h> 37526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 38526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt#include "common.h" 39526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt#include "eloop.h" 40526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt#include "l2_packet.h" 41526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 42526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 43526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtstatic const u8 pae_group_addr[ETH_ALEN] = 44526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 0x01, 0x80, 0xc2, 0x00, 0x00, 0x03 }; 45526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 46526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt/* 47526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * Number of pcap_dispatch() iterations to do without extra wait after each 48526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * received EAPOL packet or authentication notification. This is used to reduce 49526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * latency for EAPOL receive. 50526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt */ 51526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtstatic const size_t no_wait_count = 750; 52526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 53526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtstruct l2_packet_data { 54526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt pcap_t *pcap; 55526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt unsigned int num_fast_poll; 56526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt char ifname[100]; 57526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt u8 own_addr[ETH_ALEN]; 58526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt void (*rx_callback)(void *ctx, const u8 *src_addr, 59526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt const u8 *buf, size_t len); 60526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt void *rx_callback_ctx; 61526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt int l2_hdr; /* whether to include layer 2 (Ethernet) header in calls to 62526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * rx_callback and l2_packet_send() */ 63526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt int running; 64526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt HANDLE rx_avail, rx_done, rx_thread, rx_thread_done, rx_notify; 65526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt u8 *rx_buf, *rx_src; 66526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt size_t rx_len; 67526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt size_t rx_no_wait; 68526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt}; 69526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 70526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 71526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtint l2_packet_get_own_addr(struct l2_packet_data *l2, u8 *addr) 72526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 73526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_memcpy(addr, l2->own_addr, ETH_ALEN); 74526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return 0; 75526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 76526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 77526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 78526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtint l2_packet_send(struct l2_packet_data *l2, const u8 *dst_addr, u16 proto, 79526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt const u8 *buf, size_t len) 80526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 81526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt int ret; 82526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt struct l2_ethhdr *eth; 83526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 84526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2 == NULL) 85526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return -1; 86526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 87526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2->l2_hdr) { 88526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt ret = pcap_sendpacket(l2->pcap, buf, len); 89526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } else { 90526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt size_t mlen = sizeof(*eth) + len; 91526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt eth = os_malloc(mlen); 92526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (eth == NULL) 93526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return -1; 94526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 95526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_memcpy(eth->h_dest, dst_addr, ETH_ALEN); 96526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_memcpy(eth->h_source, l2->own_addr, ETH_ALEN); 97526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt eth->h_proto = htons(proto); 98526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_memcpy(eth + 1, buf, len); 99526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt ret = pcap_sendpacket(l2->pcap, (u8 *) eth, mlen); 100526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_free(eth); 101526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 102526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 103526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return ret; 104526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 105526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 106526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 107526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt/* pcap_dispatch() callback for the RX thread */ 108526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtstatic void l2_packet_receive_cb(u_char *user, const struct pcap_pkthdr *hdr, 109526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt const u_char *pkt_data) 110526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 111526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt struct l2_packet_data *l2 = (struct l2_packet_data *) user; 112526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt struct l2_ethhdr *ethhdr; 113526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 114526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (pkt_data == NULL || hdr->caplen < sizeof(*ethhdr)) 115526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return; 116526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 117526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt ethhdr = (struct l2_ethhdr *) pkt_data; 118526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2->l2_hdr) { 119526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_buf = (u8 *) ethhdr; 120526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_len = hdr->caplen; 121526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } else { 122526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_buf = (u8 *) (ethhdr + 1); 123526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_len = hdr->caplen - sizeof(*ethhdr); 124526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 125526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_src = ethhdr->h_source; 126526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt SetEvent(l2->rx_avail); 127526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt WaitForSingleObject(l2->rx_done, INFINITE); 128526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt ResetEvent(l2->rx_done); 129526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_no_wait = no_wait_count; 130526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 131526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 132526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 133526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt/* main RX loop that is running in a separate thread */ 134526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtstatic DWORD WINAPI l2_packet_receive_thread(LPVOID arg) 135526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 136526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt struct l2_packet_data *l2 = arg; 137526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 138526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt while (l2->running) { 139526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt pcap_dispatch(l2->pcap, 1, l2_packet_receive_cb, 140526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt (u_char *) l2); 141526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2->rx_no_wait > 0) 142526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_no_wait--; 143526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (WaitForSingleObject(l2->rx_notify, 144526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_no_wait ? 0 : 50) == 145526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt WAIT_OBJECT_0) { 146526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_no_wait = no_wait_count; 147526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt ResetEvent(l2->rx_notify); 148526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 149526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 150526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt SetEvent(l2->rx_thread_done); 151526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt ExitThread(0); 152526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return 0; 153526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 154526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 155526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 156526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt/* main thread RX event handler */ 157526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtstatic void l2_packet_rx_event(void *eloop_data, void *user_data) 158526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 159526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt struct l2_packet_data *l2 = eloop_data; 160526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_callback(l2->rx_callback_ctx, l2->rx_src, l2->rx_buf, 161526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_len); 162526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt ResetEvent(l2->rx_avail); 163526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt SetEvent(l2->rx_done); 164526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 165526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 166526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 167526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtstatic int l2_packet_init_libpcap(struct l2_packet_data *l2, 168526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt unsigned short protocol) 169526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 170526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt bpf_u_int32 pcap_maskp, pcap_netp; 171526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt char pcap_filter[200], pcap_err[PCAP_ERRBUF_SIZE]; 172526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt struct bpf_program pcap_fp; 173526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 174526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt pcap_lookupnet(l2->ifname, &pcap_netp, &pcap_maskp, pcap_err); 175526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->pcap = pcap_open_live(l2->ifname, 2500, 0, 1, pcap_err); 176526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2->pcap == NULL) { 177526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt fprintf(stderr, "pcap_open_live: %s\n", pcap_err); 178526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt fprintf(stderr, "ifname='%s'\n", l2->ifname); 179526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return -1; 180526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 181526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_snprintf(pcap_filter, sizeof(pcap_filter), 182526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt "not ether src " MACSTR " and " 183526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt "( ether dst " MACSTR " or ether dst " MACSTR " ) and " 184526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt "ether proto 0x%x", 185526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt MAC2STR(l2->own_addr), /* do not receive own packets */ 186526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt MAC2STR(l2->own_addr), MAC2STR(pae_group_addr), 187526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt protocol); 188526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (pcap_compile(l2->pcap, &pcap_fp, pcap_filter, 1, pcap_netp) < 0) { 189526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt fprintf(stderr, "pcap_compile: %s\n", pcap_geterr(l2->pcap)); 190526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return -1; 191526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 192526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 193526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (pcap_setfilter(l2->pcap, &pcap_fp) < 0) { 194526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt fprintf(stderr, "pcap_setfilter: %s\n", pcap_geterr(l2->pcap)); 195526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return -1; 196526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 197526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 198526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt pcap_freecode(&pcap_fp); 199526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 200526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return 0; 201526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 202526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 203526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 204526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtstruct l2_packet_data * l2_packet_init( 205526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt const char *ifname, const u8 *own_addr, unsigned short protocol, 206526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt void (*rx_callback)(void *ctx, const u8 *src_addr, 207526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt const u8 *buf, size_t len), 208526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt void *rx_callback_ctx, int l2_hdr) 209526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 210526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt struct l2_packet_data *l2; 211526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt DWORD thread_id; 212526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 213526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2 = os_zalloc(sizeof(struct l2_packet_data)); 214526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2 == NULL) 215526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return NULL; 216526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (os_strncmp(ifname, "\\Device\\NPF_", 12) == 0) 217526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_strlcpy(l2->ifname, ifname, sizeof(l2->ifname)); 218526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt else 219526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_snprintf(l2->ifname, sizeof(l2->ifname), "\\Device\\NPF_%s", 220526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt ifname); 221526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_callback = rx_callback; 222526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_callback_ctx = rx_callback_ctx; 223526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->l2_hdr = l2_hdr; 224526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 225526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (own_addr) 226526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_memcpy(l2->own_addr, own_addr, ETH_ALEN); 227526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 228526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2_packet_init_libpcap(l2, protocol)) { 229526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_free(l2); 230526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return NULL; 231526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 232526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 233526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_avail = CreateEvent(NULL, TRUE, FALSE, NULL); 234526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_done = CreateEvent(NULL, TRUE, FALSE, NULL); 235526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_notify = CreateEvent(NULL, TRUE, FALSE, NULL); 236526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2->rx_avail == NULL || l2->rx_done == NULL || 237526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_notify == NULL) { 238526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt CloseHandle(l2->rx_avail); 239526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt CloseHandle(l2->rx_done); 240526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt CloseHandle(l2->rx_notify); 241526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt pcap_close(l2->pcap); 242526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_free(l2); 243526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return NULL; 244526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 245526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 246526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt eloop_register_event(l2->rx_avail, sizeof(l2->rx_avail), 247526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2_packet_rx_event, l2, NULL); 248526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 249526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->running = 1; 250526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_thread = CreateThread(NULL, 0, l2_packet_receive_thread, l2, 0, 251526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt &thread_id); 252526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 253526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return l2; 254526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 255526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 256526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 257526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtstatic void l2_packet_deinit_timeout(void *eloop_ctx, void *timeout_ctx) 258526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 259526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt struct l2_packet_data *l2 = eloop_ctx; 260526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 261526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2->rx_thread_done && 262526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt WaitForSingleObject(l2->rx_thread_done, 2000) != WAIT_OBJECT_0) { 263526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt wpa_printf(MSG_DEBUG, "l2_packet_winpcap: RX thread did not " 264526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt "exit - kill it\n"); 265526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt TerminateThread(l2->rx_thread, 0); 266526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 267526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt CloseHandle(l2->rx_thread_done); 268526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt CloseHandle(l2->rx_thread); 269526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2->pcap) 270526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt pcap_close(l2->pcap); 271526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt eloop_unregister_event(l2->rx_avail, sizeof(l2->rx_avail)); 272526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt CloseHandle(l2->rx_avail); 273526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt CloseHandle(l2->rx_done); 274526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt CloseHandle(l2->rx_notify); 275526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_free(l2); 276526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 277526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 278526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 279526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtvoid l2_packet_deinit(struct l2_packet_data *l2) 280526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 281526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2 == NULL) 282526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return; 283526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 284526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->rx_thread_done = CreateEvent(NULL, TRUE, FALSE, NULL); 285526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 286526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt l2->running = 0; 287526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt pcap_breakloop(l2->pcap); 288526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 289526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt /* 290526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * RX thread may be waiting in l2_packet_receive_cb() for l2->rx_done 291526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * event and this event is set in l2_packet_rx_event(). However, 292526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * l2_packet_deinit() may end up being called from l2->rx_callback(), 293526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * so we need to return from here and complete deinitialization in 294526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * a registered timeout to avoid having to forcefully kill the RX 295526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt * thread. 296526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt */ 297526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt eloop_register_timeout(0, 0, l2_packet_deinit_timeout, l2, NULL); 298526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 299526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 300526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 301526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtint l2_packet_get_ip_addr(struct l2_packet_data *l2, char *buf, size_t len) 302526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 303526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt pcap_if_t *devs, *dev; 304526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt struct pcap_addr *addr; 305526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt struct sockaddr_in *saddr; 306526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt int found = 0; 307526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt char err[PCAP_ERRBUF_SIZE + 1]; 308526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 309526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (pcap_findalldevs(&devs, err) < 0) { 310526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt wpa_printf(MSG_DEBUG, "pcap_findalldevs: %s\n", err); 311526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return -1; 312526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 313526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 314526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt for (dev = devs; dev && !found; dev = dev->next) { 315526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (os_strcmp(dev->name, l2->ifname) != 0) 316526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt continue; 317526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 318526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt addr = dev->addresses; 319526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt while (addr) { 320526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt saddr = (struct sockaddr_in *) addr->addr; 321526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (saddr && saddr->sin_family == AF_INET) { 322526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt os_strlcpy(buf, inet_ntoa(saddr->sin_addr), 323526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt len); 324526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt found = 1; 325526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt break; 326526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 327526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt addr = addr->next; 328526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 329526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt } 330526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 331526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt pcap_freealldevs(devs); 332526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 333526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt return found ? 0 : -1; 334526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 335526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 336526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt 337526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidtvoid l2_packet_notify_auth_start(struct l2_packet_data *l2) 338526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt{ 339526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt if (l2) 340526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt SetEvent(l2->rx_notify); 341526fc2a7dc09b4450086cdec313a5c44d36b10fdDmitry Shmidt} 342