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         if(dest == mesh->self) {
  61                 const void *payload = packet->data + sizeof(*hdr);
  62                 size_t len = packet->len - sizeof(*hdr);
  63
  64                 char hex[len * 2 + 1];
  65
  66                 if(mesh->log_level <= MESHLINK_DEBUG) {
  67                         bin2hex(payload, hex, len);        // don't do this unless it's going to be logged
  68                 }
  69
  70                 logger(mesh, MESHLINK_DEBUG, "I received a packet for me with payload: %s\n", hex);
  71
  72                 if(mesh->receive_cb) {
  73                         mesh->receive_cb(mesh, (meshlink_node_t *)source, payload, len);
  74                 }
  75
  76                 return;
  77         }
  78
  79         if(!dest->status.reachable) {
  80                 //TODO: check what to do here, not just print a warning
  81                 logger(mesh, MESHLINK_WARNING, "The destination of a packet in the route() function is unreachable. Dropping packet.\n");
  82                 return;
  83         }
  84
  85         if(dest == source) {
  86                 logger(mesh, MESHLINK_ERROR, "Routing loop for packet from %s!", source->name);
  87                 return;
  88         }
  89
  90         send_packet(mesh, dest, packet);
  91         return;
  92 }