X-Git-Url: https://oss.titaniummirror.com/gitweb/?a=blobdiff_plain;f=support%2Fsdk%2Fc%2Fblip%2Fdriver%2Ftun_dev.c;fp=support%2Fsdk%2Fc%2Fblip%2Fdriver%2Ftun_dev.c;h=ef05d9cef50412b047b7736bb4f408acd0dc5139;hb=e9bfab607e051bae6afb47b44892ce37541d1b44;hp=0000000000000000000000000000000000000000;hpb=adf1de6c009d13b7b52e68535c63b28f59c97400;p=tinyos-2.x.git diff --git a/support/sdk/c/blip/driver/tun_dev.c b/support/sdk/c/blip/driver/tun_dev.c new file mode 100644 index 00000000..ef05d9ce --- /dev/null +++ b/support/sdk/c/blip/driver/tun_dev.c @@ -0,0 +1,212 @@ +/* + * "Copyright (c) 2008 The Regents of the University of California. + * All rights reserved." + * + * Permission to use, copy, modify, and distribute this software and its + * documentation for any purpose, without fee, and without written agreement is + * hereby granted, provided that the above copyright notice, the following + * two paragraphs and the author appear in all copies of this software. + * + * IN NO EVENT SHALL THE UNIVERSITY OF CALIFORNIA BE LIABLE TO ANY PARTY FOR + * DIRECT, INDIRECT, SPECIAL, INCIDENTAL, OR CONSEQUENTIAL DAMAGES ARISING OUT + * OF THE USE OF THIS SOFTWARE AND ITS DOCUMENTATION, EVEN IF THE UNIVERSITY OF + * CALIFORNIA HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. + * + * THE UNIVERSITY OF CALIFORNIA SPECIFICALLY DISCLAIMS ANY WARRANTIES, + * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY + * AND FITNESS FOR A PARTICULAR PURPOSE. THE SOFTWARE PROVIDED HEREUNDER IS + * ON AN "AS IS" BASIS, AND THE UNIVERSITY OF CALIFORNIA HAS NO OBLIGATION TO + * PROVIDE MAINTENANCE, SUPPORT, UPDATES, ENHANCEMENTS, OR MODIFICATIONS." + * + */ +/* + * Copyright (c) 2007 Matus Harvan + * All rights reserved + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are + * met: + * + * * Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * * 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. + * * 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 COPYRIGHT HOLDERS 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 COPYRIGHT + * OWNER 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. + */ + +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include + +#include +#include + +#include "tun_dev.h" +#include "logging.h" + + +/* + * This is in linux/include/net/ipv6.h. + * Thanks, net-tools! + */ +struct in6_ifreq { + struct in6_addr ifr6_addr; + __u32 ifr6_prefixlen; + unsigned int ifr6_ifindex; +}; + + +int tun_open(char *dev) +{ + struct ifreq ifr; + int fd; + + if ((fd = open("/dev/net/tun", O_RDWR | O_NONBLOCK)) < 0) + return -1; + + memset(&ifr, 0, sizeof(ifr)); + /* By default packets are tagged as IPv4. To tag them as IPv6, + * they need to be prefixed by struct tun_pi. + */ + //ifr.ifr_flags = IFF_TUN | IFF_NO_PI; + ifr.ifr_flags = IFF_TUN; + if (*dev) + strncpy(ifr.ifr_name, dev, IFNAMSIZ); + + if (ioctl(fd, TUNSETIFF, (void *) &ifr) < 0) + goto failed; + + strcpy(dev, ifr.ifr_name); + return fd; + + failed: + log_fatal_perror("tun_open"); + close(fd); + return -1; +} + +int tun_setup(char *dev, struct in6_addr *addr) { + struct in6_ifreq ifr6; + struct ifreq ifr; + int fd; + + if ((fd = socket(PF_INET6, SOCK_DGRAM, 0)) < 0) + return -1; + + memset(&ifr, 0, sizeof(struct ifreq)); + strncpy(ifr.ifr_name, dev, IFNAMSIZ); + + /* set the interface up */ + if (ioctl(fd, SIOCGIFFLAGS, &ifr) < 0) { + log_fatal_perror("SIOCGIFFLAGS"); + return -1; + } + ifr.ifr_flags |= IFF_UP; + if (ioctl(fd, SIOCSIFFLAGS, &ifr) < 0) { + log_fatal_perror("SIOCSIFFLAGS"); + return -1; + } + + /* MTU */ + ifr.ifr_mtu = 1280; + if (ioctl(fd, SIOCSIFMTU, &ifr) < 0) { + log_fatal_perror("SIOCSIFMTU"); + return -1; + } + + /* Global address */ + memset(&ifr6, 0, sizeof(struct in6_ifreq)); + memcpy(&ifr6.ifr6_addr, addr, 16); + if (ioctl(fd, SIOGIFINDEX, &ifr) < 0) { + log_fatal_perror("SIOGIFINDEX"); + return -1; + } + + ifr6.ifr6_ifindex = ifr.ifr_ifindex; + ifr6.ifr6_prefixlen = 128; + if (ioctl(fd, SIOCSIFADDR, &ifr6) < 0) { + log_fatal_perror("SIOCSIFADDR (global)"); + return -1; + } + + memset(&ifr6.ifr6_addr.s6_addr[0], 0, 16); + ifr6.ifr6_addr.s6_addr16[0] = htons(0xfe80); + ifr6.ifr6_addr.s6_addr16[7] = addr->s6_addr16[7]; + + if (ioctl(fd, SIOCSIFADDR, &ifr6) < 0) { + log_fatal_perror("SIOCSIFADDR (local)"); + return -1; + } + + close(fd); + + return 0; +} + +int tun_close(int fd, char *dev) +{ + return close(fd); +} + +/* Read/write frames from TUN device */ +int tun_write(int fd, struct split_ip_msg *msg) +{ + uint8_t buf[INET_MTU + sizeof(struct tun_pi)], *packet; + struct tun_pi *pi = (struct tun_pi *)buf; + struct generic_header *cur; + packet = (uint8_t *)(pi + 1); + + + if (ntohs(msg->hdr.plen) + sizeof(struct ip6_hdr) >= INET_MTU) + return 1; + + pi->flags = 0; + pi->proto = htons(ETH_P_IPV6); + + memcpy(packet, &msg->hdr, sizeof(struct ip6_hdr)); + packet += sizeof(struct ip6_hdr); + + cur = msg->headers; + while (cur != NULL) { + memcpy(packet, cur->hdr.data, cur->len); + packet += cur->len; + cur = cur->next; + } + + memcpy(packet, msg->data, msg->data_len); + + return write(fd, buf, sizeof(struct tun_pi) + sizeof(struct ip6_hdr) + ntohs(msg->hdr.plen)); +} + +int tun_read(int fd, char *buf, int len) +{ + int out; + out = read(fd, buf, sizeof(struct tun_pi) + len); + + return out - sizeof(struct tun_pi); +}