1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
|
#include <errno.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <sys/uio.h>
#include <linux/if_tun.h>
#include "debug.h"
#include "packet.h"
#include "arpa/inet.h"
short payload(struct ip6_hdr* hdr) {{{
return ntohs(hdr->paylgth);
}}}
void send_pkt(int fd, struct ip6_pkt* pkt) {{{
int sz = payload(&(pkt->hdr));
int w = 0;
char* buf = (char*)pkt;
w = 0;
while ( w > 0) {
int t = write(fd, buf+w, (sz + 40) - w);
if (t < 0)
debug(1, 0, "packet: write : %s\n", strerror(errno));
else
w+=t;
}
free(buf);
}}}
int recv_pkt(int fd, struct pkt_tun** pkt) {{{
int size = 1504;
unsigned char data[size];
debug(1, 0, "beginning to read...\n");
int r = read(fd, data, size);
debug(1, 0, "read %d bytes\n", r);
*pkt = (struct pkt_tun*)malloc(r);
memcpy(*pkt, data, r);
struct pkt_tun *_pkt = *pkt;
debug(1, 0, "read the flags: %04x\n", ntohs(_pkt->flags));
debug(1, 0, "read the type: %04x\n", ntohs(_pkt->type));
switch(ntohs(_pkt->type)) {
case 0x86dd:
debug(1, 0, "reading an ipv6-packet\n");
struct ip6_pkt * pkt6 = (struct ip6_pkt*) *pkt;
size = payload(&(pkt6->hdr));
// TODO: size might be greater than r!
debug(1, 0, "read the size: %d\n", size);
return size;
break;
case 0x0800:
debug(1, 0, "unknown pkt-type: IPv4\n");
//IPv4 TODO
break;
default:
debug(1, 0, "unknown pkt-type: 0x%02x\n", 0x800);
//Whatever TODO
break;
}
return -1;
}}}
struct ip6_pkt* parse_ip6(struct pkt_tun* pkt) {{{
struct ip6_pkt* pkt6 = (struct ip6_pkt*)pkt;
return pkt6;
}}}
struct ip6_tcp* parse_ip6_tcp(struct ip6_pkt* pkt) {{{
struct ip6_tcp* res = (struct ip6_tcp*) pkt;
return res;
}}}
struct ip6_udp* parse_ip6_udp(struct ip6_pkt* pkt) {{{
struct ip6_udp* res = (struct ip6_udp*) pkt;
return res;
}}}
|
