Imported Upstream version 0.3.6
[debian/uanytun.git] / src / plain_packet.c
1 /*
2  *  uAnytun
3  *
4  *  uAnytun is a tiny implementation of SATP. Unlike Anytun which is a full
5  *  featured implementation uAnytun has no support for multiple connections
6  *  or synchronisation. It is a small single threaded implementation intended
7  *  to act as a client on small platforms.
8  *  The secure anycast tunneling protocol (satp) defines a protocol used
9  *  for communication between any combination of unicast and anycast
10  *  tunnel endpoints.  It has less protocol overhead than IPSec in Tunnel
11  *  mode and allows tunneling of every ETHER TYPE protocol (e.g.
12  *  ethernet, ip, arp ...). satp directly includes cryptography and
13  *  message authentication based on the methods used by SRTP.  It is
14  *  intended to deliver a generic, scaleable and secure solution for
15  *  tunneling and relaying of packets of any protocol.
16  *
17  *
18  *  Copyright (C) 2007-2014 Christian Pointner <equinox@anytun.org>
19  *
20  *  This file is part of uAnytun.
21  *
22  *  uAnytun is free software: you can redistribute it and/or modify
23  *  it under the terms of the GNU General Public License as published by
24  *  the Free Software Foundation, either version 3 of the License, or
25  *  any later version.
26  *
27  *  uAnytun is distributed in the hope that it will be useful,
28  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
29  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
30  *  GNU General Public License for more details.
31  *
32  *  You should have received a copy of the GNU General Public License
33  *  along with uAnytun. If not, see <http://www.gnu.org/licenses/>.
34  *
35  *  In addition, as a special exception, the copyright holders give
36  *  permission to link the code of portions of this program with the
37  *  OpenSSL library under certain conditions as described in each
38  *  individual source file, and distribute linked combinations
39  *  including the two.
40  *  You must obey the GNU General Public License in all respects
41  *  for all of the code used other than OpenSSL.  If you modify
42  *  file(s) with this exception, you may extend this exception to your
43  *  version of the file(s), but you are not obligated to do so.  If you
44  *  do not wish to do so, delete this exception statement from your
45  *  version.  If you delete this exception statement from all source
46  *  files in the program, then also delete it here.
47  */
48
49 #include "datatypes.h"
50
51 #include "plain_packet.h"
52
53 #include <stdlib.h>
54 #include <string.h>
55 #include <sys/types.h>
56 #include <netinet/in.h>
57 #include <netinet/in_systm.h>
58 #include <netinet/ip.h>
59
60 void plain_packet_init(plain_packet_t* packet)
61 {
62   if(!packet)
63     return;
64
65   memset (packet, 0, sizeof(*packet));
66 }
67
68 u_int32_t plain_packet_get_header_length()
69 {
70   return sizeof(payload_type_t);
71 }
72
73 u_int8_t* plain_packet_get_packet(plain_packet_t* packet)
74 {
75   if(!packet)
76     return NULL;
77
78   return packet->data_.buf_;
79 }
80
81 u_int32_t plain_packet_get_length(plain_packet_t* packet)
82 {
83   if(!packet)
84     return 0;
85
86   return (packet->payload_length_ + sizeof(payload_type_t));
87 }
88
89 void plain_packet_set_length(plain_packet_t* packet, u_int32_t len)
90 {
91   if(!packet)
92     return;
93
94   if(len > PLAIN_PACKET_SIZE_MAX)
95     len = PLAIN_PACKET_SIZE_MAX - sizeof(payload_type_t);
96   else if(len < sizeof(payload_type_t))
97     len = 0;
98   else
99     len -= sizeof(payload_type_t);
100
101   packet->payload_length_ = len;
102 }
103
104 u_int8_t* plain_packet_get_payload(plain_packet_t* packet)
105 {
106   if(!packet || !packet->payload_length_)
107     return NULL;
108
109   return (packet->data_.buf_ + sizeof(payload_type_t));
110 }
111
112 u_int32_t plain_packet_get_payload_length(plain_packet_t* packet)
113 {
114   if(!packet)
115     return 0;
116
117   return packet->payload_length_;
118 }
119
120 void plain_packet_set_payload_length(plain_packet_t* packet, u_int32_t len)
121 {
122   if(!packet)
123     return;
124
125   if(len > PLAIN_PACKET_SIZE_MAX || (len + sizeof(payload_type_t)) > PLAIN_PACKET_SIZE_MAX)
126     len = PLAIN_PACKET_SIZE_MAX - sizeof(payload_type_t);
127
128   packet->payload_length_ = len;
129 }
130
131 payload_type_t plain_packet_get_type(plain_packet_t* packet)
132 {
133   if(!packet)
134     return 0;
135
136   return PAYLOAD_TYPE_T_NTOH(packet->data_.payload_type_);
137 }
138
139 void plain_packet_set_type(plain_packet_t* packet, payload_type_t type)
140 {
141   if(!packet)
142     return;
143
144   if(type == PAYLOAD_TYPE_TUN) {
145     if(!packet->payload_length_) {
146       packet->data_.payload_type_ = PAYLOAD_TYPE_T_HTON(PAYLOAD_TYPE_TUN);
147       return;
148     }
149
150     struct ip* hdr = (struct ip*)(packet->data_.buf_ + sizeof(payload_type_t));
151     if(hdr->ip_v == 4)
152       packet->data_.payload_type_ = PAYLOAD_TYPE_T_HTON(PAYLOAD_TYPE_TUN4);
153     else if(hdr->ip_v == 6)
154       packet->data_.payload_type_ = PAYLOAD_TYPE_T_HTON(PAYLOAD_TYPE_TUN6);
155   }
156   else
157     packet->data_.payload_type_ = PAYLOAD_TYPE_T_HTON(type);
158 }