]>
Commit | Line | Data |
---|---|---|
f043759d RA |
1 | /* |
2 | * misc.c Miscellaneous TIPC helper functions. | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or | |
5 | * modify it under the terms of the GNU General Public License | |
6 | * as published by the Free Software Foundation; either version | |
7 | * 2 of the License, or (at your option) any later version. | |
8 | * | |
9 | * Authors: Richard Alpe <richard.alpe@ericsson.com> | |
10 | */ | |
11 | ||
12 | #include <stdio.h> | |
13 | #include <stdint.h> | |
14 | #include <linux/tipc.h> | |
725ebfbf | 15 | #include <string.h> |
5947046d JM |
16 | #include <sys/ioctl.h> |
17 | #include <sys/socket.h> | |
18 | #include <unistd.h> | |
19 | #include <errno.h> | |
f043759d RA |
20 | #include "misc.h" |
21 | ||
22 | #define IN_RANGE(val, low, high) ((val) <= (high) && (val) >= (low)) | |
23 | ||
24 | uint32_t str2addr(char *str) | |
25 | { | |
26 | unsigned int z, c, n; | |
27 | char dummy; | |
28 | ||
29 | if (sscanf(str, "%u.%u.%u%c", &z, &c, &n, &dummy) != 3) { | |
30 | fprintf(stderr, "invalid network address, syntax: Z.C.N\n"); | |
31 | return 0; | |
32 | } | |
33 | ||
34 | if (IN_RANGE(z, 0, 255) && IN_RANGE(c, 0, 4095) && IN_RANGE(n, 0, 4095)) | |
35 | return tipc_addr(z, c, n); | |
36 | ||
37 | fprintf(stderr, "invalid network address \"%s\"\n", str); | |
38 | return 0; | |
39 | } | |
725ebfbf JM |
40 | |
41 | static int is_hex(char *arr, int last) | |
42 | { | |
43 | int i; | |
44 | ||
45 | while (!arr[last]) | |
46 | last--; | |
47 | ||
48 | for (i = 0; i <= last; i++) { | |
49 | if (!IN_RANGE(arr[i], '0', '9') && | |
50 | !IN_RANGE(arr[i], 'a', 'f') && | |
51 | !IN_RANGE(arr[i], 'A', 'F')) | |
52 | return 0; | |
53 | } | |
54 | return 1; | |
55 | } | |
56 | ||
57 | static int is_name(char *arr, int last) | |
58 | { | |
59 | int i; | |
60 | char c; | |
61 | ||
62 | while (!arr[last]) | |
63 | last--; | |
64 | ||
65 | if (last > 15) | |
66 | return 0; | |
67 | ||
68 | for (i = 0; i <= last; i++) { | |
69 | c = arr[i]; | |
70 | if (!IN_RANGE(c, '0', '9') && !IN_RANGE(c, 'a', 'z') && | |
71 | !IN_RANGE(c, 'A', 'Z') && c != '-' && c != '_' && | |
72 | c != '.' && c != ':' && c != '@') | |
73 | return 0; | |
74 | } | |
75 | return 1; | |
76 | } | |
77 | ||
78 | int str2nodeid(char *str, uint8_t *id) | |
79 | { | |
80 | int len = strlen(str); | |
81 | int i; | |
82 | ||
83 | if (len > 32) | |
84 | return -1; | |
85 | ||
86 | if (is_name(str, len - 1)) { | |
87 | memcpy(id, str, len); | |
88 | return 0; | |
89 | } | |
90 | if (!is_hex(str, len - 1)) | |
91 | return -1; | |
92 | ||
93 | str[len] = '0'; | |
94 | for (i = 0; i < 16; i++) { | |
95 | if (sscanf(&str[2 * i], "%2hhx", &id[i]) != 1) | |
96 | break; | |
97 | } | |
98 | return 0; | |
99 | } | |
100 | ||
101 | void nodeid2str(uint8_t *id, char *str) | |
102 | { | |
103 | int i; | |
104 | ||
105 | if (is_name((char *)id, 15)) { | |
106 | memcpy(str, id, 16); | |
107 | return; | |
108 | } | |
109 | ||
110 | for (i = 0; i < 16; i++) | |
111 | sprintf(&str[2 * i], "%02x", id[i]); | |
112 | ||
113 | for (i = 31; str[i] == '0'; i--) | |
114 | str[i] = 0; | |
115 | } | |
5947046d JM |
116 | |
117 | void hash2nodestr(uint32_t hash, char *str) | |
118 | { | |
119 | struct tipc_sioc_nodeid_req nr = {}; | |
120 | int sd; | |
121 | ||
122 | sd = socket(AF_TIPC, SOCK_RDM, 0); | |
123 | if (sd < 0) { | |
124 | fprintf(stderr, "opening TIPC socket: %s\n", strerror(errno)); | |
125 | return; | |
126 | } | |
127 | nr.peer = hash; | |
128 | if (!ioctl(sd, SIOCGETNODEID, &nr)) | |
129 | nodeid2str((uint8_t *)nr.node_id, str); | |
130 | close(sd); | |
131 | } |