/* * Copyright (c) 2007, Swedish Institute of Computer Science. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. Neither the name of the Institute nor the names of its contributors * may be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * This file is part of the Contiki operating system. * * Author: Oliver Schmidt * */ #define WIN32_LEAN_AND_MEAN #define _WIN32_WINNT 0x0501 #include #include #include #include #include #ifdef __CYGWIN__ #include #else /* __CYGWIN__ */ #include #endif /* __CYGWIN__ */ #define DEBUG 0 #if DEBUG #define PRINTF(...) printf(__VA_ARGS__) #else #define PRINTF(...) #endif #include "contiki-net.h" #include "sys/log.h" #include "net/wpcap.h" /* Handle native-border-router case where the fallback has ethernet headers. * The command line args for native-border-router conflice with the passing * of the interface addresses to connect to, so both must be hard coded. * See comments in wpcap-drv.c */ #ifdef SELECT_CALLBACK #define FALLBACK_HAS_ETHERNET_HEADERS 1 #endif #if NETSTACK_CONF_WITH_IPV6 #include struct in6_addr addr6; char addr6str[64]; /*---------------------------------------------------------------------------*/ uint8_t issame_ip6addr(struct in6_addr addr1, struct in6_addr addr2) { return ((addr1.s6_addr32[0]==addr2.s6_addr32[0]) && (addr1.s6_addr32[1]==addr2.s6_addr32[1]) && (addr1.s6_addr32[2]==addr2.s6_addr32[2]) && (addr1.s6_addr32[3]==addr2.s6_addr32[3]) ); } /*---------------------------------------------------------------------------*/ uint8_t iszero_ip6addr(struct in6_addr addr) { return ((addr.s6_addr32[0]==0) && (addr.s6_addr32[1]==0) && (addr.s6_addr32[2]==0) && (addr.s6_addr32[3]==0) ); } /*---------------------------------------------------------------------------*/ uint8_t sprint_ip6addr(struct in6_addr addr, char * result) { unsigned char i = 0; unsigned char zerocnt = 0; unsigned char numprinted = 0; char * starting = result; *result++='['; while (numprinted < 8) { if ((addr.s6_addr16[i] == 0) && (zerocnt == 0)) { while(addr.s6_addr16[zerocnt + i] == 0) zerocnt++; if (zerocnt == 1) { *result++ = '0'; numprinted++; break; } i += zerocnt; numprinted += zerocnt; } else { result += sprintf(result, "%x", (unsigned int) uip_ntohs(addr.s6_addr16[i])); i++; numprinted++; } if (numprinted != 8) *result++ = ':'; } *result++=']'; *result=0; return (result - starting); } #endif /* NETSTACK_CONF_WITH_IPV6 */ #ifdef __CYGWIN__ __attribute__((dllimport)) extern char **__argv[]; #endif /* __CYGWIN__ */ struct pcap; struct pcap_if { struct pcap_if *next; char *name; char *description; struct pcap_addr { struct pcap_addr *next; struct sockaddr *addr; struct sockaddr *netmask; struct sockaddr *broadaddr; struct sockaddr *dstaddr; } *addresses; DWORD flags; }; struct pcap_pkthdr { struct timeval ts; DWORD caplen; DWORD len; }; HMODULE wpcap; static struct pcap *pcap; /* uip_lladdr is defined in uip.c. It is not used in uip6.c. * If needed for some purpose it can be defined here */ #if NETSTACK_CONF_WITH_IPV6 //struct uip_eth_addr uip_lladdr; #endif static int (* pcap_findalldevs)(struct pcap_if **, char *); static struct pcap *(* pcap_open_live)(char *, int, int, int, char *); static int (* pcap_next_ex)(struct pcap *, struct pcap_pkthdr **, unsigned char **); static int (* pcap_sendpacket)(struct pcap *, unsigned char *, int); #define UIP_IP_BUF ((struct uip_ip_hdr *)&uip_buf[UIP_LLH_LEN]) #define BUF ((struct uip_eth_hdr *)&uip_buf[0]) #define IPBUF ((struct uip_tcpip_hdr *)&uip_buf[UIP_LLH_LEN]) #ifdef UIP_FALLBACK_INTERFACE static struct pcap *pfall; struct in_addr addrfall; #if NETSTACK_CONF_WITH_IPV6 struct in_addr6 addrfall6; #endif /*---------------------------------------------------------------------------*/ static void init(void) { /* Nothing to do here */ } /*---------------------------------------------------------------------------*/ uint8_t wfall_send(const uip_lladdr_t *lladdr); #if FALLBACK_HAS_ETHERNET_HEADERS #undef IPBUF #define IPBUF ((struct uip_tcpip_hdr *)&uip_buf[14]) static uip_ipaddr_t last_sender; #endif static int output(void) { #if FALLBACK_HAS_ETHERNET_HEADERS&&0 if(uip_ipaddr_cmp(&last_sender, &UIP_IP_BUF->srcipaddr)) { /* Do not bounce packets back to fallback if the packet was received from it */ PRINTF("FUT: trapping pingpong"); return; } uip_ipaddr_copy(&last_sender, &UIP_IP_BUF->srcipaddr); #endif PRINTF("FUT: %u\n", uip_len); return wfall_send(0); } const struct uip_fallback_interface rpl_interface = { init, output }; #endif /*---------------------------------------------------------------------------*/ static void error_exit(char *message) { printf("error_exit: %s", message); exit(EXIT_FAILURE); } /*---------------------------------------------------------------------------*/ static void set_ethaddr(struct in_addr addr) { PIP_ADAPTER_ADDRESSES adapters; ULONG size = 0; if(GetAdaptersAddresses(AF_INET, GAA_FLAG_SKIP_ANYCAST | GAA_FLAG_SKIP_MULTICAST | GAA_FLAG_SKIP_DNS_SERVER, NULL, NULL, &size) != ERROR_BUFFER_OVERFLOW) { error_exit("error on access to adapter list size\n"); } adapters = alloca(size); if(GetAdaptersAddresses(AF_INET, GAA_FLAG_SKIP_ANYCAST | GAA_FLAG_SKIP_MULTICAST | GAA_FLAG_SKIP_DNS_SERVER, NULL, adapters, &size) != ERROR_SUCCESS) { error_exit("error on access to adapter list\n"); } while(adapters != NULL) { char buffer[256]; WideCharToMultiByte(CP_ACP, 0, adapters->Description, -1, buffer, sizeof(buffer), NULL, NULL); log_message("set_ethaddr: found adapter: ", buffer); if(adapters->FirstUnicastAddress != NULL && adapters->FirstUnicastAddress->Address.lpSockaddr != NULL && adapters->FirstUnicastAddress->Address.lpSockaddr->sa_family == AF_INET) { struct in_addr adapter_addr; adapter_addr = ((struct sockaddr_in *)adapters->FirstUnicastAddress->Address.lpSockaddr)->sin_addr; log_message("set_ethaddr: with address: ", inet_ntoa(adapter_addr)); if(adapter_addr.s_addr == addr.s_addr) { if(adapters->PhysicalAddressLength != 6) { error_exit("ip addr specified on cmdline does not belong to an ethernet card\n"); } wsprintf(buffer, "%02X-%02X-%02X-%02X-%02X-%02X", adapters->PhysicalAddress[0], adapters->PhysicalAddress[1], adapters->PhysicalAddress[2], adapters->PhysicalAddress[3], adapters->PhysicalAddress[4], adapters->PhysicalAddress[5]); log_message("set_ethaddr: ethernetaddr: ", buffer); #if NETSTACK_CONF_WITH_IPV6 // int i;for (i=0;i<6;i++) uip_lladdr.addr[i] = adapters->PhysicalAddress[i]; #else uip_setethaddr((*(struct uip_eth_addr *)adapters->PhysicalAddress)); #endif break; } } adapters = adapters->Next; } if(adapters == NULL) { error_exit("no adapter found with ip addr specified on cmdline\n"); } } #if NETSTACK_CONF_WITH_IPV6 /*---------------------------------------------------------------------------*/ static void set_ethaddr6(struct in_addr6 addr) { PIP_ADAPTER_ADDRESSES adapters; ULONG size = 0; if(GetAdaptersAddresses(AF_INET6, GAA_FLAG_SKIP_ANYCAST | GAA_FLAG_SKIP_MULTICAST | GAA_FLAG_SKIP_DNS_SERVER, NULL, NULL, &size) != ERROR_BUFFER_OVERFLOW) { error_exit("error on access to adapter list size\n"); } adapters = alloca(size); if(GetAdaptersAddresses(AF_INET6, GAA_FLAG_SKIP_ANYCAST | GAA_FLAG_SKIP_MULTICAST | GAA_FLAG_SKIP_DNS_SERVER, NULL, adapters, &size) != ERROR_SUCCESS) { error_exit("error on access to adapter list\n"); } while(adapters != NULL) { char buffer[256]; WideCharToMultiByte(CP_ACP, 0, adapters->Description, -1, buffer, sizeof(buffer), NULL, NULL); log_message("set_ethaddr: found adapter: ", buffer); if(adapters->FirstUnicastAddress != NULL && adapters->FirstUnicastAddress->Address.lpSockaddr != NULL && adapters->FirstUnicastAddress->Address.lpSockaddr->sa_family == AF_INET6) { struct in_addr6 adapter_addr; adapter_addr = ((struct sockaddr_in6 *)adapters->FirstUnicastAddress->Address.lpSockaddr)->sin6_addr; sprint_ip6addr(adapter_addr, addr6str); log_message("set_ethaddr: with ipv6 address: : ", addr6str); if(issame_ip6addr(adapter_addr,addr6)) { if(adapters->PhysicalAddressLength != 6) { error_exit("ip addr specified on cmdline does not belong to an ethernet card\n"); } wsprintf(buffer, "%02X-%02X-%02X-%02X-%02X-%02X", adapters->PhysicalAddress[0], adapters->PhysicalAddress[1], adapters->PhysicalAddress[2], adapters->PhysicalAddress[3], adapters->PhysicalAddress[4], adapters->PhysicalAddress[5]); log_message("set_ethaddr: ethernetaddr: ", buffer); #if NETSTACK_CONF_WITH_IPV6 // int i;for (i=0;i<6;i++) uip_lladdr.addr[i] = adapters->PhysicalAddress[i]; //does this need doing? #else uip_setethaddr((*(struct uip_eth_addr *)adapters->PhysicalAddress)); #endif break; } } adapters = adapters->Next; } if(adapters == NULL) { error_exit("no adapter found with ip addr specified on cmdline\n"); } } #endif /*---------------------------------------------------------------------------*/ static void init_pcap(struct in_addr addr) { struct pcap_if *interfaces; struct pcap_addr *paddr; char error[256]; if(pcap_findalldevs(&interfaces, error) == -1) { error_exit(error); } while(interfaces != NULL) { log_message("init_pcap: found interface: ", interfaces->description); if(interfaces->addresses != NULL) { for(paddr = interfaces->addresses; paddr != NULL; paddr = paddr->next) { if(paddr->addr != NULL && paddr->addr->sa_family == AF_INET) { struct in_addr interface_addr; interface_addr = ((struct sockaddr_in *)paddr->addr)->sin_addr; log_message("init_pcap: with address: ", inet_ntoa(interface_addr)); if(interface_addr.s_addr == addr.s_addr) { pcap = pcap_open_live(interfaces->name, UIP_BUFSIZE, 0, -1, error); if(pcap == NULL) { error_exit(error); } #ifdef UIP_FALLBACK_INTERFACE log_message("init_pcap: Opened as primary interface",""); #else log_message("init_pcap: Opened as interface",""); #endif // pcap_setdirection(PCAP_D_IN); //Not implemented in windows yet? set_ethaddr(addr); #ifdef UIP_FALLBACK_INTERFACE } if (pfall && pcap) return; if(interface_addr.s_addr == addrfall.s_addr) { pfall = pcap_open_live(interfaces->name, UIP_BUFSIZE, 0, -1, error); if(pfall == NULL) { error_exit(error); } log_message("init_pcap: Opened as fallback interface",""); if (pcap) return; } #else return; } #endif #if NETSTACK_CONF_WITH_IPV6 } else if(paddr->addr != NULL && paddr->addr->sa_family == AF_INET6) { struct in6_addr interface_addr; interface_addr = ((struct sockaddr_in6 *)paddr->addr)->sin6_addr; sprint_ip6addr(interface_addr, addr6str); log_message("init_pcap: with ipv6 address: ", addr6str); if (issame_ip6addr(interface_addr, addr6)) { pcap = pcap_open_live(interfaces->name, UIP_BUFSIZE, 0, -1, error); if(pcap == NULL) { error_exit(error); } #ifdef UIP_FALLBACK_INTERFACE log_message("init_pcap: Opened as primary interface",""); #endif set_ethaddr6(addr6); // pcap_setdirection(PCAP_D_IN); //Not implemented in windows yet? #ifdef UIP_FALLBACK_INTERFACE } if (pfall && pcap) return; //exit when we have both interfaces if (issame_ip6addr(interface_addr, addrfall6)) { pfall = pcap_open_live(interfaces->name, UIP_BUFSIZE, 0, -1, error); if(pfall == NULL) { error_exit(error); } log_message("init_pcap: Opened as fallback interface",""); if (pcap) return; } #else return; } #endif #endif /* NETSTACK_CONF_WITH_IPV6 */ } } } interfaces = interfaces->next; } if(interfaces == NULL) { error_exit("no interface found with specified ip address\n"); } } /*---------------------------------------------------------------------------*/ void wpcap_init(void) { struct in_addr addr; addr.s_addr = INADDR_NONE; //255.255.255.255 #ifdef UIP_FALLBACK_INTERFACE addrfall.s_addr = INADDR_NONE; #endif /* Pick up possible ip addresses from command line */ #ifdef __CYGWIN__ if ((*__argv)[1]) { addr.s_addr = inet_addr((*__argv)[1]); #if NETSTACK_CONF_WITH_IPV6 uiplib_ipaddrconv((*__argv)[1],(uip_ipaddr_t*) &addr6.s6_addr); #endif #ifdef UIP_FALLBACK_INTERFACE if ((*__argv)[2]) { addrfall.s_addr = inet_addr((*__argv)[2]); #if NETSTACK_CONF_WITH_IPV6 uiplib_ipaddrconv((*__argv)[2],(uip_ipaddr_t*) &addrfall6.s6_addr); #endif } #endif } #else /* __CYGWIN__ */ /* VC++ build on win32 platform. Currently the platform has no ipv6 support */ addr.s_addr = inet_addr(__argv[1]); #if NETSTACK_CONF_WITH_IPV6 if((__argv)[1]) uiplib_ipaddrconv((__argv)[1],(uip_ipaddr_t*) &addr6.s6_addr); #endif #ifdef UIP_FALLBACK_INTERFACE addrfall.s_addr = inet_addr(__argv[2]); #if NETSTACK_CONF_WITH_IPV6 if((__argv)[2]) uiplib_ipaddrconv((__argv)[2],(uip_ipaddr_t*) &addrfall6.s6_addr); #endif #endif #endif /* __CYGWIN__ */ #if DEBUG log_message("wpcap_init:Passed ipv4 ", inet_ntoa(addr)); sprint_ip6addr(addr6, addr6str); log_message("wpcap_init:Passed ipv6 ", addr6str); #ifdef UIP_FALLBACK_INTERFACE log_message("wpcap_init:Passed fallback ipv4 ", inet_ntoa(addrfall)); sprint_ip6addr(addrfall6, addr6str); log_message("wpcap_init:Passed fallback ipv6 ", addr6str); #endif #endif /* Use build defaults if not enough addresses passed */ #if NETSTACK_CONF_WITH_IPV6 #ifdef UIP_FALLBACK_INTERFACE if(addrfall.s_addr == INADDR_NONE) { if(iszero_ip6addr(addrfall6)) { #ifdef WPCAP_FALLBACK_ADDRESS addrfall.s_addr = inet_addr(WPCAP_FALLBACK_ADDRESS); // if(addrfall.s_addr == INADDR_NONE) { //use ipv6 if contiki-conf.h override uiplib_ipaddrconv(WPCAP_FALLBACK_ADDRESS,(uip_ipaddr_t*) &addrfall6.s6_addr); // } #else // addrfall.s_addr = inet_addr("10.2.10.10"); uiplib_ipaddrconv("bbbb::1",(uip_ipaddr_t*) &addrfall6.s6_addr); #endif } } #endif if(addr.s_addr == INADDR_NONE) { if(iszero_ip6addr(addr6)) { #ifdef WPCAP_INTERFACE_ADDRESS addr.s_addr = inet_addr(WPCAP_INTERFACE_ADDRESS); // if(addr.s_addr == INADDR_NONE) { uiplib_ipaddrconv(WPCAP_INTERFACE_ADDRESS,(uip_ipaddr_t*) &addr6.s6_addr); // } #else addr.s_addr = inet_addr("10.10.10.10"); //prefer ipv4 default for legacy compatibility // uiplib_ipaddrconv("fd00::1",(uip_ipaddr_t*) &addr6.s6_addr); #endif #ifdef UIP_FALLBACK_INTERFACE log_message("usage: \n",""); if(addr.s_addr != INADDR_NONE) { log_message("-->I'll try interface address ", inet_ntoa(addr)); } else { sprint_ip6addr(addr6, addr6str); log_message("-->I'll try interface address ", addr6str); } if(addrfall.s_addr != INADDR_NONE) { log_message("--> and fallback address ", inet_ntoa(addrfall)); } else { sprint_ip6addr(addrfall6, addr6str); log_message("--> and fallback address ", addr6str); } #else if(addr.s_addr != INADDR_NONE) { log_message("usage: \n-->I'll try guessing ", inet_ntoa(addr)); } else { sprint_ip6addr(addr6, addr6str); log_message("usage: \n-->I'll try guessing ", addr6str); } #endif } } #else /* ip4 build */ if(addr.s_addr == INADDR_NONE) { #ifdef WPCAP_INTERFACE_ADDRESS addr.s_addr = inet_addr(WPCAP_INTERFACE_ADDRESS); #else addr.s_addr = inet_addr("10.10.10.10"); #endif log_message("usage: \n-->I'll try guessing ", inet_ntoa(addr)); } #endif /* NETSTACK_CONF_WITH_IPV6 */ #if DEBUG log_message("wpcap_init:Using ipv4 ", inet_ntoa(addr)); sprint_ip6addr(addr6, addr6str); log_message("wpcap_init:Using ipv6 ", addr6str); #ifdef UIP_FALLBACK_INTERFACE log_message("wpcap_init:Using fallback ipv4 ", inet_ntoa(addrfall)); sprint_ip6addr(addrfall6, addr6str); log_message("wpcap_init:Using fallback ipv6 ", addr6str); #endif #endif // log_message("wpcap_init:cmdline address: ", inet_ntoa(addr)); wpcap = LoadLibrary("wpcap.dll"); pcap_findalldevs = (int (*)(struct pcap_if **, char *)) GetProcAddress(wpcap, "pcap_findalldevs"); pcap_open_live = (struct pcap *(*)(char *, int, int, int, char *)) GetProcAddress(wpcap, "pcap_open_live"); pcap_next_ex = (int (*)(struct pcap *, struct pcap_pkthdr **, unsigned char **)) GetProcAddress(wpcap, "pcap_next_ex"); pcap_sendpacket = (int (*)(struct pcap *, unsigned char *, int)) GetProcAddress(wpcap, "pcap_sendpacket"); if(pcap_findalldevs == NULL || pcap_open_live == NULL || pcap_next_ex == NULL || pcap_sendpacket == NULL) { error_exit("error on access to winpcap library\n"); } init_pcap(addr); } /*---------------------------------------------------------------------------*/ uint16_t wpcap_poll(void) { struct pcap_pkthdr *packet_header; unsigned char *packet; switch(pcap_next_ex(pcap, &packet_header, &packet)) { case -1: error_exit("error on poll\n"); case 0: return 0; } #if NETSTACK_CONF_WITH_IPV6 /* Since pcap_setdirection(PCAP_D_IN) is not implemented in winpcap all outgoing packets * will be echoed back. The stack will ignore any packets not addressed to it, but initial * ipv6 neighbor solicitations are addressed to everyone and the echoed NS sent on startup * would be processed as a conflicting NS race which would cause a stack shutdown. * So discard all packets with our source address (packet starts destaddr, srcaddr, ...) * */ int i; for (i=0;icaplen > UIP_BUFSIZE) { return 0; } // PRINTF("SIN: %lu\n", packet_header->caplen); CopyMemory(uip_buf, packet, packet_header->caplen); return (uint16_t)packet_header->caplen; } #ifdef UIP_FALLBACK_INTERFACE uint16_t wfall_poll(void) { struct pcap_pkthdr *packet_header; unsigned char *packet; switch(pcap_next_ex(pfall, &packet_header, &packet)) { case -1: error_exit("error on fallback poll\n"); case 0: return 0; } #if NETSTACK_CONF_WITH_IPV6 #if FALLBACK_HAS_ETHERNET_HEADERS #define ETHERNET_LLADDR_LEN 6 #else #define ETHERNET_LLADDR_LEN UIP_LLADDR_LEN #endif /* Since pcap_setdirection(PCAP_D_IN) is not implemented in winpcap all outgoing packets * will be echoed back. The stack will ignore any packets not addressed to it, but initial * ipv6 neighbor solicitations are addressed to everyone and the echoed NS sent on startup * would be processed as a conflicting NS race which would cause a stack shutdown. * So discard all packets with our source address (packet starts destaddr, srcaddr, ...) * */ int i; for (i=0;icaplen > UIP_BUFSIZE) { return 0; } PRINTF("FIN: %lu\n", packet_header->caplen); CopyMemory(uip_buf, packet, packet_header->caplen); return (uint16_t)packet_header->caplen; } #endif /*---------------------------------------------------------------------------*/ #if NETSTACK_CONF_WITH_IPV6 uint8_t wpcap_send(const uip_lladdr_t *lladdr) { if(lladdr == NULL) { /* the dest must be multicast*/ (&BUF->dest)->addr[0] = 0x33; (&BUF->dest)->addr[1] = 0x33; (&BUF->dest)->addr[2] = IPBUF->destipaddr.u8[12]; (&BUF->dest)->addr[3] = IPBUF->destipaddr.u8[13]; (&BUF->dest)->addr[4] = IPBUF->destipaddr.u8[14]; (&BUF->dest)->addr[5] = IPBUF->destipaddr.u8[15]; } else { //when fallback used this gets ptr to lladdr of all zeroes on forwarded packets, turn them into multicast(?) if ((lladdr->addr[0]==0)&&(lladdr->addr[1]==0)&&(lladdr->addr[2]==0)&&(lladdr->addr[3]==0)&&(lladdr->addr[4]==0)&&(lladdr->addr[5]==0)) { (&BUF->dest)->addr[0] = 0x33; (&BUF->dest)->addr[1] = 0x33; (&BUF->dest)->addr[2] = IPBUF->destipaddr.u8[12]; (&BUF->dest)->addr[3] = IPBUF->destipaddr.u8[13]; (&BUF->dest)->addr[4] = IPBUF->destipaddr.u8[14]; (&BUF->dest)->addr[5] = IPBUF->destipaddr.u8[15]; } else { memcpy(&BUF->dest, lladdr, UIP_LLADDR_LEN); } } memcpy(&BUF->src, &uip_lladdr, UIP_LLADDR_LEN); PRINTF("SUT: %u\n", uip_len); PRINTF("Src= %02x %02x %02x %02x %02x %02x",(&BUF->src)->addr[0],(&BUF->src)->addr[1],(&BUF->src)->addr[2],(&BUF->src)->addr[3],(&BUF->src)->addr[4],(&BUF->src)->addr[5]); PRINTF(" Dst= %02x %02x %02x %02x %02x %02x",(&BUF->dest)->addr[0],(&BUF->dest)->addr[1],(&BUF->dest)->addr[2],(&BUF->dest)->addr[3],(&BUF->dest)->addr[4],(&BUF->dest)->addr[5]); PRINTF(" Type=%04x\n",BUF->type); BUF->type = UIP_HTONS(UIP_ETHTYPE_IPV6); uip_len += sizeof(struct uip_eth_hdr); if(pcap_sendpacket(pcap, uip_buf, uip_len) == -1) { error_exit("error on send\n"); } return 0; } #ifdef UIP_FALLBACK_INTERFACE uint8_t wfall_send(const uip_lladdr_t *lladdr) { #if FALLBACK_HAS_ETHERNET_HEADERS //make room for ethernet header //{int i;printf("\n");for (i=0;i=0;--i) *(char *)(uip_buf+i+14) = *(char *)(uip_buf+i);} //{int i;printf("\n");for (i=0;idest)->addr[0] = 0x33; (&BUF->dest)->addr[1] = 0x33; (&BUF->dest)->addr[2] = IPBUF->destipaddr.u8[12]; (&BUF->dest)->addr[3] = IPBUF->destipaddr.u8[13]; (&BUF->dest)->addr[4] = IPBUF->destipaddr.u8[14]; (&BUF->dest)->addr[5] = IPBUF->destipaddr.u8[15]; } else { memcpy(&BUF->dest, lladdr, UIP_LLADDR_LEN); } memcpy(&BUF->src, &uip_lladdr, UIP_LLADDR_LEN); PRINTF("FUT: %u\n", uip_len); PRINTF("Srcf= %02x %02x %02x %02x %02x %02x",(&BUF->src)->addr[0],(&BUF->src)->addr[1],(&BUF->src)->addr[2],(&BUF->src)->addr[3],(&BUF->src)->addr[4],(&BUF->src)->addr[5]); PRINTF(" Dstf= %02x %02x %02x %02x %02x %02x",(&BUF->dest)->addr[0],(&BUF->dest)->addr[1],(&BUF->dest)->addr[2],(&BUF->dest)->addr[3],(&BUF->dest)->addr[4],(&BUF->dest)->addr[5]); PRINTF(" Typef=%04x\n",BUF->type); BUF->type = UIP_HTONS(UIP_ETHTYPE_IPV6); uip_len += sizeof(struct uip_eth_hdr); if(pcap_sendpacket(pfall, uip_buf, uip_len) == -1) { error_exit("error on fallback send\n"); } return 0; } #endif #else /* NETSTACK_CONF_WITH_IPV6 */ void wpcap_send(void) { /* if(rand() % 1000 > 900) { printf("Drop\n"); return; } else { printf("Send\n"); }*/ if(pcap_sendpacket(pcap, uip_buf, uip_len) == -1) { error_exit("error on send\n"); } } #endif /* NETSTACK_CONF_WITH_IPV6 */ /*---------------------------------------------------------------------------*/ void wpcap_exit(void) { FreeLibrary(wpcap); } /*---------------------------------------------------------------------------*/