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 methodes 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-2008 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 version 3 as
  24  *  published by the Free Software Foundation.
  25  *
  26  *  uAnytun is distributed in the hope that it will be useful,
  27  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  28  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  29  *  GNU General Public License for more details.
  30  *
  31  *  You should have received a copy of the GNU General Public License
  32  *  along with uAnytun. If not, see <http://www.gnu.org/licenses/>.
  33  */
  34
  35 #include "datatypes.h"
  36
  37 #include "plain_packet.h"
  38
  39 #include <stdlib.h>
  40 #include <string.h>
  41 #include <sys/types.h>
  42 #include <netinet/in.h>
  43 #include <netinet/in_systm.h>
  44 #include <netinet/ip.h>
  45
  46 void plain_packet_init(plain_packet_t* packet)
  47 {
  48   if(!packet)
  49     return;
  50
  51   memset (packet, 0, sizeof(*packet));
  52 }
  53
  54 u_int32_t plain_packet_get_header_length()
  55 {
  56   return sizeof(payload_type_t);
  57 }
  58
  59 u_int8_t* plain_packet_get_packet(plain_packet_t* packet)
  60 {
  61   if(!packet)
  62     return NULL;
  63
  64   return packet->data_.buf_;
  65 }
  66
  67 u_int32_t plain_packet_get_length(plain_packet_t* packet)
  68 {
  69   if(!packet)
  70     return 0;
  71
  72   return (packet->payload_length_ + sizeof(payload_type_t));
  73 }
  74
  75 void plain_packet_set_length(plain_packet_t* packet, u_int32_t len)
  76 {
  77   if(!packet)
  78     return;
  79
  80   if(len > PLAIN_PACKET_SIZE_MAX)
  81     len = PLAIN_PACKET_SIZE_MAX - sizeof(payload_type_t);
  82   else if(len < sizeof(payload_type_t))
  83     len = 0;
  84   else
  85     len -= sizeof(payload_type_t);
  86
  87   packet->payload_length_ = len;
  88 }
  89
  90 u_int8_t* plain_packet_get_payload(plain_packet_t* packet)
  91 {
  92   if(!packet || !packet->payload_length_)
  93     return NULL;
  94
  95   return (packet->data_.buf_ + sizeof(payload_type_t));
  96 }
  97
  98 u_int32_t plain_packet_get_payload_length(plain_packet_t* packet)
  99 {
 100   if(!packet)
 101     return 0;
 102
 103   return packet->payload_length_;
 104 }
 105
 106 void plain_packet_set_payload_length(plain_packet_t* packet, u_int32_t len)
 107 {
 108   if(!packet)
 109     return;
 110
 111   if(len > PLAIN_PACKET_SIZE_MAX || (len + sizeof(payload_type_t)) > PLAIN_PACKET_SIZE_MAX)
 112     len = PLAIN_PACKET_SIZE_MAX - sizeof(payload_type_t);
 113
 114   packet->payload_length_ = len;
 115 }
 116
 117 payload_type_t plain_packet_get_type(plain_packet_t* packet)
 118 {
 119   if(!packet)
 120     return 0;
 121
 122   return PAYLOAD_TYPE_T_NTOH(packet->data_.payload_type_);
 123 }
 124
 125 void plain_packet_set_type(plain_packet_t* packet, payload_type_t type)
 126 {
 127   if(!packet)
 128     return;
 129
 130   if(type == PAYLOAD_TYPE_TUN) {
 131     if(!packet->payload_length_) {
 132       packet->data_.payload_type_ = PAYLOAD_TYPE_T_HTON(PAYLOAD_TYPE_TUN);
 133       return;
 134     }
 135
 136     struct ip* hdr = (struct ip*)(packet->data_.buf_ + sizeof(payload_type_t));
 137     if(hdr->ip_v == 4)
 138       packet->data_.payload_type_ = PAYLOAD_TYPE_T_HTON(PAYLOAD_TYPE_TUN4);
 139     else if(hdr->ip_v == 6)
 140       packet->data_.payload_type_ = PAYLOAD_TYPE_T_HTON(PAYLOAD_TYPE_TUN6);
 141   }
 142   else
 143     packet->data_.payload_type_ = PAYLOAD_TYPE_T_HTON(type);
 144 }