--- /dev/null
+/*
+ * "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 <unistd.h>
+#include <fcntl.h>
+#include <stdlib.h>
+#include <stdio.h>
+#include <string.h>
+#include <syslog.h>
+#include <errno.h>
+
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+#include <linux/if.h>
+#include <linux/if_ether.h>
+
+#include <netinet/in.h>
+#include <lib6lowpan/lib6lowpan.h>
+
+#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);
+}
projects / tinyos-2.x.git / blobdiff