X-Git-Url: http://git.meshlink.io/?a=blobdiff_plain;f=src%2Froute.c;h=ee36a9bfe4b17c8289d85053312a7d44ed2692c3;hb=963c5055505f2fc117cd5efa06eaa02c9b2bf85d;hp=3264d56003b6b8d6b4848a34c4dd97b68611aa87;hpb=fcf869cd4250a240ea8d443f70fa373e4fbacf07;p=meshlink diff --git a/src/route.c b/src/route.c index 3264d560..ee36a9bf 100644 --- a/src/route.c +++ b/src/route.c @@ -1,7 +1,6 @@ /* route.c -- routing - Copyright (C) 2000,2001 Ivo Timmermans , - 2000,2001 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,181 +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.8 2001/05/25 11:54:28 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 +#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; -subnet_t mymac; - -void learn_mac(connection_t *source, mac_t *address) -{ - subnet_t *subnet; -cp - subnet = lookup_subnet_mac(address); - - if(!subnet) - { - subnet = new_subnet(); - subnet->type = SUBNET_MAC; -// subnet->lasttime = gettimeofday(); - memcpy(&subnet->net.mac.address, address, sizeof(mac_t)); - subnet_add(source, subnet); - - if(debug_lvl >= DEBUG_TRAFFIC) - { - syslog(LOG_DEBUG, _("Learned new MAC address %x:%x:%x:%x:%x:%x from %s (%s)"), - address->x[0], - address->x[1], - address->x[2], - address->x[3], - address->x[4], - address->x[5], - source->name, source->hostname); - } - } + 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_mac(connection_t *source, vpn_packet_t *packet) -{ - subnet_t *subnet; -cp - /* Learn source address */ - - learn_mac(source, (mac_t *)(&packet->data[0])); - - /* Lookup destination address */ - - subnet = lookup_subnet_mac((mac_t *)(&packet->data[6])); - - if(!subnet) - { - 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]); - } - return NULL; - } -cp - return subnet->owner; -} +void route(meshlink_handle_t *mesh, node_t *source, vpn_packet_t *packet) { + assert(source); -connection_t *route_ipv4(vpn_packet_t *packet) -{ - ipv4_t dest; - subnet_t *subnet; -cp - dest = ntohl(*((unsigned long*)(&packet->data[30]))); - - subnet = lookup_subnet_ipv4(&dest); - - if(!subnet) - { - 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]); - } - - return NULL; - } -cp - return subnet->owner; -} + // TODO: route on name or key -connection_t *route_ipv6(vpn_packet_t *packet) -{ -cp - if(debug_lvl > DEBUG_NOTHING) - { - syslog(LOG_WARNING, _("Cannot route packet: IPv6 routing not yet implemented")); - } -cp - return NULL; -} + 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); -void route_outgoing(vpn_packet_t *packet) -{ - unsigned short int type; - avl_node_t *node; - connection_t *cl; -cp - /* FIXME: multicast? */ - - switch(routing_mode) - { - case RMODE_ROUTER: - type = ntohs(*((unsigned short*)(&packet->data[12]))); - switch(type) - { - case 0x0800: - cl = route_ipv4(packet); - break; - case 0x86DD: - cl = route_ipv6(packet); - break; - default: - if(debug_lvl >= DEBUG_TRAFFIC) - { - syslog(LOG_WARNING, _("Cannot route packet: unknown type %hx"), type); - } - return; - } - if(cl) - send_packet(cl, packet); - break; - - case RMODE_SWITCH: - cl = route_mac(myself, packet); - if(cl) - send_packet(cl, packet); - break; - - case RMODE_HUB: - for(node = connection_tree->head; node; node = node->next) - { - cl = (connection_t *)node->data; - if(cl->status.active) - send_packet(cl, packet); - } - break; - } -} + //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; + } -void route_incoming(connection_t *source, vpn_packet_t *packet) -{ - switch(routing_mode) - { - case RMODE_ROUTER: - memcpy(packet->data, mymac.net.mac.address.x, 6); - break; - case RMODE_SWITCH: - learn_mac(source, (mac_t *)(&packet->data[0])); - break; - } - - accept_packet(packet); + send_packet(mesh, dest, packet); + return; }