Blame tipc/misc.c

Packit d3f73b
/*
Packit d3f73b
 * misc.c	Miscellaneous TIPC helper functions.
Packit d3f73b
 *
Packit d3f73b
 *		This program is free software; you can redistribute it and/or
Packit d3f73b
 *		modify it under the terms of the GNU General Public License
Packit d3f73b
 *		as published by the Free Software Foundation; either version
Packit d3f73b
 *		2 of the License, or (at your option) any later version.
Packit d3f73b
 *
Packit d3f73b
 * Authors:	Richard Alpe <richard.alpe@ericsson.com>
Packit d3f73b
 */
Packit d3f73b
Packit d3f73b
#include <stdio.h>
Packit d3f73b
#include <stdint.h>
Packit d3f73b
#include <linux/tipc.h>
Packit d3f73b
#include <string.h>
Packit d3f73b
#include <sys/ioctl.h>
Packit d3f73b
#include <sys/socket.h>
Packit d3f73b
#include <unistd.h>
Packit d3f73b
#include <errno.h>
Packit d3f73b
#include "misc.h"
Packit d3f73b
Packit d3f73b
#define IN_RANGE(val, low, high) ((val) <= (high) && (val) >= (low))
Packit d3f73b
Packit d3f73b
uint32_t str2addr(char *str)
Packit d3f73b
{
Packit d3f73b
	unsigned int z, c, n;
Packit d3f73b
	char dummy;
Packit d3f73b
Packit d3f73b
	if (sscanf(str, "%u.%u.%u%c", &z, &c, &n, &dummy) != 3) {
Packit d3f73b
		fprintf(stderr, "invalid network address, syntax: Z.C.N\n");
Packit d3f73b
		return 0;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (IN_RANGE(z, 0, 255) && IN_RANGE(c, 0, 4095) && IN_RANGE(n, 0, 4095))
Packit d3f73b
		return tipc_addr(z, c, n);
Packit d3f73b
Packit d3f73b
	fprintf(stderr, "invalid network address \"%s\"\n", str);
Packit d3f73b
	return 0;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int is_hex(char *arr, int last)
Packit d3f73b
{
Packit d3f73b
	int i;
Packit d3f73b
Packit d3f73b
	while (!arr[last])
Packit d3f73b
		last--;
Packit d3f73b
Packit d3f73b
	for (i = 0; i <= last; i++) {
Packit d3f73b
		if (!IN_RANGE(arr[i], '0', '9') &&
Packit d3f73b
		    !IN_RANGE(arr[i], 'a', 'f') &&
Packit d3f73b
		    !IN_RANGE(arr[i], 'A', 'F'))
Packit d3f73b
			return 0;
Packit d3f73b
	}
Packit d3f73b
	return 1;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int is_name(char *arr, int last)
Packit d3f73b
{
Packit d3f73b
	int i;
Packit d3f73b
	char c;
Packit d3f73b
Packit d3f73b
	while (!arr[last])
Packit d3f73b
		last--;
Packit d3f73b
Packit d3f73b
	if (last > 15)
Packit d3f73b
		return 0;
Packit d3f73b
Packit d3f73b
	for (i = 0; i <= last; i++) {
Packit d3f73b
		c = arr[i];
Packit d3f73b
		if (!IN_RANGE(c, '0', '9') && !IN_RANGE(c, 'a', 'z') &&
Packit d3f73b
		    !IN_RANGE(c, 'A', 'Z') && c != '-' && c != '_' &&
Packit d3f73b
		    c != '.' && c != ':' && c != '@')
Packit d3f73b
			return 0;
Packit d3f73b
	}
Packit d3f73b
	return 1;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
int str2nodeid(char *str, uint8_t *id)
Packit d3f73b
{
Packit d3f73b
	int len = strlen(str);
Packit d3f73b
	int i;
Packit d3f73b
Packit d3f73b
	if (len > 32)
Packit d3f73b
		return -1;
Packit d3f73b
Packit d3f73b
	if (is_name(str, len - 1)) {
Packit d3f73b
		memcpy(id, str, len);
Packit d3f73b
		return 0;
Packit d3f73b
	}
Packit d3f73b
	if (!is_hex(str, len - 1))
Packit d3f73b
		return -1;
Packit d3f73b
Packit d3f73b
	str[len] = '0';
Packit d3f73b
	for (i = 0; i < 16; i++) {
Packit d3f73b
		if (sscanf(&str[2 * i], "%2hhx", &id[i]) != 1)
Packit d3f73b
			break;
Packit d3f73b
	}
Packit d3f73b
	return 0;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
void nodeid2str(uint8_t *id, char *str)
Packit d3f73b
{
Packit d3f73b
	int i;
Packit d3f73b
Packit d3f73b
	if (is_name((char *)id, 15)) {
Packit d3f73b
		memcpy(str, id, 16);
Packit d3f73b
		return;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	for (i = 0; i < 16; i++)
Packit d3f73b
		sprintf(&str[2 * i], "%02x", id[i]);
Packit d3f73b
Packit d3f73b
	for (i = 31; str[i] == '0'; i--)
Packit d3f73b
		str[i] = 0;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
void hash2nodestr(uint32_t hash, char *str)
Packit d3f73b
{
Packit d3f73b
	struct tipc_sioc_nodeid_req nr = {};
Packit d3f73b
	int sd;
Packit d3f73b
Packit d3f73b
	sd = socket(AF_TIPC, SOCK_RDM, 0);
Packit d3f73b
	if (sd < 0) {
Packit d3f73b
		fprintf(stderr, "opening TIPC socket: %s\n", strerror(errno));
Packit d3f73b
		return;
Packit d3f73b
	}
Packit d3f73b
	nr.peer = hash;
Packit d3f73b
	if (!ioctl(sd, SIOCGETNODEID, &nr))
Packit d3f73b
		nodeid2str((uint8_t *)nr.node_id, str);
Packit d3f73b
	close(sd);
Packit d3f73b
}