www.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.8 2002/03/01 15:14:29 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 defined(SOL_IP) && defined(IP_TOS)
 265   if(priorityinheritance && origpriority != priority)
 266     {
 267       priority = origpriority;
 268       if(debug_lvl >= DEBUG_TRAFFIC)
 269         syslog(LOG_DEBUG, _("Setting outgoing packet priority to %d"), priority);
 270       if(setsockopt(udp_socket[0], SOL_IP, IP_TOS, &priority, sizeof(priority))) /* SO_PRIORITY doesn't seem to work */
 271         syslog(LOG_ERR, _("System call `%s' failed: %s"), "setsockopt", strerror(errno));
 272     }
 273 #endif
 274
 275   if((sendto(udp_socket[0], (char *)&inpkt->seqno, inpkt->len, 0, &(n->address.sa), SALEN(n->address.sa))) < 0)
 276     {
 277       syslog(LOG_ERR, _("Error sending packet to %s (%s): %s"),
 278              n->name, n->hostname, strerror(errno));
 279       return;
 280     }
 281
 282   inpkt->len = origlen;
 283 cp
 284 }
 285
 286 /*
 287   send a packet to the given vpn ip.
 288 */
 289 void send_packet(node_t *n, vpn_packet_t *packet)
 290 {
 291   node_t *via;
 292 cp
 293   if(debug_lvl >= DEBUG_TRAFFIC)
 294     syslog(LOG_ERR, _("Sending packet of %d bytes to %s (%s)"),
 295            packet->len, n->name, n->hostname);
 296
 297   if(n == myself)
 298     {
 299       if(debug_lvl >= DEBUG_TRAFFIC)
 300         {
 301           syslog(LOG_NOTICE, _("Packet is looping back to us!"));
 302         }
 303
 304       return;
 305     }
 306
 307   if(!n->status.reachable)
 308     {
 309       if(debug_lvl >= DEBUG_TRAFFIC)
 310         syslog(LOG_INFO, _("Node %s (%s) is not reachable"),
 311                n->name, n->hostname);
 312       return;
 313     }
 314
 315   via = (n->via == myself)?n->nexthop:n->via;
 316
 317   if(via != n && debug_lvl >= DEBUG_TRAFFIC)
 318     syslog(LOG_ERR, _("Sending packet to %s via %s (%s)"),
 319            n->name, via->name, n->via->hostname);
 320
 321   if((myself->options | via->options) & OPTION_TCPONLY)
 322     {
 323       if(send_tcppacket(via->connection, packet))
 324         terminate_connection(via->connection, 1);
 325     }
 326   else
 327     send_udppacket(via, packet);
 328 }
 329
 330 /* Broadcast a packet using the minimum spanning tree */
 331
 332 void broadcast_packet(node_t *from, vpn_packet_t *packet)
 333 {
 334   avl_node_t *node;
 335   connection_t *c;
 336 cp
 337   if(debug_lvl >= DEBUG_TRAFFIC)
 338     syslog(LOG_INFO, _("Broadcasting packet of %d bytes from %s (%s)"),
 339            packet->len, from->name, from->hostname);
 340
 341   for(node = connection_tree->head; node; node = node->next)
 342     {
 343       c = (connection_t *)node->data;
 344       if(c->status.active && c->status.mst && c != from->nexthop->connection)
 345         send_packet(c->node, packet);
 346     }
 347 cp
 348 }
 349
 350 void flush_queue(node_t *n)
 351 {
 352   list_node_t *node, *next;
 353 cp
 354   if(debug_lvl >= DEBUG_TRAFFIC)
 355     syslog(LOG_INFO, _("Flushing queue for %s (%s)"), n->name, n->hostname);
 356
 357   for(node = n->queue->head; node; node = next)
 358     {
 359       next = node->next;
 360       send_udppacket(n, (vpn_packet_t *)node->data);
 361       list_delete_node(n->queue, node);
 362     }
 363 cp
 364 }
 365
 366 void handle_incoming_vpn_data(int sock)
 367 {
 368   vpn_packet_t pkt;
 369   int x, l = sizeof(x);
 370   char *hostname;
 371   sockaddr_t from;
 372   socklen_t fromlen = sizeof(from);
 373   node_t *n;
 374 cp
 375   if(getsockopt(sock, SOL_SOCKET, SO_ERROR, &x, &l) < 0)
 376     {
 377       syslog(LOG_ERR, _("This is a bug: %s:%d: %d:%s"),
 378              __FILE__, __LINE__, sock, strerror(errno));
 379       cp_trace();
 380       exit(1);
 381     }
 382   if(x)
 383     {
 384       syslog(LOG_ERR, _("Incoming data socket error: %s"), strerror(x));
 385       return;
 386     }
 387
 388   if((pkt.len = recvfrom(sock, (char *)&pkt.seqno, MAXSIZE, 0, &from.sa, &fromlen)) <= 0)
 389     {
 390       syslog(LOG_ERR, _("Receiving packet failed: %s"), strerror(errno));
 391       return;
 392     }
 393
 394   n = lookup_node_udp(&from);
 395
 396   if(!n)
 397     {
 398       hostname = sockaddr2hostname(&from);
 399       syslog(LOG_WARNING, _("Received UDP packet from unknown source %s"), hostname);
 400       free(hostname);
 401       return;
 402     }
 403
 404   if(n->connection)
 405     n->connection->last_ping_time = now;
 406
 407   receive_udppacket(n, &pkt);
 408 cp
 409 }
 410