15263807472

/* SPDX-License-Identifier: LGPL-2.1-or-later */

#include <net/ethernet.h>
#include <stdio.h>

#include "ether-addr-util.h"
#include "hash-funcs.h"
#include "hexdecoct.h"
#include "in-addr-util.h"
#include "memory-util.h"
#include "siphash24.h"
#include "string-util.h"

char* hw_addr_to_string_full(
                const struct hw_addr_data *addr,
                HardwareAddressToStringFlags flags,
                char buffer[static HW_ADDR_TO_STRING_MAX]) {

        assert(addr);
        assert(buffer);
        assert(addr->length <= HW_ADDR_MAX_SIZE);

        for (size_t i = 0, j = 0; i < addr->length; i++) {
                buffer[j++] = hexchar(addr->bytes[i] >> 4);
                buffer[j++] = hexchar(addr->bytes[i] & 0x0f);
                if (!FLAGS_SET(flags, HW_ADDR_TO_STRING_NO_COLON))
                        buffer[j++] = ':';
        }

        buffer[addr->length == 0 || FLAGS_SET(flags, HW_ADDR_TO_STRING_NO_COLON) ?
               addr->length * 2 :
               addr->length * 3 - 1] = '\0';
        return buffer;
}

struct hw_addr_data *hw_addr_set(struct hw_addr_data *addr, const uint8_t *bytes, size_t length) {
        assert(addr);
        assert(length <= HW_ADDR_MAX_SIZE);

        addr->length = length;
        memcpy_safe(addr->bytes, bytes, length);
        return addr;
}

int hw_addr_compare(const struct hw_addr_data *a, const struct hw_addr_data *b) {
        int r;

        assert(a);
        assert(b);

        r = CMP(a->length, b->length);
        if (r != 0)
                return r;

        return memcmp(a->bytes, b->bytes, a->length);
}

void hw_addr_hash_func(const struct hw_addr_data *p, struct siphash *state) {
        assert(p);
        assert(state);

        siphash24_compress_typesafe(p->length, state);
        siphash24_compress_safe(p->bytes, p->length, state);
}

bool hw_addr_is_null(const struct hw_addr_data *addr) {
        assert(addr);
        return addr->length == 0 || memeqzero(addr->bytes, addr->length);
}

DEFINE_HASH_OPS(hw_addr_hash_ops, struct hw_addr_data, hw_addr_hash_func, hw_addr_compare);
DEFINE_HASH_OPS_WITH_KEY_DESTRUCTOR(hw_addr_hash_ops_free, struct hw_addr_data, hw_addr_hash_func, hw_addr_compare, free);

char* ether_addr_to_string(const struct ether_addr *addr, char buffer[ETHER_ADDR_TO_STRING_MAX]) {
        assert(addr);
        assert(buffer);

        /* Like ether_ntoa() but uses %02x instead of %x to print
         * ethernet addresses, which makes them look less funny. Also,
         * doesn't use a static buffer. */

        sprintf(buffer, "%02x:%02x:%02x:%02x:%02x:%02x",
                addr->ether_addr_octet[0],
                addr->ether_addr_octet[1],
                addr->ether_addr_octet[2],
                addr->ether_addr_octet[3],
                addr->ether_addr_octet[4],
                addr->ether_addr_octet[5]);

        return buffer;
}

int ether_addr_compare(const struct ether_addr *a, const struct ether_addr *b) {
        return memcmp(a, b, ETH_ALEN);
}

static void ether_addr_hash_func(const struct ether_addr *p, struct siphash *state) {
        siphash24_compress_typesafe(*p, state);
}

bool ether_addr_is_broadcast(const struct ether_addr *addr) {
        assert(addr);
        return memeqbyte(0xff, addr->ether_addr_octet, ETH_ALEN);
}

DEFINE_HASH_OPS(ether_addr_hash_ops, struct ether_addr, ether_addr_hash_func, ether_addr_compare);
DEFINE_HASH_OPS_WITH_KEY_DESTRUCTOR(ether_addr_hash_ops_free, struct ether_addr, ether_addr_hash_func, ether_addr_compare, free);

static int parse_hw_addr_one_field(const char **s, char sep, size_t len, uint8_t *buf) {
        const char *hex = HEXDIGITS, *p;
        uint16_t data = 0;
        bool cont;

        assert(s);
        assert(*s);
        assert(IN_SET(len, 1, 2));
        assert(buf);

        p = *s;

        for (size_t i = 0; i < len * 2; i++) {
                const char *hexoff;
                size_t x;

                if (*p == '\0' || *p == sep) {
                        if (i == 0)
                                return -EINVAL;
                        break;
                }

                hexoff = strchr(hex, *p);
                if (!hexoff)
                        return -EINVAL;

                assert(hexoff >= hex);
                x = hexoff - hex;
                if (x >= 16)
                        x -= 6; /* A-F */

                assert(x < 16);
                data <<= 4;
                data += x;

                p++;
        }

        if (*p != '\0' && *p != sep)
                return -EINVAL;

        switch (len) {
        case 1:
                buf[0] = data;
                break;
        case 2:
                buf[0] = (data & 0xff00) >> 8;
                buf[1] = data & 0xff;
                break;
        default:
                assert_not_reached();
        }

        cont = *p == sep;
        *s = p + cont;
        return cont;
}

int parse_hw_addr_full(const char *s, size_t expected_len, struct hw_addr_data *ret) {
        size_t field_size, max_len, len = 0;
        uint8_t bytes[HW_ADDR_MAX_SIZE];
        char sep;
        int r;

        assert(s);
        assert(expected_len <= HW_ADDR_MAX_SIZE || expected_len == SIZE_MAX);
        assert(ret);

        /* This accepts the following formats:
         *
         * Dot separated 2 bytes format: xxyy.zzaa.bbcc
         * Colon separated 1 bytes format: xx:yy:zz:aa:bb:cc
         * Hyphen separated 1 bytes format: xx-yy-zz-aa-bb-cc
         *
         * Moreover, if expected_len == 0, 4, or 16, this also accepts:
         *
         * IPv4 format: used by IPv4 tunnel, e.g. ipgre
         * IPv6 format: used by IPv6 tunnel, e.g. ip6gre
         *
         * The expected_len argument controls the length of acceptable addresses:
         *
         * 0: accepts 4 (AF_INET), 16 (AF_INET6), 6 (ETH_ALEN), or 20 (INFINIBAND_ALEN).
         * SIZE_MAX: accepts arbitrary length, but at least one separator must be included.
         * Otherwise: accepts addresses with matching length.
         */

        if (IN_SET(expected_len, 0, sizeof(struct in_addr), sizeof(struct in6_addr))) {
                union in_addr_union a;
                int family;

                if (expected_len == 0)
                        r = in_addr_from_string_auto(s, &family, &a);
                else {
                        family = expected_len == sizeof(struct in_addr) ? AF_INET : AF_INET6;
                        r = in_addr_from_string(family, s, &a);
                }
                if (r >= 0) {
                        ret->length = FAMILY_ADDRESS_SIZE(family);
                        memcpy(ret->bytes, a.bytes, ret->length);
                        return 0;
                }
        }

        max_len =
                expected_len == 0 ? INFINIBAND_ALEN :
                expected_len == SIZE_MAX ? HW_ADDR_MAX_SIZE : expected_len;
        sep = s[strspn(s, HEXDIGITS)];

        if (sep == '.')
                field_size = 2;
        else if (IN_SET(sep, ':', '-'))
                field_size = 1;
        else
                return -EINVAL;

        if (max_len % field_size != 0)
                return -EINVAL;

        for (size_t i = 0; i < max_len / field_size; i++) {
                r = parse_hw_addr_one_field(&s, sep, field_size, bytes + i * field_size);
                if (r < 0)
                        return r;
                if (r == 0) {
                        len = (i + 1) * field_size;
                        break;
                }
        }

        if (len == 0)
                return -EINVAL;

        if (expected_len == 0) {
                if (!IN_SET(len, 4, 16, ETH_ALEN, INFINIBAND_ALEN))
                        return -EINVAL;
        } else if (expected_len != SIZE_MAX) {
                if (len != expected_len)
                        return -EINVAL;
        }

        ret->length = len;
        memcpy(ret->bytes, bytes, ret->length);
        return 0;
}

int parse_ether_addr(const char *s, struct ether_addr *ret) {
        struct hw_addr_data a;
        int r;

        assert(s);
        assert(ret);

        r = parse_hw_addr_full(s, ETH_ALEN, &a);
        if (r < 0)
                return r;

        *ret = a.ether;
        return 0;
}

void ether_addr_mark_random(struct ether_addr *addr) {
        assert(addr);

        /* see eth_random_addr in the kernel */
        addr->ether_addr_octet[0] &= 0xfe;        /* clear multicast bit */
        addr->ether_addr_octet[0] |= 0x02;        /* set local assignment bit (IEEE802) */
}

1	/* SPDX-License-Identifier: LGPL-2.1-or-later */
2
3	#include <net/ethernet.h>
4	#include <stdio.h>
5
6	#include "ether-addr-util.h"
7	#include "hash-funcs.h"
8	#include "hexdecoct.h"
9	#include "in-addr-util.h"
10	#include "memory-util.h"
11	#include "siphash24.h"
12	#include "string-util.h"
13
14	char* hw_addr_to_string_full(	7,307✔
15	const struct hw_addr_data *addr,
16	HardwareAddressToStringFlags flags,
17	char buffer[static HW_ADDR_TO_STRING_MAX]) {
18
19	assert(addr);	7,307✔
20	assert(buffer);	7,307✔
21	assert(addr->length <= HW_ADDR_MAX_SIZE);	7,307✔
22
23	for (size_t i = 0, j = 0; i < addr->length; i++) {	53,045✔
24	buffer[j++] = hexchar(addr->bytes[i] >> 4);	45,738✔
25	buffer[j++] = hexchar(addr->bytes[i] & 0x0f);	45,738✔
26	if (!FLAGS_SET(flags, HW_ADDR_TO_STRING_NO_COLON))	45,738✔
27	buffer[j++] = ':';	45,708✔
28	}
29
30	buffer[addr->length == 0 \|\| FLAGS_SET(flags, HW_ADDR_TO_STRING_NO_COLON) ?	7,307✔
31	addr->length * 2 :	7,312✔
32	addr->length * 3 - 1] = '\0';	7,302✔
33	return buffer;	7,307✔
34	}
35
36	struct hw_addr_data hw_addr_set(struct hw_addr_data addr, const uint8_t *bytes, size_t length) {	250✔
37	assert(addr);	250✔
38	assert(length <= HW_ADDR_MAX_SIZE);	250✔
39
40	addr->length = length;	250✔
41	memcpy_safe(addr->bytes, bytes, length);	250✔
42	return addr;	250✔
43	}
44
45	int hw_addr_compare(const struct hw_addr_data a, const struct hw_addr_data b) {	12,432✔
46	int r;	12,432✔
47
48	assert(a);	12,432✔
49	assert(b);	12,432✔
50
51	r = CMP(a->length, b->length);	12,432✔
52	if (r != 0)	9,431✔
53	return r;	3,844✔
54
55	return memcmp(a->bytes, b->bytes, a->length);	8,588✔
56	}
57
58	void hw_addr_hash_func(const struct hw_addr_data p, struct siphash state) {	2,228✔
59	assert(p);	2,228✔
60	assert(state);	2,228✔
61
62	siphash24_compress_typesafe(p->length, state);	2,228✔
63	siphash24_compress_safe(p->bytes, p->length, state);	2,228✔
64	}	2,228✔
65
66	bool hw_addr_is_null(const struct hw_addr_data *addr) {	5,716✔
67	assert(addr);	5,716✔
68	return addr->length == 0 \|\| memeqzero(addr->bytes, addr->length);	5,716✔
69	}
70
71	DEFINE_HASH_OPS(hw_addr_hash_ops, struct hw_addr_data, hw_addr_hash_func, hw_addr_compare);
72	DEFINE_HASH_OPS_WITH_KEY_DESTRUCTOR(hw_addr_hash_ops_free, struct hw_addr_data, hw_addr_hash_func, hw_addr_compare, free);	17✔
73
74	char* ether_addr_to_string(const struct ether_addr *addr, char buffer[ETHER_ADDR_TO_STRING_MAX]) {	29✔
75	assert(addr);	29✔
76	assert(buffer);	29✔
77
78	/* Like ether_ntoa() but uses %02x instead of %x to print
79	* ethernet addresses, which makes them look less funny. Also,
80	* doesn't use a static buffer. */
81
82	sprintf(buffer, "%02x:%02x:%02x:%02x:%02x:%02x",	29✔
83	addr->ether_addr_octet[0],	29✔
84	addr->ether_addr_octet[1],	29✔
85	addr->ether_addr_octet[2],	29✔
86	addr->ether_addr_octet[3],	29✔
87	addr->ether_addr_octet[4],	29✔
88	addr->ether_addr_octet[5]);	29✔
89
90	return buffer;	29✔
91	}
92
93	int ether_addr_compare(const struct ether_addr a, const struct ether_addr b) {	12,651✔
94	return memcmp(a, b, ETH_ALEN);	12,651✔
95	}
96
97	static void ether_addr_hash_func(const struct ether_addr p, struct siphash state) {	37✔
98	siphash24_compress_typesafe(*p, state);	37✔
99	}	37✔
100
101	bool ether_addr_is_broadcast(const struct ether_addr *addr) {	1,240✔
102	assert(addr);	1,240✔
103	return memeqbyte(0xff, addr->ether_addr_octet, ETH_ALEN);	1,240✔
104	}
105
106	DEFINE_HASH_OPS(ether_addr_hash_ops, struct ether_addr, ether_addr_hash_func, ether_addr_compare);
107	DEFINE_HASH_OPS_WITH_KEY_DESTRUCTOR(ether_addr_hash_ops_free, struct ether_addr, ether_addr_hash_func, ether_addr_compare, free);	3✔
108
109	static int parse_hw_addr_one_field(const char *s, char sep, size_t len, uint8_t buf) {	3,862✔
110	const char hex = HEXDIGITS, p;	3,862✔
111	uint16_t data = 0;	3,862✔
112	bool cont;	3,862✔
113
114	assert(s);	3,862✔
115	assert(*s);	3,862✔
116	assert(IN_SET(len, 1, 2));	3,862✔
117	assert(buf);	3,862✔
118
119	p = *s;
120
121	for (size_t i = 0; i < len * 2; i++) {	11,646✔
122	const char *hexoff;	7,859✔
123	size_t x;	7,859✔
124
125	if (p == '\0' \|\| p == sep) {	7,859✔
126	if (i == 0)	68✔
127	return -EINVAL;
128	break;
129	}
130
131	hexoff = strchr(hex, *p);	7,791✔
132	if (!hexoff)	7,791✔
133	return -EINVAL;
134
135	assert(hexoff >= hex);	7,784✔
136	x = hexoff - hex;	7,784✔
137	if (x >= 16)	7,784✔
138	x -= 6; /* A-F */	70✔
139
140	assert(x < 16);	70✔
141	data <<= 4;	7,784✔
142	data += x;	7,784✔
143
144	p++;	7,784✔
145	}
146
147	if (p != '\0' && p != sep)	3,847✔
148	return -EINVAL;
149
150	switch (len) {	3,834✔
151	case 1:	3,741✔
152	buf[0] = data;	3,741✔
153	break;	3,741✔
154	case 2:	93✔
155	buf[0] = (data & 0xff00) >> 8;	93✔
156	buf[1] = data & 0xff;	93✔
157	break;	93✔
UNCOV 158	default:	×
UNCOV 159	assert_not_reached();	×
160	}
161
162	cont = *p == sep;	3,834✔
163	*s = p + cont;	3,834✔
164	return cont;	3,834✔
165	}
166
167	int parse_hw_addr_full(const char s, size_t expected_len, struct hw_addr_data ret) {	718✔
168	size_t field_size, max_len, len = 0;	718✔
169	uint8_t bytes[HW_ADDR_MAX_SIZE];	718✔
170	char sep;	718✔
171	int r;	718✔
172
173	assert(s);	718✔
174	assert(expected_len <= HW_ADDR_MAX_SIZE \|\| expected_len == SIZE_MAX);	718✔
175	assert(ret);	718✔
176
177	/* This accepts the following formats:
178	*
179	* Dot separated 2 bytes format: xxyy.zzaa.bbcc
180	* Colon separated 1 bytes format: xx:yy:zz:aa:bb:cc
181	* Hyphen separated 1 bytes format: xx-yy-zz-aa-bb-cc
182	*
183	* Moreover, if expected_len == 0, 4, or 16, this also accepts:
184	*
185	* IPv4 format: used by IPv4 tunnel, e.g. ipgre
186	* IPv6 format: used by IPv6 tunnel, e.g. ip6gre
187	*
188	* The expected_len argument controls the length of acceptable addresses:
189	*
190	* 0: accepts 4 (AF_INET), 16 (AF_INET6), 6 (ETH_ALEN), or 20 (INFINIBAND_ALEN).
191	* SIZE_MAX: accepts arbitrary length, but at least one separator must be included.
192	* Otherwise: accepts addresses with matching length.
193	*/
194
195	if (IN_SET(expected_len, 0, sizeof(struct in_addr), sizeof(struct in6_addr))) {	718✔
196	union in_addr_union a;	93✔
197	int family;	93✔
198
199	if (expected_len == 0)	93✔
200	r = in_addr_from_string_auto(s, &family, &a);	80✔
201	else {
202	family = expected_len == sizeof(struct in_addr) ? AF_INET : AF_INET6;	13✔
203	r = in_addr_from_string(family, s, &a);	13✔
204	}
205	if (r >= 0) {	93✔
206	ret->length = FAMILY_ADDRESS_SIZE(family);	30✔
207	memcpy(ret->bytes, a.bytes, ret->length);	30✔
208	return 0;	30✔
209	}
210	}
211
212	max_len =	28✔
213	expected_len == 0 ? INFINIBAND_ALEN :	688✔
214	expected_len == SIZE_MAX ? HW_ADDR_MAX_SIZE : expected_len;	627✔
215	sep = s[strspn(s, HEXDIGITS)];	688✔
216
217	if (sep == '.')	688✔
218	field_size = 2;
219	else if (IN_SET(sep, ':', '-'))	650✔
220	field_size = 1;
221	else
222	return -EINVAL;
223
224	if (max_len % field_size != 0)	677✔
225	return -EINVAL;
226
227	for (size_t i = 0; i < max_len / field_size; i++) {	3,870✔
228	r = parse_hw_addr_one_field(&s, sep, field_size, bytes + i * field_size);	3,862✔
229	if (r < 0)	3,862✔
230	return r;
231	if (r == 0) {	3,834✔
232	len = (i + 1) * field_size;	641✔
233	break;	641✔
234	}
235	}
236
237	if (len == 0)	649✔
238	return -EINVAL;
239
240	if (expected_len == 0) {	641✔
241	if (!IN_SET(len, 4, 16, ETH_ALEN, INFINIBAND_ALEN))	61✔
242	return -EINVAL;
243	} else if (expected_len != SIZE_MAX) {	580✔
244	if (len != expected_len)	567✔
245	return -EINVAL;
246	}
247
248	ret->length = len;	630✔
249	memcpy(ret->bytes, bytes, ret->length);	630✔
250	return 0;	630✔
251	}
252
253	int parse_ether_addr(const char s, struct ether_addr ret) {	123✔
254	struct hw_addr_data a;	123✔
255	int r;	123✔
256
257	assert(s);	123✔
258	assert(ret);	123✔
259
260	r = parse_hw_addr_full(s, ETH_ALEN, &a);	123✔
261	if (r < 0)	123✔
262	return r;	123✔
263
264	*ret = a.ether;	85✔
265	return 0;	85✔
266	}
267
268	void ether_addr_mark_random(struct ether_addr *addr) {	76✔
269	assert(addr);	76✔
270
271	/* see eth_random_addr in the kernel */
272	addr->ether_addr_octet[0] &= 0xfe; /* clear multicast bit */	76✔
273	addr->ether_addr_octet[0] \|= 0x02; /* set local assignment bit (IEEE802) */	76✔
274	}	76✔

systemd / systemd / 15263807472

Source File Press 'n' to go to next uncovered line, 'b' for previous

Source File
Press 'n' to go to next uncovered line, 'b' for previous