git.tinc-vpn.org Git - tinc/blob - src/net_packet.c

   1 /*
   2     net_packet.c -- Handles in- and outgoing VPN packets
   3     Copyright (C) 1998-2002 Ivo Timmermans <itimmermans@bigfoot.com>,
   4                   2000-2002 Guus Sliepen <guus@sliepen.warande.net>
   5
   6     This program is free software; you can redistribute it and/or modify
   7     it under the terms of the GNU General Public License as published by
   8     the Free Software Foundation; either version 2 of the License, or
   9     (at your option) any later version.
  10
  11     This program is distributed in the hope that it will be useful,
  12     but WITHOUT ANY WARRANTY; without even the implied warranty of
  13     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14     GNU General Public License for more details.
  15
  16     You should have received a copy of the GNU General Public License
  17     along with this program; if not, write to the Free Software
  18     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  19
  20     $Id: net_packet.c,v 1.1.2.6 2002/03/01 12:26:56 guus Exp $
  21 */
  22
  23 #include "config.h"
  24
  25 #include <errno.h>
  26 #include <fcntl.h>
  27 #include <netdb.h>
  28 #include <netinet/in.h>
  29 #ifdef HAVE_LINUX
  30  #include <netinet/ip.h>
  31  #include <netinet/tcp.h>
  32 #endif
  33 #include <stdio.h>
  34 #include <stdlib.h>
  35 #include <string.h>
  36 #include <signal.h>
  37 #include <sys/time.h>
  38 #include <sys/types.h>
  39 #include <syslog.h>
  40 #include <unistd.h>
  41 #include <sys/ioctl.h>
  42 /* SunOS really wants sys/socket.h BEFORE net/if.h,
  43    and FreeBSD wants these lines below the rest. */
  44 #include <arpa/inet.h>
  45 #include <sys/socket.h>
  46 #include <net/if.h>
  47
  48 #include <openssl/rand.h>
  49 #include <openssl/evp.h>
  50 #include <openssl/pem.h>
  51 #include <openssl/hmac.h>
  52
  53 #ifndef HAVE_RAND_PSEUDO_BYTES
  54 #define RAND_pseudo_bytes RAND_bytes
  55 #endif
  56
  57 #include <zlib.h>
  58
  59 #include <utils.h>
  60 #include <xalloc.h>
  61 #include <avl_tree.h>
  62 #include <list.h>
  63
  64 #include "conf.h"
  65 #include "connection.h"
  66 #include "meta.h"
  67 #include "net.h"
  68 #include "netutl.h"
  69 #include "process.h"
  70 #include "protocol.h"
  71 #include "subnet.h"
  72 #include "graph.h"
  73 #include "process.h"
  74 #include "route.h"
  75 #include "device.h"
  76 #include "event.h"
  77
  78 #include "system.h"
  79
  80 int keylifetime = 0;
  81 int keyexpires = 0;
  82
  83 #define MAX_SEQNO 1073741824
  84
  85 /* VPN packet I/O */
  86
  87 void receive_udppacket(node_t *n, vpn_packet_t *inpkt)
  88 {
  89   vpn_packet_t pkt1, pkt2;
  90   vpn_packet_t *pkt[] = {&pkt1, &pkt2, &pkt1, &pkt2};
  91   int nextpkt = 0;
  92   vpn_packet_t *outpkt = pkt[0];
  93   int outlen, outpad;
  94   long int complen = MTU + 12;
  95   EVP_CIPHER_CTX ctx;
  96   char hmac[EVP_MAX_MD_SIZE];
  97 cp
  98   /* Check the message authentication code */
  99
 100   if(myself->digest && myself->maclength)
 101     {
 102       inpkt->len -= myself->maclength;
 103       HMAC(myself->digest, myself->key, myself->keylength, (char *)&inpkt->seqno, inpkt->len, hmac, NULL);
 104       if(memcmp(hmac, (char *)&inpkt->seqno + inpkt->len, myself->maclength))
 105         {
 106           syslog(LOG_DEBUG, _("Got unauthenticated packet from %s (%s)"), n->name, n->hostname);
 107           return;
 108         }
 109     }
 110
 111   /* Decrypt the packet */
 112
 113   if(myself->cipher)
 114   {
 115     outpkt = pkt[nextpkt++];
 116
 117     EVP_DecryptInit(&ctx, myself->cipher, myself->key, myself->key + myself->cipher->key_len);
 118     EVP_DecryptUpdate(&ctx, (char *)&outpkt->seqno, &outlen, (char *)&inpkt->seqno, inpkt->len);
 119     EVP_DecryptFinal(&ctx, (char *)&outpkt->seqno + outlen, &outpad);
 120
 121     outpkt->len = outlen + outpad;
 122     inpkt = outpkt;
 123   }
 124
 125   /* Check the sequence number */
 126
 127   inpkt->len -= sizeof(inpkt->seqno);
 128   inpkt->seqno = ntohl(inpkt->seqno);
 129
 130   if(inpkt->seqno <= n->received_seqno)
 131   {
 132     syslog(LOG_DEBUG, _("Got late or replayed packet from %s (%s), seqno %d"), n->name, n->hostname, inpkt->seqno);
 133     return;
 134   }
 135
 136   n->received_seqno = inpkt->seqno;
 137
 138   if(n->received_seqno > MAX_SEQNO)
 139     keyexpires = 0;
 140
 141   /* Decompress the packet */
 142
 143   if(myself->compression)
 144   {
 145     outpkt = pkt[nextpkt++];
 146
 147     if(uncompress(outpkt->data, &complen, inpkt->data, inpkt->len) != Z_OK)
 148     {
 149       syslog(LOG_ERR, _("Error while uncompressing packet from %s (%s)"), n->name, n->hostname);
 150       return;
 151     }
 152
 153     outpkt->len = complen;
 154     inpkt = outpkt;
 155   }
 156
 157   receive_packet(n, inpkt);
 158 cp
 159 }
 160
 161 void receive_tcppacket(connection_t *c, char *buffer, int len)
 162 {
 163   vpn_packet_t outpkt;
 164 cp
 165   outpkt.len = len;
 166   memcpy(outpkt.data, buffer, len);
 167
 168   receive_packet(c->node, &outpkt);
 169 cp
 170 }
 171
 172 void receive_packet(node_t *n, vpn_packet_t *packet)
 173 {
 174 cp
 175   if(debug_lvl >= DEBUG_TRAFFIC)
 176     syslog(LOG_DEBUG, _("Received packet of %d bytes from %s (%s)"), packet->len, n->name, n->hostname);
 177
 178   route_incoming(n, packet);
 179 cp
 180 }
 181
 182 void send_udppacket(node_t *n, vpn_packet_t *inpkt)
 183 {
 184   vpn_packet_t pkt1, pkt2;
 185   vpn_packet_t *pkt[] = {&pkt1, &pkt2, &pkt1, &pkt2};
 186   int nextpkt = 0;
 187   vpn_packet_t *outpkt;
 188   int origlen;
 189   int outlen, outpad;
 190   long int complen = MTU + 12;
 191   EVP_CIPHER_CTX ctx;
 192   vpn_packet_t *copy;
 193   static int priority = 0;
 194   int origpriority;
 195 cp
 196   if(!n->status.validkey)
 197     {
 198       if(debug_lvl >= DEBUG_TRAFFIC)
 199         syslog(LOG_INFO, _("No valid key known yet for %s (%s), queueing packet"),
 200                n->name, n->hostname);
 201
 202       /* Since packet is on the stack of handle_tap_input(),
 203          we have to make a copy of it first. */
 204
 205       copy = xmalloc(sizeof(vpn_packet_t));
 206       memcpy(copy, inpkt, sizeof(vpn_packet_t));
 207
 208       list_insert_tail(n->queue, copy);
 209
 210       if(!n->status.waitingforkey)
 211         send_req_key(n->nexthop->connection, myself, n);
 212
 213       return;
 214     }
 215
 216   origlen = inpkt->len;
 217   origpriority = inpkt->priority;
 218
 219   /* Compress the packet */
 220
 221   if(n->compression)
 222   {
 223     outpkt = pkt[nextpkt++];
 224
 225     if(compress2(outpkt->data, &complen, inpkt->data, inpkt->len, n->compression) != Z_OK)
 226     {
 227       syslog(LOG_ERR, _("Error while compressing packet to %s (%s)"), n->name, n->hostname);
 228       return;
 229     }
 230
 231     outpkt->len = complen;
 232     inpkt = outpkt;
 233   }
 234
 235   /* Add sequence number */
 236
 237   inpkt->seqno = htonl(++(n->sent_seqno));
 238   inpkt->len += sizeof(inpkt->seqno);
 239
 240   /* Encrypt the packet */
 241
 242   if(n->cipher)
 243   {
 244     outpkt = pkt[nextpkt++];
 245
 246     EVP_EncryptInit(&ctx, n->cipher, n->key, n->key + n->cipher->key_len);
 247     EVP_EncryptUpdate(&ctx, (char *)&outpkt->seqno, &outlen, (char *)&inpkt->seqno, inpkt->len);
 248     EVP_EncryptFinal(&ctx, (char *)&outpkt->seqno + outlen, &outpad);
 249
 250     outpkt->len = outlen + outpad;
 251     inpkt = outpkt;
 252   }
 253
 254   /* Add the message authentication code */
 255
 256   if(n->digest && n->maclength)
 257     {
 258       HMAC(n->digest, n->key, n->keylength, (char *)&inpkt->seqno, inpkt->len, (char *)&inpkt->seqno + inpkt->len, &outlen);
 259       inpkt->len += n->maclength;
 260     }
 261
 262   /* Send the packet */
 263
 264   if(priorityinheritance && origpriority != priority)
 265     {
 266       priority = origpriority;
 267       if(debug_lvl >= DEBUG_TRAFFIC)
 268         syslog(LOG_DEBUG, _("Setting outgoing packet priority to %d"), priority);
 269       if(setsockopt(udp_socket[0], SOL_IP, IP_TOS, &priority, sizeof(priority))) /* SO_PRIORITY doesn't seem to work */
 270         syslog(LOG_ERR, _("System call `%s' failed: %s"), "setsockopt", strerror(errno));
 271     }
 272
 273   if((sendto(udp_socket[0], (char *)&inpkt->seqno, inpkt->len, 0, &(n->address.sa), SALEN(n->address.sa))) < 0)
 274     {
 275       syslog(LOG_ERR, _("Error sending packet to %s (%s): %s"),
 276              n->name, n->hostname, strerror(errno));
 277       return;
 278     }
 279
 280   inpkt->len = origlen;
 281 cp
 282 }
 283
 284 /*
 285   send a packet to the given vpn ip.
 286 */
 287 void send_packet(node_t *n, vpn_packet_t *packet)
 288 {
 289   node_t *via;
 290 cp
 291   if(debug_lvl >= DEBUG_TRAFFIC)
 292     syslog(LOG_ERR, _("Sending packet of %d bytes to %s (%s)"),
 293            packet->len, n->name, n->hostname);
 294
 295   if(n == myself)
 296     {
 297       if(debug_lvl >= DEBUG_TRAFFIC)
 298         {
 299           syslog(LOG_NOTICE, _("Packet is looping back to us!"));
 300         }
 301
 302       return;
 303     }
 304
 305   if(!n->status.reachable)
 306     {
 307       if(debug_lvl >= DEBUG_TRAFFIC)
 308         syslog(LOG_INFO, _("Node %s (%s) is not reachable"),
 309                n->name, n->hostname);
 310       return;
 311     }
 312
 313   via = (n->via == myself)?n->nexthop:n->via;
 314
 315   if(via != n && debug_lvl >= DEBUG_TRAFFIC)
 316     syslog(LOG_ERR, _("Sending packet to %s via %s (%s)"),
 317            n->name, via->name, n->via->hostname);
 318
 319   if((myself->options | via->options) & OPTION_TCPONLY)
 320     {
 321       if(send_tcppacket(via->connection, packet))
 322         terminate_connection(via->connection, 1);
 323     }
 324   else
 325     send_udppacket(via, packet);
 326 }
 327
 328 /* Broadcast a packet using the minimum spanning tree */
 329
 330 void broadcast_packet(node_t *from, vpn_packet_t *packet)
 331 {
 332   avl_node_t *node;
 333   connection_t *c;
 334 cp
 335   if(debug_lvl >= DEBUG_TRAFFIC)
 336     syslog(LOG_INFO, _("Broadcasting packet of %d bytes from %s (%s)"),
 337            packet->len, from->name, from->hostname);
 338
 339   for(node = connection_tree->head; node; node = node->next)
 340     {
 341       c = (connection_t *)node->data;
 342       if(c->status.active && c->status.mst && c != from->nexthop->connection)
 343         send_packet(c->node, packet);
 344     }
 345 cp
 346 }
 347
 348 void flush_queue(node_t *n)
 349 {
 350   list_node_t *node, *next;
 351 cp
 352   if(debug_lvl >= DEBUG_TRAFFIC)
 353     syslog(LOG_INFO, _("Flushing queue for %s (%s)"), n->name, n->hostname);
 354
 355   for(node = n->queue->head; node; node = next)
 356     {
 357       next = node->next;
 358       send_udppacket(n, (vpn_packet_t *)node->data);
 359       list_delete_node(n->queue, node);
 360     }
 361 cp
 362 }
 363
 364 void handle_incoming_vpn_data(int sock)
 365 {
 366   vpn_packet_t pkt;
 367   int x, l = sizeof(x);
 368   char *hostname;
 369   sockaddr_t from;
 370   socklen_t fromlen = sizeof(from);
 371   node_t *n;
 372 cp
 373   if(getsockopt(sock, SOL_SOCKET, SO_ERROR, &x, &l) < 0)
 374     {
 375       syslog(LOG_ERR, _("This is a bug: %s:%d: %d:%s"),
 376              __FILE__, __LINE__, sock, strerror(errno));
 377       cp_trace();
 378       exit(1);
 379     }
 380   if(x)
 381     {
 382       syslog(LOG_ERR, _("Incoming data socket error: %s"), strerror(x));
 383       return;
 384     }
 385
 386   if((pkt.len = recvfrom(sock, (char *)&pkt.seqno, MAXSIZE, 0, &from.sa, &fromlen)) <= 0)
 387     {
 388       syslog(LOG_ERR, _("Receiving packet failed: %s"), strerror(errno));
 389       return;
 390     }
 391
 392   n = lookup_node_udp(&from);
 393
 394   if(!n)
 395     {
 396       hostname = sockaddr2hostname(&from);
 397       syslog(LOG_WARNING, _("Received UDP packet from unknown source %s"), hostname);
 398       free(hostname);
 399       return;
 400     }
 401
 402 /*
 403   if(n->connection)
 404     n->connection->last_ping_time = time(NULL);
 405 */
 406   receive_udppacket(n, &pkt);
 407 cp
 408 }
 409