git.meshlink.io Git - meshlink/blob - src/route.c

   1 /*
   2     route.c -- routing
   3     Copyright (C) 2014 Guus Sliepen <guus@meshlink.io>
   4
   5     This program is free software; you can redistribute it and/or modify
   6     it under the terms of the GNU General Public License as published by
   7     the Free Software Foundation; either version 2 of the License, or
   8     (at your option) any later version.
   9
  10     This program is distributed in the hope that it will be useful,
  11     but WITHOUT ANY WARRANTY; without even the implied warranty of
  12     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13     GNU General Public License for more details.
  14
  15     You should have received a copy of the GNU General Public License along
  16     with this program; if not, write to the Free Software Foundation, Inc.,
  17     51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  18 */
  19
  20 #include "system.h"
  21
  22 #include "logger.h"
  23 #include "meshlink_internal.h"
  24 #include "net.h"
  25 #include "route.h"
  26 #include "utils.h"
  27
  28 static bool checklength(node_t *source, vpn_packet_t *packet, uint16_t length) {
  29         assert(length);
  30
  31         if(packet->len < length) {
  32                 logger(source->mesh, MESHLINK_WARNING, "Got too short packet from %s", source->name);
  33                 return false;
  34         } else {
  35                 return true;
  36         }
  37 }
  38
  39 void route(meshlink_handle_t *mesh, node_t *source, vpn_packet_t *packet) {
  40         assert(source);
  41
  42         // TODO: route on name or key
  43
  44         meshlink_packethdr_t *hdr = (meshlink_packethdr_t *) packet->data;
  45         node_t *dest = lookup_node(mesh, (char *)hdr->destination);
  46         logger(mesh, MESHLINK_DEBUG, "Routing packet from \"%s\" to \"%s\"\n", hdr->source, hdr->destination);
  47
  48         //Check Length
  49         if(!checklength(source, packet, sizeof(*hdr))) {
  50                 return;
  51         }
  52
  53         if(dest == NULL) {
  54                 //Lookup failed
  55                 logger(mesh, MESHLINK_WARNING, "Can't lookup the destination of a packet in the route() function. This should never happen!\n");
  56                 logger(mesh, MESHLINK_WARNING, "Destination was: %s\n", hdr->destination);
  57                 return;
  58         }
  59
  60         size_t len = packet->len - sizeof(*hdr);
  61
  62         // Channel traffic accounting
  63         if(source == mesh->self) {
  64                 dest->out_data += len + SPTPS_OVERHEAD;
  65         }
  66
  67         if(dest == mesh->self) {
  68                 source->in_data += len + SPTPS_OVERHEAD;
  69                 const void *payload = packet->data + sizeof(*hdr);
  70
  71                 char hex[len * 2 + 1];
  72
  73                 if(mesh->log_level <= MESHLINK_DEBUG) {
  74                         bin2hex(payload, hex, len);        // don't do this unless it's going to be logged
  75                 }
  76
  77                 logger(mesh, MESHLINK_DEBUG, "I received a packet for me with payload: %s\n", hex);
  78
  79                 if(source->utcp) {
  80                         channel_receive(mesh, (meshlink_node_t *)source, payload, len);
  81                 } else if(mesh->receive_cb) {
  82                         mesh->receive_cb(mesh, (meshlink_node_t *)source, payload, len);
  83                 }
  84
  85                 return;
  86         }
  87
  88         if(!dest->status.reachable) {
  89                 //TODO: check what to do here, not just print a warning
  90                 logger(mesh, MESHLINK_WARNING, "The destination of a packet in the route() function is unreachable. Dropping packet.\n");
  91                 return;
  92         }
  93
  94         if(dest == source) {
  95                 logger(mesh, MESHLINK_ERROR, "Routing loop for packet from %s!", source->name);
  96                 return;
  97         }
  98
  99         send_packet(mesh, dest, packet);
 100         return;
 101 }