protocol.c

/*
  ISC License

  Copyright (c) 2016-2017, Jo-Philipp Wich <jo@mein.io>

  Permission to use, copy, modify, and/or distribute this software for any
  purpose with or without fee is hereby granted, provided that the above
  copyright notice and this permission notice appear in all copies.

  THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH
  REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY
  AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
  INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM
  LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE
  OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  PERFORMANCE OF THIS SOFTWARE.
*/

#include <stdio.h>
#include <errno.h>
#include <string.h>

#include <libubox/utils.h>

#include "protocol.h"
#include "nlbwmon.h"

static int
avl_cmp_proto(const void *k1, const void *k2, void *ptr)
{
	return memcmp(k1, k2, offsetof(struct protocol, idx));
}

static AVL_TREE(protocols, avl_cmp_proto, false, NULL);

int
init_protocols(const char *database)
{
	char *p = NULL, buf[PR_NAMELEN];
	struct protocol *pr;
	uint16_t idx = 0;
	uint16_t port;
	uint8_t proto;
	FILE *in;

	in = fopen(opt.protocol_db, "r");

	if (!in)
		return -errno;

	while (fscanf(in, PR_SCANFMT, &proto, &port, buf) == 3)
	{
		if (!buf[0])
			continue;

		if (!p || strcmp(p, buf))
			idx++;

		pr = calloc_a(sizeof(*pr), &p, strlen(buf) + 1);

		if (!pr) {
			fclose(in);
			return -ENOMEM;
		}

		pr->proto = proto;
		pr->port = port;
		pr->idx = idx;
		pr->name = strcpy(p, buf);
		pr->node.key = pr;

		avl_insert(&protocols, &pr->node);
	}

	fclose(in);
	return 0;
}

struct protocol *
lookup_protocol(uint8_t proto, uint16_t port)
{
	struct protocol *pr, key = { };

	key.proto = proto;
	key.port = port;

	return avl_find_element(&protocols, &key, pr, node);
}