From 632a3585f5956692aa8f5013917c56894ed620b7 Mon Sep 17 00:00:00 2001 From: julienabeille Date: Tue, 14 Oct 2008 09:47:15 +0000 Subject: [PATCH] Modification to tapdev for IPv6 support --- cpu/native/net/tapdev6.c | 233 +++++++++++++++++++++++++++++++++++++++ cpu/native/net/tapdev6.h | 47 ++++++++ 2 files changed, 280 insertions(+) create mode 100644 cpu/native/net/tapdev6.c create mode 100644 cpu/native/net/tapdev6.h diff --git a/cpu/native/net/tapdev6.c b/cpu/native/net/tapdev6.c new file mode 100644 index 000000000..c922472d8 --- /dev/null +++ b/cpu/native/net/tapdev6.c @@ -0,0 +1,233 @@ +/* + * 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.1 2008/10/14 09:47:15 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) +{ +} +/*---------------------------------------------------------------------------*/ diff --git a/cpu/native/net/tapdev6.h b/cpu/native/net/tapdev6.h new file mode 100644 index 000000000..2b93cbe06 --- /dev/null +++ b/cpu/native/net/tapdev6.h @@ -0,0 +1,47 @@ +/* + * Copyright (c) 2003, Adam Dunkels. + * 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. All advertising materials mentioning features or use of this software + * must display the following acknowledgement: + * This product includes software developed by Adam Dunkels. + * 4. The name of the author may not be used to endorse or promote + * products derived from this software without specific prior + * written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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 uIP TCP/IP stack. + * + * $Id: tapdev6.h,v 1.1 2008/10/14 09:47:15 julienabeille Exp $ + * + */ +#ifndef __TAPDEV_H__ +#define __TAPDEV_H__ + +#include "contiki-net.h" + +void tapdev_init(void); +u8_t tapdev_send(uip_lladdr_t *lladdr); +u16_t tapdev_poll(void); +void tapdev_do_send(void); +void tapdev_exit(void); //math +#endif /* __TAPDEV_H__ */