X-Git-Url: http://git.meshlink.io/?a=blobdiff_plain;f=src%2Froute.c;h=ee36a9bfe4b17c8289d85053312a7d44ed2692c3;hb=be83b0af60449c7b35d17d97f2e6dc12f611e831;hp=8ff2e39cbad1ace318c6c669ca5ac823688ebeda;hpb=e924096f62655d711cd2d114a8d1ef0fecbb593b;p=meshlink diff --git a/src/route.c b/src/route.c index 8ff2e39c..ee36a9bf 100644 --- a/src/route.c +++ b/src/route.c @@ -1,7 +1,6 @@ /* route.c -- routing - Copyright (C) 2000 Ivo Timmermans , - 2000 Guus Sliepen + Copyright (C) 2014 Guus Sliepen This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by @@ -13,129 +12,81 @@ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. - You should have received a copy of the GNU General Public License - along with this program; if not, write to the Free Software - Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. - - $Id: route.c,v 1.1.2.4 2001/01/05 23:53:53 guus Exp $ + You should have received a copy of the GNU General Public License along + with this program; if not, write to the Free Software Foundation, Inc., + 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. */ -#include "config.h" - -#include -#include -#include +#include "system.h" +#include "logger.h" +#include "meshlink_internal.h" #include "net.h" -#include "connection.h" -#include "subnet.h" #include "route.h" +#include "utils.h" -#include "system.h" +static bool checklength(node_t *source, vpn_packet_t *packet, uint16_t length) { + assert(length); -int routing_mode = RMODE_ROUTER; /* Will be used to determine if we route by MAC or by payload's protocol */ - -connection_t *route_mac(connection_t *source, vpn_packet_t *packet) -{ - connection_t *oldsrc, *dst; - subnet_t *subnet; -cp - /* Learn source address */ - - oldsrc = lookup_subnet_mac((mac_t *)(&packet->data[0]))->owner; - - if(!oldsrc) - { - subnet = new_subnet(); - subnet->type = SUBNET_MAC; - memcpy(&subnet->net.mac.address, (mac_t *)(&packet->data[0]), sizeof(mac_t)); - subnet_add(source, subnet); - } - - /* FIXME: do ageing and roaming */ - - /* Lookup destination address */ - - dst = lookup_subnet_mac((mac_t *)(&packet->data[6]))->owner; - - if(!dst) - if(debug_lvl >= DEBUG_TRAFFIC) - { - syslog(LOG_WARNING, _("Cannot route packet: unknown destination address %x:%x:%x:%x:%x:%x"), - packet->data[6], - packet->data[7], - packet->data[8], - packet->data[9], - packet->data[10], - packet->data[11]); - } -cp - return dst; + if(packet->len < length) { + logger(source->mesh, MESHLINK_WARNING, "Got too short packet from %s", source->name); + return false; + } else { + return true; + } } -connection_t *route_ipv4(vpn_packet_t *packet) -{ - ipv4_t dest; - connection_t *cl; -cp - dest = ntohl(*((unsigned long*)(&packet->data[30]))); - - cl = lookup_subnet_ipv4(&dest)->owner; - if(!cl) - if(debug_lvl >= DEBUG_TRAFFIC) - { - syslog(LOG_WARNING, _("Cannot route packet: unknown destination address %d.%d.%d.%d"), - packet->data[30], packet->data[31], packet->data[32], packet->data[33]); - } -cp - return cl; -} +void route(meshlink_handle_t *mesh, node_t *source, vpn_packet_t *packet) { + assert(source); -connection_t *route_ipv6(vpn_packet_t *packet) -{ -cp - if(debug_lvl > DEBUG_NOTHING) - { - syslog(LOG_WARNING, _("Cannot route packet: IPv6 routing not implemented yet")); - } -cp - return NULL; -} + // TODO: route on name or key + + meshlink_packethdr_t *hdr = (meshlink_packethdr_t *) packet->data; + node_t *dest = lookup_node(mesh, (char *)hdr->destination); + logger(mesh, MESHLINK_DEBUG, "Routing packet from \"%s\" to \"%s\"\n", hdr->source, hdr->destination); + + //Check Length + if(!checklength(source, packet, sizeof(*hdr))) { + return; + } + + if(dest == NULL) { + //Lookup failed + logger(mesh, MESHLINK_WARNING, "Can't lookup the destination of a packet in the route() function. This should never happen!\n"); + logger(mesh, MESHLINK_WARNING, "Destination was: %s\n", hdr->destination); + return; + } + + if(dest == mesh->self) { + const void *payload = packet->data + sizeof(*hdr); + size_t len = packet->len - sizeof(*hdr); + + char hex[len * 2 + 1]; + + if(mesh->log_level <= MESHLINK_DEBUG) { + bin2hex(payload, hex, len); // don't do this unless it's going to be logged + } + + logger(mesh, MESHLINK_DEBUG, "I received a packet for me with payload: %s\n", hex); + + if(mesh->receive_cb) { + mesh->receive_cb(mesh, (meshlink_node_t *)source, payload, len); + } + + return; + } + + if(!dest->status.reachable) { + //TODO: check what to do here, not just print a warning + logger(mesh, MESHLINK_WARNING, "The destination of a packet in the route() function is unreachable. Dropping packet.\n"); + return; + } + + if(dest == source) { + logger(mesh, MESHLINK_ERROR, "Routing loop for packet from %s!", source->name); + return; + } -connection_t *route_packet(connection_t *source, vpn_packet_t *packet) -{ - unsigned short int type; -cp - /* FIXME: multicast? */ - - switch(routing_mode) - { - case RMODE_HUB: - return broadcast; - - case RMODE_SWITCH: - return route_mac(source, packet); - - case RMODE_ROUTER: - type = ntohs(*((unsigned short*)(&packet->data[12]))); - switch(type) - { - case 0x0800: - return route_ipv4(packet); - case 0x86DD: - return route_ipv6(packet); - /* - case 0x8137: - return route_ipx(packet); - case 0x0806: - return route_arp(packet); - */ - default: - if(debug_lvl >= DEBUG_TRAFFIC) - { - syslog(LOG_WARNING, _("Cannot route packet: unknown type %hx"), type); - } - return NULL; - } - } + send_packet(mesh, dest, packet); + return; }