Move packet handling to a separate source file

1 files changed, 4 insertions, 111 deletions

diff --git a/src/babel.c b/src/babel.c
index 9242d30..91cd97b 100644
--- a/src/babel.c
+++ b/src/babel.c
@@ -133,124 +133,17 @@ void gmrf_protocol_add_iface(gmrf_t *gmrf, gmrf_context_t *ctx, gmrf_iface_t *if
 	ctx->interfaces = b_iface;
 }
 
-typedef struct handle_tlv_arg {
-	gp_babel_iface_t *iface;
-	const gmrf_addr_t *source;
-
-	gp_babel_node_id_t node_id;
-} handle_tlv_arg_t;
-
-static inline gp_babel_neigh_t* get_tlv_neigh(handle_tlv_arg_t *arg) {
-	return gp_babel_neigh_get(arg->iface, arg->source);
-}
-
-static void handle_tlv_hello(gmrf_t *gmrf, gmrf_context_t *ctx, const gp_babel_tlv_hello_t *tlv_hello, size_t len, handle_tlv_arg_t *arg) {
-	if (len < sizeof(gp_babel_tlv_hello_t)) {
-		gmrf_logf(gmrf, LOG_WARNING, "received short hello TLV.");
-		return;
-	}
-
-	gmrf_logf(gmrf, LOG_DEBUG, "received hello with seqno %u.", ntohs(tlv_hello->seqno));
-
-	gp_babel_neigh_t *neigh = get_tlv_neigh(arg);
-
-	uint16_t seqno = ntohs(tlv_hello->seqno);
-
-	if (neigh->last_hello != gmrf_time_unspec) {
-		int timediff = (gmrf_now(gmrf) - neigh->last_hello)/10;
-		uint16_t seqexp = neigh->last_seqno + (timediff - neigh->hello_interval/2)/neigh->hello_interval;
-
-		/* cast to int16_t to ensure correct handling of seqno wrapping */
-		if (abs((int16_t)(seqno - seqexp)) > 16) {
-			gmrf_logf(gmrf, LOG_INFO, "neighbour was reset.");
-			neigh->hello_log = 0;
-			neigh->txcost = 0xffff;
-		}
-		else {
-			int16_t seqdiff = seqno - neigh->last_seqno;
-			if (seqdiff <= 0) {
-				gmrf_logf(gmrf, LOG_DEBUG, "seqno already seen, ignoring.");
-				return;
-			}
-
-			neigh->hello_log <<= seqdiff;
-		}
-	}
-	else {
-		gmrf_logf(gmrf, LOG_DEBUG, "received hello from new neighbour.");
-	}
-
-	neigh->hello_log |= 1;
-	neigh->hello_interval = ntohs(tlv_hello->interval);
-	neigh->last_seqno = seqno;
-	neigh->last_hello = gmrf_now(gmrf);
-
-	if (neigh->hello_log == 1) /* new or reset neighbour */
-		gp_babel_neigh_reset(arg->iface, neigh);
-
-	gmrf_logf(gmrf, LOG_DEBUG, "accepted hello, log %04x, rxcost is %u, cost is %u now.", neigh->hello_log, gp_babel_neigh_get_rxcost(gmrf, neigh), gp_babel_neigh_get_cost(gmrf, neigh));
-}
-
-static void handle_tlv_ihu(gmrf_t *gmrf, gmrf_context_t *ctx, const gp_babel_tlv_ihu_t *tlv_ihu, size_t len, handle_tlv_arg_t *arg) {
-	if (len < sizeof(gp_babel_tlv_ihu_t)) {
-		gmrf_logf(gmrf, LOG_WARNING, "received short IHU TLV.");
-		return;
-	}
-
-	if (tlv_ihu->ae == ADDR_ENC_GMRF) {
-		if (len < sizeof(gp_babel_tlv_ihu_t)+sizeof(gmrf_addr_t)) {
-			gmrf_logf(gmrf, LOG_WARNING, "received short IHU TLV.");
-			return;
-		}
-
-		gmrf_addr_t iface_addr = gmrf_iface_get_addr(gmrf, arg->iface->gmrf_iface);
-		if (memcmp(tlv_ihu->address, &iface_addr, sizeof(gmrf_addr_t)) != 0)
-			return;
-	}
-	else if (tlv_ihu->ae != ADDR_ENC_UNSPEC) {
-		return;
-	}
-
-	gp_babel_neigh_t *neigh = get_tlv_neigh(arg);
-	neigh->ihu_interval = ntohs(tlv_ihu->interval);
-	neigh->last_ihu = gmrf_now(gmrf);
-	neigh->txcost = ntohs(tlv_ihu->rxcost);
-
-	gmrf_logf(gmrf, LOG_DEBUG, "accepted IHU, txcost is %u, cost is %u now.", gp_babel_neigh_get_txcost(gmrf, neigh), gp_babel_neigh_get_cost(gmrf, neigh));
-}
-
-static void handle_tlv(gmrf_t *gmrf, gmrf_context_t *ctx, gp_babel_tlv_type_t type, const void *data, size_t len, void *arg) {
-	handle_tlv_arg_t *tlv_arg = arg;
-
-	switch (type) {
-	case TLV_HELLO:
-		handle_tlv_hello(gmrf, ctx, data, len, tlv_arg);
-		return;
-
-	case TLV_IHU:
-		handle_tlv_ihu(gmrf, ctx, data, len, tlv_arg);
-		return;
-
-	default:
-		gmrf_logf(gmrf, LOG_DEBUG, "received unknown TLV %u on %s.", type, gmrf_iface_get_name(gmrf, tlv_arg->iface->gmrf_iface));
-		return;
-	}
-}
-
 void gmrf_protocol_handle_packet(gmrf_t *gmrf, gmrf_context_t *ctx, gmrf_iface_t *iface, const gmrf_addr_t *source, const void *data, size_t len) {
 	const gp_babel_packet_t *packet = data;
 
-	if (len < sizeof(gp_babel_packet_t) || len < sizeof(gp_babel_packet_t)+ntohs(packet->len)) {
+	if (len < sizeof(gp_babel_packet_t) || len < gp_babel_packet_size(packet)) {
 		gmrf_logf(gmrf, LOG_DEBUG, "received short packet.");
 		return;
 	}
 
-	handle_tlv_arg_t arg = { .iface = gp_babel_get_iface(ctx, iface), .source = source };
-
-	if (!arg.iface)
+	gp_babel_iface_t *b_iface = gp_babel_get_iface(ctx, iface);
+	if (!b_iface)
 		return;
 
-	if (!gp_babel_tlv_parse(gmrf, ctx, packet, handle_tlv, &arg)) {
-		gmrf_logf(gmrf, LOG_DEBUG, "received invalid packet.");
-	}
+	gp_babel_handle_packet(gmrf, ctx, b_iface, source, packet);
 }