/* * Copyright (c) 2001, 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. * * Author: Adam Dunkels * * $Id: tapdev6.c,v 1.3 2008/10/14 16:50:11 julienabeille Exp $ */ #include #include #include #include #include #include #include #include #include #include #include #ifdef linux #include #include #include #define DEVTAP "/dev/net/tun" #else /* linux */ #define DEVTAP "/dev/tap0" #endif /* linux */ #include "tapdev6.h" #include "contiki-net.h" #define DROP 0 #if DROP static int drop = 0; #endif static int fd; static unsigned long lasttime; #define BUF ((struct uip_eth_hdr *)&uip_buf[0]) #define IPBUF ((struct uip_tcpip_hdr *)&uip_buf[UIP_LLH_LEN]) #define DEBUG 0 #if DEBUG #define PRINTF(...) printf(__VA_ARGS__) #define PRINT6ADDR(addr) PRINTF("%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x", ((u8_t *)addr)[0], ((u8_t *)addr)[1], ((u8_t *)addr)[2], ((u8_t *)addr)[3], ((u8_t *)addr)[4], ((u8_t *)addr)[5], ((u8_t *)addr)[6], ((u8_t *)addr)[7], ((u8_t *)addr)[8], ((u8_t *)addr)[9], ((u8_t *)addr)[10], ((u8_t *)addr)[11], ((u8_t *)addr)[12], ((u8_t *)addr)[13], ((u8_t *)addr)[14], ((u8_t *)addr)[15]) #else #define PRINTF(...) #define PRINT6ADDR(addr) #endif static void do_send(void); u8_t tapdev_send(uip_lladdr_t *lladdr); u16_t tapdev_poll(void) { fd_set fdset; struct timeval tv; int ret; tv.tv_sec = 0; tv.tv_usec = 0; FD_ZERO(&fdset); if(fd > 0) { FD_SET(fd, &fdset); } ret = select(fd + 1, &fdset, NULL, NULL, &tv); if(ret == 0) { return 0; } ret = read(fd, uip_buf, UIP_BUFSIZE); PRINTF("tapdev6: read %d bytes (max %d)\n", ret, UIP_BUFSIZE); if(ret == -1) { perror("tapdev_poll: read"); } return ret; } /*---------------------------------------------------------------------------*/ void tapdev_init(void) { char buf[1024]; fd = open(DEVTAP, O_RDWR); if(fd == -1) { perror("tapdev: tapdev_init: open"); return; } #ifdef linux { struct ifreq ifr; memset(&ifr, 0, sizeof(ifr)); ifr.ifr_flags = IFF_TAP|IFF_NO_PI; if (ioctl(fd, TUNSETIFF, (void *) &ifr) < 0) { perror(buf); exit(1); } } #endif /* Linux */ /* Linux (ubuntu) snprintf(buf, sizeof(buf), "ip link set tap0 up"); system(buf); PRINTF("%s\n", buf); snprintf(buf, sizeof(buf), "ip -6 address add fc00::231/7 dev tap0"); system(buf); PRINTF("%s\n", buf); snprintf(buf, sizeof(buf), "ip -6 route add fc00::0/7 dev tap0"); system(buf); PRINTF("%s\n", buf); */ /* freebsd */ snprintf(buf, sizeof(buf), "ifconfig tap0 up"); system(buf); printf("%s\n", buf); /* */ lasttime = 0; /* gdk_input_add(fd, GDK_INPUT_READ, read_callback, NULL);*/ } /*---------------------------------------------------------------------------*/ static void do_send(void) { int ret; if(fd <= 0) { return; } PRINTF("tapdev_send: sending %d bytes\n", uip_len); /* check_checksum(uip_buf, size);*/ #if DROP drop++; if(drop % 8 == 7) { PRINTF("Dropped an output packet!\n"); return; } #endif /* DROP */ ret = write(fd, uip_buf, uip_len); if(ret == -1) { perror("tap_dev: tapdev_send: writev"); exit(1); } } /*---------------------------------------------------------------------------*/ u8_t tapdev_send(uip_lladdr_t *lladdr) { /* * If L3 dest is multicast, build L2 multicast address * as per RFC 2464 section 7 * else fill with th eaddrsess in argument */ 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 { memcpy(&BUF->dest, lladdr, UIP_LLADDR_LEN); } memcpy(&BUF->src, &uip_lladdr, UIP_LLADDR_LEN); BUF->type = HTONS(UIP_ETHTYPE_IPV6); //math tmp uip_len += sizeof(struct uip_eth_hdr); do_send(); return 0; } /*---------------------------------------------------------------------------*/ void tapdev_do_send(void) { do_send(); } /*---------------------------------------------------------------------------*/ // math added function void tapdev_exit(void) { } /*---------------------------------------------------------------------------*/