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