|
| 1 | +#include <fcntl.h> |
| 2 | +#include <stdio.h> |
| 3 | +#include <unistd.h> |
| 4 | +#include <string.h> |
| 5 | +#include <arpa/inet.h> |
| 6 | +#include <linux/if.h> |
| 7 | +#include <linux/if_tun.h> |
| 8 | +#include <sys/ioctl.h> |
| 9 | + |
| 10 | +#define BUFF_SIZE 2000 |
| 11 | +#define PORT_NUMBER 55555 |
| 12 | +#define SERVER_IP "10.0.2.25" |
| 13 | +struct sockaddr_in peerAddr; |
| 14 | + |
| 15 | +int createTunDevice() { |
| 16 | + int tunfd; |
| 17 | + struct ifreq ifr; |
| 18 | + memset(&ifr, 0, sizeof(ifr)); |
| 19 | + |
| 20 | + ifr.ifr_flags = IFF_TUN | IFF_NO_PI; |
| 21 | + |
| 22 | + tunfd = open("/dev/net/tun", O_RDWR); |
| 23 | + ioctl(tunfd, TUNSETIFF, &ifr); |
| 24 | + |
| 25 | + return tunfd; |
| 26 | +} |
| 27 | + |
| 28 | +/*int connectToUDPServer(){ |
| 29 | + int sockfd; |
| 30 | + char *hello="Hello"; |
| 31 | +
|
| 32 | + memset(&peerAddr, 0, sizeof(peerAddr)); |
| 33 | + peerAddr.sin_family = AF_INET; |
| 34 | + peerAddr.sin_port = htons(PORT_NUMBER); |
| 35 | + peerAddr.sin_addr.s_addr = inet_addr(SERVER_IP); |
| 36 | +
|
| 37 | + sockfd = socket(AF_INET, SOCK_DGRAM, 0); |
| 38 | +
|
| 39 | + // Send a hello message to "connect" with the VPN server |
| 40 | + sendto(sockfd, hello, strlen(hello), 0, |
| 41 | + (struct sockaddr *) &peerAddr, sizeof(peerAddr)); |
| 42 | +
|
| 43 | + return sockfd; |
| 44 | +} |
| 45 | +*/ |
| 46 | +int connectToTCPServer(){ |
| 47 | + int sockfd; |
| 48 | + char *hello="Hello"; |
| 49 | + |
| 50 | + memset(&peerAddr, 0, sizeof(peerAddr)); |
| 51 | + peerAddr.sin_family = AF_INET; |
| 52 | + peerAddr.sin_port = htons(443); |
| 53 | + peerAddr.sin_addr.s_addr = inet_addr(SERVER_IP); |
| 54 | + |
| 55 | + sockfd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP); |
| 56 | + |
| 57 | + // Send a hello message to "connect" with the VPN server |
| 58 | + sendto(sockfd, hello, strlen(hello), 0, |
| 59 | + (struct sockaddr *) &peerAddr, sizeof(peerAddr)); |
| 60 | + |
| 61 | + return sockfd; |
| 62 | +} |
| 63 | + |
| 64 | + |
| 65 | +void tunSelected(int tunfd, int sockfd){ |
| 66 | + int len; |
| 67 | + char buff[BUFF_SIZE]; |
| 68 | + |
| 69 | + printf("Got a packet from TUN\n"); |
| 70 | + |
| 71 | + bzero(buff, BUFF_SIZE); |
| 72 | + len = read(tunfd, buff, BUFF_SIZE); |
| 73 | + sendto(sockfd, buff, len, 0, (struct sockaddr *) &peerAddr, |
| 74 | + sizeof(peerAddr)); |
| 75 | +} |
| 76 | + |
| 77 | +void socketSelected (int tunfd, int sockfd){ |
| 78 | + int len; |
| 79 | + char buff[BUFF_SIZE]; |
| 80 | + |
| 81 | + printf("Got a packet from the tunnel\n"); |
| 82 | + |
| 83 | + bzero(buff, BUFF_SIZE); |
| 84 | + len = recvfrom(sockfd, buff, BUFF_SIZE, 0, NULL, NULL); |
| 85 | + write(tunfd, buff, len); |
| 86 | + |
| 87 | +} |
| 88 | +int main (int argc, char * argv[]) { |
| 89 | + int tunfd, sockfd; |
| 90 | + |
| 91 | + tunfd = createTunDevice(); |
| 92 | + sockfd = connectToUDPServer(); |
| 93 | + |
| 94 | + // Enter the main loop |
| 95 | + while (1) { |
| 96 | + fd_set readFDSet; |
| 97 | + |
| 98 | + FD_ZERO(&readFDSet); |
| 99 | + FD_SET(sockfd, &readFDSet); |
| 100 | + FD_SET(tunfd, &readFDSet); |
| 101 | + select(FD_SETSIZE, &readFDSet, NULL, NULL, NULL); |
| 102 | + |
| 103 | + if (FD_ISSET(tunfd, &readFDSet)) tunSelected(tunfd, sockfd); |
| 104 | + if (FD_ISSET(sockfd, &readFDSet)) socketSelected(tunfd, sockfd); |
| 105 | + } |
| 106 | +} |
| 107 | + |
0 commit comments