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 }