]> git.meshlink.io Git - meshlink/blob - src/route.c
Include "system.h" in the UTCP sources.
[meshlink] / 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 }