Created
September 5, 2012 03:16
-
-
Save vi/3629756 to your computer and use it in GitHub Desktop.
Create tun/tap device that just copies all packets to/from the given ethernet interface.
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Primary use case: workaround non-working "ip link set wlan0 netns ..." for some network drivers. | |
Secondary use case: simple demo for getting/setting the MAC address, tun/tap, raw sockets... | |
Pre-built version: http://vi-server.org/pub/tap_copy |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
/* tap_copy - multiplex packets between a tap device and a ethernet interface | |
Permission is hereby granted, free of charge, to any person obtaining a | |
copy of this software and associated documentation files (the "Software"), | |
to deal in the Software without restriction, including without limitation | |
the rights to use, copy, modify, merge, publish, distribute, sublicense, | |
and/or sell copies of the Software, and to permit persons to whom the | |
Software is furnished to do so, subject to the following conditions: | |
The above copyright notice and this permission notice shall be included in | |
all copies or substantial portions of the Software. | |
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | |
HANS ROSENFELD BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER | |
IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | |
CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. | |
Except as contained in this notice, the name of Hans Rosenfeld shall not | |
be used in advertising or otherwise to promote the sale, use or other dealings | |
in this Software without prior written authorization from Hans Rosenfeld. | |
(This Copyright notice / Disclaimer was copied from SIMH (c) Robert M Supnik) | |
*/ | |
#include <sys/types.h> | |
#include <sys/time.h> | |
#include <sys/stat.h> | |
#include <sys/socket.h> | |
#include <fcntl.h> | |
#include <unistd.h> | |
#include <stdlib.h> | |
#include <string.h> | |
#include <sys/socket.h> | |
#include <netpacket/packet.h> | |
#include <net/ethernet.h> /* the L2 protocols */ | |
#ifndef __NetBSD__ | |
#include <linux/if.h> | |
#include <linux/if_tun.h> | |
#endif | |
#include <netinet/in.h> | |
#include <arpa/inet.h> | |
#include <sys/ioctl.h> | |
#include <netdb.h> | |
#include <stdio.h> | |
#include <errno.h> | |
void printpacket(const char* msg, const unsigned char* p, size_t len) { | |
int i; | |
printf("%s len=%d ", msg, len); | |
for(i=0; i<len; ++i) { | |
printf("%02x", p[i]); | |
} | |
printf("\n"); | |
} | |
int parseMac(char* mac, u_int8_t addr[]) | |
{ | |
int i; | |
for (i = 0; i < 6; i++) { | |
long b = strtol(mac+(3*i), (char **) NULL, 16); | |
addr[i] = (char)b; | |
} | |
return 0; | |
} | |
void init_MAC_addr(int pf, char *interface, char *addr, int *card_index) | |
{ | |
struct ifreq card; | |
strcpy(card.ifr_name, interface); | |
if(!getenv("SOURCE_MAC_ADDRESS")) { | |
if (ioctl(pf, SIOCGIFHWADDR, &card) == -1) { | |
fprintf(stderr, "Could not get MAC address for %s\n", card.ifr_name); | |
perror("ioctl SIOCGIFHWADDR"); | |
exit(1); | |
} | |
memcpy(addr, card.ifr_hwaddr.sa_data, 6); | |
} else { | |
parseMac(getenv("SOURCE_MAC_ADDRESS"), (unsigned char*)addr); | |
} | |
if (ioctl(pf, SIOCGIFINDEX, &card) == -1) { | |
fprintf(stderr, "Could not find device index number for %s\n", card.ifr_name); | |
perror("ioctl SIOCGIFINDEX"); | |
exit(1); | |
} | |
*card_index = card.ifr_ifindex; | |
} | |
int main(int argc, char **argv) | |
{ | |
int dev,cnt,sock; | |
unsigned char buf_frame[1536+sizeof(struct ether_header)]; | |
unsigned char *buf = buf_frame+sizeof(struct ether_header); | |
struct ether_header *header = (struct ether_header*) buf_frame; | |
#ifndef __NetBSD__ | |
struct ifreq ifr; | |
#endif | |
int debug=0; | |
char* tun_device = "/dev/net/tun"; | |
char* dev_name="tun%d"; | |
if(getenv("TUN_DEVICE")) { tun_device = getenv("TUN_DEVICE"); } | |
if(getenv("DEV_NAME")) { dev_name = getenv("DEV_NAME"); } | |
if(getenv("DEBUG")) { debug = atoi(getenv("DEBUG")); } | |
if(argc<=1) { | |
fprintf(stderr, | |
"Usage: tap_copy interface\n" | |
"Example: tap_copy eth0\n" | |
" Environment variables:\n" | |
" TUN_DEVICE /dev/net/tun\n" | |
" DEV_NAME name of the device, default tun%%d\n" | |
" SOURCE_MAC_ADDRESS -- by default use interface's one\n" | |
" DEBUG=0,1,2 print send and recv packets\n" | |
" \n" | |
); | |
exit(1); | |
} | |
char* interface = argv[1]; | |
if((dev = open(tun_device, O_RDWR)) < 0) { | |
fprintf(stderr,"open(%s) failed: %s\n", tun_device, strerror(errno)); | |
exit(2); | |
} | |
if((sock = socket(AF_PACKET, SOCK_RAW, htons(ETH_P_ALL)))==-1) { | |
perror("socket() failed"); | |
exit(4); | |
} | |
char source_mac[6]; | |
int card_index; | |
struct sockaddr_ll device; | |
memset(&device, 0, sizeof(device)); | |
init_MAC_addr(sock, interface, source_mac, &card_index); | |
device.sll_ifindex=card_index; | |
device.sll_family = AF_PACKET; | |
memcpy(device.sll_addr, source_mac, 6); | |
device.sll_halen = htons(6); | |
#ifndef __NetBSD__ | |
memset(&ifr, 0, sizeof(ifr)); | |
ifr.ifr_flags = IFF_TAP | IFF_NO_PI; | |
strncpy(ifr.ifr_name, dev_name, IFNAMSIZ); | |
if(ioctl(dev, TUNSETIFF, (void*) &ifr) < 0) { | |
perror("ioctl(TUNSETIFF) failed"); | |
exit(3); | |
} | |
{ | |
int sock2; | |
struct ifreq ifr_tun; | |
strncpy(ifr_tun.ifr_name, ifr.ifr_name, IFNAMSIZ); | |
if((sock2 = socket(AF_PACKET, SOCK_RAW, htons(ETH_P_ALL)))==-1) { | |
perror("socket() failed"); | |
exit(4); | |
} | |
if (ioctl(sock2, SIOCGIFFLAGS, &ifr_tun) < 0) { perror("ioctl SIOCGIFFLAGS"); } | |
ifr_tun.ifr_mtu=1408; | |
if (ioctl(sock2, SIOCSIFMTU, (void*) &ifr_tun) < 0) { | |
perror("ioctl(SIOCSIFMTU) failed"); | |
} | |
#ifndef ARPHRD_ETHER | |
#define ARPHRD_ETHER 1 | |
#endif | |
ifr_tun.ifr_hwaddr.sa_family = ARPHRD_ETHER; | |
memcpy(ifr_tun.ifr_hwaddr.sa_data, source_mac, 6); | |
if (ioctl(sock2, SIOCSIFHWADDR, &ifr_tun) == -1) { | |
perror("ioctl(SIOCSIFHWADDR) failed"); | |
} | |
close(sock2); | |
} | |
#endif | |
if(fork()) | |
while(1) { | |
cnt=read(dev,(void*)buf_frame,1518); | |
if(debug==2) printpacket("sent", buf_frame, cnt); | |
sendto(sock, buf_frame, cnt,0,(struct sockaddr *)&device, sizeof device); | |
if(debug==1) write(1, ">", 1); | |
} | |
else | |
while(1) { | |
size_t size = sizeof device; | |
cnt=recvfrom(sock,buf_frame,1536,0,(struct sockaddr *)&device,&size); | |
if(cnt<0) { | |
continue; | |
} | |
if(device.sll_ifindex != card_index) { | |
continue; /* Not our interface */ | |
} | |
if(debug==2) printpacket("recv", buf_frame, cnt); | |
write(dev,(void*)buf_frame,cnt); | |
if (debug==1) write(1, "<", 1); | |
} | |
} |
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
I think it would be clearer if you add more comments in the code