Add RPL nodes and border router to minimal-net platform (cygwin only)
This commit is contained in:
David Kopf
parent
6749281a87
commit
c48b7ab78d
10 changed files with 843 additions and 78 deletions
|
|
@ -30,7 +30,6 @@
|
|||
*
|
||||
* Author: Oliver Schmidt <ol.sc@web.de>
|
||||
*
|
||||
* $Id: wpcap.c,v 1.20 2010/10/19 20:30:47 oliverschmidt Exp $
|
||||
*/
|
||||
|
||||
#define WIN32_LEAN_AND_MEAN
|
||||
|
|
@ -41,6 +40,7 @@
|
|||
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
|
||||
#ifdef __CYGWIN__
|
||||
#include <alloca.h>
|
||||
#else /* __CYGWIN__ */
|
||||
|
|
@ -59,6 +59,63 @@
|
|||
|
||||
#include "net/wpcap.h"
|
||||
|
||||
#if UIP_CONF_IPV6
|
||||
#include <ws2tcpip.h>
|
||||
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 /* UIP_CONF_IPV6 */
|
||||
|
||||
|
||||
#ifdef __CYGWIN__
|
||||
__attribute__((dllimport)) extern char **__argv[];
|
||||
#endif /* __CYGWIN__ */
|
||||
|
|
@ -101,6 +158,45 @@ 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);
|
||||
|
||||
#ifdef UIP_FALLBACK_INTERFACE
|
||||
static struct pcap *pfall;
|
||||
struct in_addr addrfall;
|
||||
#if UIP_CONF_IPV6
|
||||
struct in_addr6 addrfall6;
|
||||
#endif
|
||||
|
||||
/*---------------------------------------------------------------------------*/
|
||||
static void
|
||||
init(void)
|
||||
{
|
||||
/* Nothing to do here */
|
||||
}
|
||||
/*---------------------------------------------------------------------------*/
|
||||
u8_t wfall_send(uip_lladdr_t *lladdr);
|
||||
#define UIP_IP_BUF ((struct uip_ip_hdr *)&uip_buf[UIP_LLH_LEN])
|
||||
static void
|
||||
output(void)
|
||||
{
|
||||
#if 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("fallback: Destination off-link but no route src=");
|
||||
PRINT6ADDR(&UIP_IP_BUF->srcipaddr);
|
||||
PRINTF(" dst=");
|
||||
PRINT6ADDR(&UIP_IP_BUF->destipaddr);
|
||||
PRINTF("\n");
|
||||
} else {
|
||||
#endif
|
||||
PRINTF("FUT: %u\n", uip_len);
|
||||
wfall_send(0);
|
||||
}
|
||||
|
||||
const struct uip_fallback_interface rpl_interface = {
|
||||
init, output
|
||||
};
|
||||
|
||||
#endif
|
||||
|
||||
#define BUF ((struct uip_eth_hdr *)&uip_buf[0])
|
||||
#define IPBUF ((struct uip_tcpip_hdr *)&uip_buf[UIP_LLH_LEN])
|
||||
|
||||
|
|
@ -113,49 +209,6 @@ error_exit(char *message)
|
|||
}
|
||||
/*---------------------------------------------------------------------------*/
|
||||
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);
|
||||
}
|
||||
// pcap_setdirection(PCAP_D_IN); //Not implemented in windows yet?
|
||||
return;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
interfaces = interfaces->next;
|
||||
}
|
||||
|
||||
if(interfaces == NULL) {
|
||||
error_exit("no interface found with specified ip address\n");
|
||||
}
|
||||
}
|
||||
/*---------------------------------------------------------------------------*/
|
||||
static void
|
||||
set_ethaddr(struct in_addr addr)
|
||||
{
|
||||
PIP_ADAPTER_ADDRESSES adapters;
|
||||
|
|
@ -214,25 +267,301 @@ set_ethaddr(struct in_addr addr)
|
|||
error_exit("no adapter found with ip addr specified on cmdline\n");
|
||||
}
|
||||
}
|
||||
|
||||
#if UIP_CONF_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 UIP_CONF_IPV6
|
||||
// int i;for (i=0;i<6;i++) uip_ethaddr.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","");
|
||||
#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 UIP_CONF_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 /* UIP_CONF_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__
|
||||
addr.s_addr = inet_addr((*__argv)[1]);
|
||||
#else /* __CYGWIN__ */
|
||||
addr.s_addr = inet_addr(__argv[1]);
|
||||
#endif /* __CYGWIN__ */
|
||||
if(addr.s_addr == INADDR_NONE) {
|
||||
// error_exit("usage: <program> <ip addr of ethernet card to share>\n");
|
||||
addr.s_addr = inet_addr("10.10.10.10");
|
||||
log_message("usage: <program> <ip addr of ethernet card to share>\n-->I'll try guessing ", inet_ntoa(addr));
|
||||
} else {
|
||||
log_message("wpcap_init:cmdline address: ", inet_ntoa(addr));
|
||||
if ((*__argv)[1]) {
|
||||
addr.s_addr = inet_addr((*__argv)[1]);
|
||||
#if UIP_CONF_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 UIP_CONF_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 UIP_CONF_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 UIP_CONF_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 UIP_CONF_IPV6
|
||||
|
||||
#ifdef UIP_FALLBACK_INTERFACE
|
||||
if(addrfall.s_addr == INADDR_NONE) {
|
||||
if(iszero_ip6addr(addrfall6)) {
|
||||
#ifdef WPCAP_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("aaaa::1",(uip_ipaddr_t*) &addr6.s6_addr);
|
||||
#endif
|
||||
|
||||
#ifdef UIP_FALLBACK_INTERFACE
|
||||
log_message("usage: <program> <ip addr of interface> <ip addr of fallback>\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: <program> <ip addr of ethernet card to share>\n-->I'll try guessing ", inet_ntoa(addr));
|
||||
} else {
|
||||
sprint_ip6addr(addr6, addr6str);
|
||||
log_message("usage: <program> <ip addr of ethernet card to share>\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: <program> <ip addr of ethernet card to share>\n-->I'll try guessing ", inet_ntoa(addr));
|
||||
}
|
||||
#endif /* UIP_CONF_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");
|
||||
|
|
@ -248,8 +577,7 @@ wpcap_init(void)
|
|||
error_exit("error on access to winpcap library\n");
|
||||
}
|
||||
|
||||
init_pcap(addr);
|
||||
set_ethaddr(addr);
|
||||
init_pcap(addr);
|
||||
|
||||
}
|
||||
|
||||
|
|
@ -268,6 +596,44 @@ wpcap_poll(void)
|
|||
}
|
||||
|
||||
#if UIP_CONF_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;i<UIP_LLADDR_LEN;i++) if (*(packet+UIP_LLADDR_LEN+i)!=uip_lladdr.addr[i]) break;
|
||||
if (i==UIP_LLADDR_LEN) {
|
||||
PRINTF("SIN: Discarding echoed packet\n");
|
||||
return 0;
|
||||
}
|
||||
#endif /* UIP_CONF_IPV6 */
|
||||
|
||||
if(packet_header->caplen > UIP_BUFSIZE) {
|
||||
return 0;
|
||||
}
|
||||
// PRINTF("SIN: %lu\n", packet_header->caplen);
|
||||
CopyMemory(uip_buf, packet, packet_header->caplen);
|
||||
return (u16_t)packet_header->caplen;
|
||||
|
||||
}
|
||||
|
||||
#ifdef UIP_FALLBACK_INTERFACE
|
||||
u16_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 UIP_CONF_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
|
||||
|
|
@ -286,16 +652,46 @@ wpcap_poll(void)
|
|||
if(packet_header->caplen > UIP_BUFSIZE) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
PRINTF("FIN: %lu\n", packet_header->caplen);
|
||||
CopyMemory(uip_buf, packet, packet_header->caplen);
|
||||
return (u16_t)packet_header->caplen;
|
||||
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
/*---------------------------------------------------------------------------*/
|
||||
#if UIP_CONF_IPV6
|
||||
u8_t
|
||||
wpcap_send(uip_lladdr_t *lladdr)
|
||||
{
|
||||
// if(lladdr == NULL) { //when fallback used this gets ptr to lladdr of all zeroes on forwarded packets
|
||||
if(1) {
|
||||
/* 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 {
|
||||
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
|
||||
u8_t
|
||||
wfall_send(uip_lladdr_t *lladdr)
|
||||
{
|
||||
if(lladdr == NULL) {
|
||||
/* the dest must be multicast*/
|
||||
|
|
@ -309,17 +705,18 @@ wpcap_send(uip_lladdr_t *lladdr)
|
|||
memcpy(&BUF->dest, lladdr, UIP_LLADDR_LEN);
|
||||
}
|
||||
memcpy(&BUF->src, &uip_lladdr, UIP_LLADDR_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);
|
||||
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(pcap, uip_buf, uip_len) == -1) {
|
||||
error_exit("error on send\n");
|
||||
if(pcap_sendpacket(pfall, uip_buf, uip_len) == -1) {
|
||||
error_exit("error on fallback send\n");
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
#else /* UIP_CONF_IPV6 */
|
||||
void
|
||||
wpcap_send(void)
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue