]> git.ipfire.org Git - people/ms/libloc.git/blame - src/network.c
network: Add more excluded networks straight to the to_check list
[people/ms/libloc.git] / src / network.c
CommitLineData
3b5f4af2
MT
1/*
2 libloc - A library to determine the location of someone on the Internet
3
4 Copyright (C) 2017 IPFire Development Team <info@ipfire.org>
5
6 This library is free software; you can redistribute it and/or
7 modify it under the terms of the GNU Lesser General Public
8 License as published by the Free Software Foundation; either
9 version 2.1 of the License, or (at your option) any later version.
10
11 This library is distributed in the hope that it will be useful,
12 but WITHOUT ANY WARRANTY; without even the implied warranty of
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 Lesser General Public License for more details.
15*/
16
17#include <arpa/inet.h>
18#include <assert.h>
19#include <errno.h>
71ff3e69 20#include <stdio.h>
3b5f4af2
MT
21#include <stdlib.h>
22#include <string.h>
23
42f3ccd7
MT
24#ifdef HAVE_ENDIAN_H
25# include <endian.h>
26#endif
27
3b5f4af2 28#include <loc/libloc.h>
42f3ccd7 29#include <loc/compat.h>
57146963 30#include <loc/country.h>
3b5f4af2 31#include <loc/network.h>
e0b9ff5f 32#include <loc/network-list.h>
9fc7f001 33#include <loc/private.h>
3b5f4af2
MT
34
35struct loc_network {
36 struct loc_ctx* ctx;
37 int refcount;
38
c3068be1 39 int family;
ce4f5752 40 struct in6_addr first_address;
b43edb61 41 struct in6_addr last_address;
3b5f4af2
MT
42 unsigned int prefix;
43
44 char country_code[3];
71ff3e69 45 uint32_t asn;
a293f829 46 enum loc_network_flags flags;
3b5f4af2
MT
47};
48
6183c0f2
MT
49static int valid_prefix(struct in6_addr* address, unsigned int prefix) {
50 // The prefix cannot be larger than 128 bits
51 if (prefix > 128)
52 return 1;
53
54 // And the prefix cannot be zero
55 if (prefix == 0)
56 return 1;
57
aa37232a
MT
58 // For IPv4-mapped addresses the prefix has to be 96 or lager
59 if (IN6_IS_ADDR_V4MAPPED(address) && prefix <= 96)
60 return 1;
61
6183c0f2
MT
62 return 0;
63}
64
a82ce8bc
MT
65static struct in6_addr prefix_to_bitmask(unsigned int prefix) {
66 struct in6_addr bitmask;
67
68 for (unsigned int i = 0; i < 16; i++)
69 bitmask.s6_addr[i] = 0;
70
364a2a37 71 for (int i = prefix, j = 0; i > 0; i -= 8, j++) {
a82ce8bc
MT
72 if (i >= 8)
73 bitmask.s6_addr[j] = 0xff;
74 else
75 bitmask.s6_addr[j] = 0xff << (8 - i);
76 }
77
78 return bitmask;
79}
80
b43edb61 81static struct in6_addr make_first_address(const struct in6_addr* address, const struct in6_addr* bitmask) {
a82ce8bc 82 struct in6_addr a;
a82ce8bc
MT
83
84 // Perform bitwise AND
85 for (unsigned int i = 0; i < 4; i++)
b43edb61 86 a.s6_addr32[i] = address->s6_addr32[i] & bitmask->s6_addr32[i];
a82ce8bc
MT
87
88 return a;
89}
90
b43edb61 91static struct in6_addr make_last_address(const struct in6_addr* address, const struct in6_addr* bitmask) {
2a30e4de 92 struct in6_addr a;
2a30e4de
MT
93
94 // Perform bitwise OR
95 for (unsigned int i = 0; i < 4; i++)
b43edb61 96 a.s6_addr32[i] = address->s6_addr32[i] | ~bitmask->s6_addr32[i];
2a30e4de
MT
97
98 return a;
99}
100
850e7516
MT
101static struct in6_addr address_increment(const struct in6_addr* address) {
102 struct in6_addr a = *address;
103
104 for (int octet = 15; octet >= 0; octet--) {
105 if (a.s6_addr[octet] < 255) {
106 a.s6_addr[octet]++;
107 break;
108 } else {
109 a.s6_addr[octet] = 0;
110 }
111 }
112
113 return a;
114}
115
3b5f4af2 116LOC_EXPORT int loc_network_new(struct loc_ctx* ctx, struct loc_network** network,
10778041 117 struct in6_addr* address, unsigned int prefix) {
3b5f4af2 118 // Address cannot be unspecified
bca87342 119 if (IN6_IS_ADDR_UNSPECIFIED(address)) {
3b5f4af2
MT
120 DEBUG(ctx, "Start address is unspecified\n");
121 return -EINVAL;
122 }
123
124 // Address cannot be loopback
bca87342 125 if (IN6_IS_ADDR_LOOPBACK(address)) {
3b5f4af2
MT
126 DEBUG(ctx, "Start address is loopback address\n");
127 return -EINVAL;
128 }
129
130 // Address cannot be link-local
bca87342 131 if (IN6_IS_ADDR_LINKLOCAL(address)) {
3b5f4af2
MT
132 DEBUG(ctx, "Start address cannot be link-local\n");
133 return -EINVAL;
134 }
135
136 // Address cannot be site-local
bca87342 137 if (IN6_IS_ADDR_SITELOCAL(address)) {
3b5f4af2
MT
138 DEBUG(ctx, "Start address cannot be site-local\n");
139 return -EINVAL;
140 }
141
6183c0f2 142 // Validate the prefix
10778041 143 if (valid_prefix(address, prefix) != 0) {
6183c0f2
MT
144 DEBUG(ctx, "Invalid prefix: %u\n", prefix);
145 return -EINVAL;
146 }
147
3b5f4af2
MT
148 struct loc_network* n = calloc(1, sizeof(*n));
149 if (!n)
150 return -ENOMEM;
151
152 n->ctx = loc_ref(ctx);
153 n->refcount = 1;
154
b43edb61 155 // Store the prefix
3b5f4af2
MT
156 n->prefix = prefix;
157
b43edb61
MT
158 // Convert the prefix into a bitmask
159 struct in6_addr bitmask = prefix_to_bitmask(n->prefix);
160
161 // Store the first and last address in the network
162 n->first_address = make_first_address(address, &bitmask);
163 n->last_address = make_last_address(&n->first_address, &bitmask);
164
c3068be1
MT
165 // Set family
166 if (IN6_IS_ADDR_V4MAPPED(&n->first_address))
167 n->family = AF_INET;
168 else
169 n->family = AF_INET6;
170
3b5f4af2
MT
171 DEBUG(n->ctx, "Network allocated at %p\n", n);
172 *network = n;
173 return 0;
174}
175
176LOC_EXPORT int loc_network_new_from_string(struct loc_ctx* ctx, struct loc_network** network,
177 const char* address_string) {
ce4f5752 178 struct in6_addr first_address;
3b5f4af2 179 char* prefix_string;
26ab419b 180 unsigned int prefix = 128;
13ad6e69
MT
181 int r = -EINVAL;
182
183 DEBUG(ctx, "Attempting to parse network %s\n", address_string);
3b5f4af2
MT
184
185 // Make a copy of the string to work on it
186 char* buffer = strdup(address_string);
187 address_string = prefix_string = buffer;
188
189 // Split address and prefix
190 address_string = strsep(&prefix_string, "/");
191
13ad6e69
MT
192 DEBUG(ctx, " Split into address = %s, prefix = %s\n", address_string, prefix_string);
193
13ad6e69
MT
194 // Parse the address
195 r = loc_parse_address(ctx, address_string, &first_address);
196 if (r) {
197 DEBUG(ctx, "The address could not be parsed\n");
198 goto FAIL;
b61f14fc 199 }
3b5f4af2 200
26ab419b
MT
201 // If a prefix was given, we will try to parse it
202 if (prefix_string) {
203 // Convert prefix to integer
204 prefix = strtol(prefix_string, NULL, 10);
205
206 if (!prefix) {
207 DEBUG(ctx, "The prefix was not parsable: %s\n", prefix_string);
208 goto FAIL;
209 }
210
211 // Map the prefix to IPv6 if needed
212 if (IN6_IS_ADDR_V4MAPPED(&first_address))
213 prefix += 96;
214 }
13ad6e69
MT
215
216FAIL:
3b5f4af2
MT
217 // Free temporary buffer
218 free(buffer);
219
13ad6e69
MT
220 // Exit if the parsing was unsuccessful
221 if (r)
222 return r;
223
13ad6e69
MT
224 // Create a new network
225 return loc_network_new(ctx, network, &first_address, prefix);
3b5f4af2
MT
226}
227
228LOC_EXPORT struct loc_network* loc_network_ref(struct loc_network* network) {
229 network->refcount++;
230
231 return network;
232}
233
234static void loc_network_free(struct loc_network* network) {
235 DEBUG(network->ctx, "Releasing network at %p\n", network);
236
3b5f4af2
MT
237 loc_unref(network->ctx);
238 free(network);
239}
240
241LOC_EXPORT struct loc_network* loc_network_unref(struct loc_network* network) {
2a30e4de
MT
242 if (!network)
243 return NULL;
244
3b5f4af2
MT
245 if (--network->refcount > 0)
246 return network;
247
248 loc_network_free(network);
249 return NULL;
250}
251
8fb874e9
MT
252static int format_ipv6_address(const struct in6_addr* address, char* string, size_t length) {
253 const char* ret = inet_ntop(AF_INET6, address, string, length);
d3409788
MT
254 if (!ret)
255 return -1;
256
257 return 0;
258}
259
8fb874e9 260static int format_ipv4_address(const struct in6_addr* address, char* string, size_t length) {
d3409788 261 struct in_addr ipv4_address;
8fb874e9 262 ipv4_address.s_addr = address->s6_addr32[3];
d3409788
MT
263
264 const char* ret = inet_ntop(AF_INET, &ipv4_address, string, length);
265 if (!ret)
266 return -1;
267
268 return 0;
269}
270
3b5f4af2 271LOC_EXPORT char* loc_network_str(struct loc_network* network) {
d3409788
MT
272 int r;
273 const size_t length = INET6_ADDRSTRLEN + 4;
3b5f4af2 274
d3409788 275 char* string = malloc(length);
3b5f4af2
MT
276 if (!string)
277 return NULL;
278
aa37232a
MT
279 unsigned int prefix = network->prefix;
280
c3068be1 281 switch (network->family) {
d3409788 282 case AF_INET6:
ce4f5752 283 r = format_ipv6_address(&network->first_address, string, length);
d3409788 284 break;
3b5f4af2 285
d3409788 286 case AF_INET:
ce4f5752 287 r = format_ipv4_address(&network->first_address, string, length);
aa37232a 288 prefix -= 96;
d3409788
MT
289 break;
290
291 default:
292 r = -1;
293 break;
294 }
295
296 if (r) {
297 ERROR(network->ctx, "Could not convert network to string: %s\n", strerror(errno));
3b5f4af2 298 free(string);
d3409788 299
3b5f4af2
MT
300 return NULL;
301 }
302
303 // Append prefix
aa37232a 304 sprintf(string + strlen(string), "/%u", prefix);
3b5f4af2
MT
305
306 return string;
307}
308
44e5ef71 309LOC_EXPORT int loc_network_address_family(struct loc_network* network) {
c3068be1 310 return network->family;
44e5ef71
MT
311}
312
7fe6a218
MT
313LOC_EXPORT unsigned int loc_network_prefix(struct loc_network* network) {
314 switch (network->family) {
315 case AF_INET6:
316 return network->prefix;
317
318 case AF_INET:
319 return network->prefix - 96;
320 }
321
322 return 0;
323}
324
2b9338ea
MT
325static char* loc_network_format_address(struct loc_network* network, const struct in6_addr* address) {
326 const size_t length = INET6_ADDRSTRLEN;
327
328 char* string = malloc(length);
329 if (!string)
330 return NULL;
331
332 int r = 0;
333
c3068be1 334 switch (network->family) {
2b9338ea
MT
335 case AF_INET6:
336 r = format_ipv6_address(address, string, length);
337 break;
338
339 case AF_INET:
340 r = format_ipv4_address(address, string, length);
341 break;
342
343 default:
344 r = -1;
345 break;
346 }
347
348 if (r) {
349 ERROR(network->ctx, "Could not format IP address to string: %s\n", strerror(errno));
350 free(string);
351
352 return NULL;
353 }
354
355 return string;
356}
357
a1a00053
MT
358LOC_EXPORT const struct in6_addr* loc_network_get_first_address(struct loc_network* network) {
359 return &network->first_address;
360}
361
2b9338ea
MT
362LOC_EXPORT char* loc_network_format_first_address(struct loc_network* network) {
363 return loc_network_format_address(network, &network->first_address);
364}
365
a1a00053
MT
366LOC_EXPORT const struct in6_addr* loc_network_get_last_address(struct loc_network* network) {
367 return &network->last_address;
368}
369
2b9338ea
MT
370LOC_EXPORT char* loc_network_format_last_address(struct loc_network* network) {
371 return loc_network_format_address(network, &network->last_address);
372}
373
2a30e4de 374LOC_EXPORT int loc_network_match_address(struct loc_network* network, const struct in6_addr* address) {
f50adb09 375 // Address must be larger than the start address
ce4f5752 376 if (in6_addr_cmp(&network->first_address, address) > 0)
fc692a58 377 return 0;
2a30e4de 378
2a30e4de 379 // Address must be smaller than the last address
b43edb61 380 if (in6_addr_cmp(&network->last_address, address) < 0)
fc692a58 381 return 0;
2a30e4de
MT
382
383 // The address is inside this network
fc692a58 384 return 1;
2a30e4de
MT
385}
386
3b5f4af2
MT
387LOC_EXPORT const char* loc_network_get_country_code(struct loc_network* network) {
388 return network->country_code;
389}
390
391LOC_EXPORT int loc_network_set_country_code(struct loc_network* network, const char* country_code) {
901ef882
MT
392 // Set empty country code
393 if (!country_code || !*country_code) {
394 *network->country_code = '\0';
395 return 0;
396 }
397
57146963
MT
398 // Check country code
399 if (!loc_country_code_is_valid(country_code))
3b5f4af2
MT
400 return -EINVAL;
401
a7a3d958 402 loc_country_code_copy(network->country_code, country_code);
3b5f4af2
MT
403
404 return 0;
405}
406
e3f696c1 407LOC_EXPORT int loc_network_match_country_code(struct loc_network* network, const char* country_code) {
57146963
MT
408 // Check country code
409 if (!loc_country_code_is_valid(country_code))
e3f696c1
MT
410 return -EINVAL;
411
412 return (network->country_code[0] == country_code[0])
413 && (network->country_code[1] == country_code[1]);
414}
415
71ff3e69
MT
416LOC_EXPORT uint32_t loc_network_get_asn(struct loc_network* network) {
417 return network->asn;
418}
419
420LOC_EXPORT int loc_network_set_asn(struct loc_network* network, uint32_t asn) {
421 network->asn = asn;
422
423 return 0;
424}
425
82910b95
MT
426LOC_EXPORT int loc_network_match_asn(struct loc_network* network, uint32_t asn) {
427 return network->asn == asn;
428}
429
a99e7c2b
MT
430LOC_EXPORT int loc_network_has_flag(struct loc_network* network, uint32_t flag) {
431 return network->flags & flag;
432}
433
434LOC_EXPORT int loc_network_set_flag(struct loc_network* network, uint32_t flag) {
435 network->flags |= flag;
436
437 return 0;
438}
439
440LOC_EXPORT int loc_network_match_flag(struct loc_network* network, uint32_t flag) {
441 return loc_network_has_flag(network, flag);
442}
443
af4689bf 444LOC_EXPORT int loc_network_cmp(struct loc_network* self, struct loc_network* other) {
af4689bf
MT
445 // Compare address
446 int r = in6_addr_cmp(&self->first_address, &other->first_address);
447 if (r)
448 return r;
449
450 // Compare prefix
451 if (self->prefix > other->prefix)
452 return 1;
453 else if (self->prefix < other->prefix)
454 return -1;
455
456 // Both networks are equal
457 return 0;
458}
459
6159d384 460LOC_EXPORT int loc_network_overlaps(struct loc_network* self, struct loc_network* other) {
fc692a58
MT
461 // Either of the start addresses must be in the other subnet
462 if (loc_network_match_address(self, &other->first_address))
6159d384
MT
463 return 1;
464
fc692a58 465 if (loc_network_match_address(other, &self->first_address))
6159d384
MT
466 return 1;
467
fc692a58
MT
468 // Or either of the end addresses is in the other subnet
469 if (loc_network_match_address(self, &other->last_address))
6159d384
MT
470 return 1;
471
fc692a58 472 if (loc_network_match_address(other, &self->last_address))
6159d384
MT
473 return 1;
474
475 return 0;
476}
477
33a051e0 478LOC_EXPORT int loc_network_is_subnet(struct loc_network* self, struct loc_network* other) {
cf8d3c64
MT
479 // The prefix must be smaller (this avoids the more complex comparisons later)
480 if (self->prefix > other->prefix)
481 return 0;
482
33a051e0
MT
483 // If the start address of the other network is smaller than this network,
484 // it cannot be a subnet.
1209ff0c 485 if (in6_addr_cmp(&self->first_address, &other->first_address) > 0)
33a051e0
MT
486 return 0;
487
488 // If the end address of the other network is greater than this network,
489 // it cannot be a subnet.
1209ff0c 490 if (in6_addr_cmp(&self->last_address, &other->last_address) < 0)
33a051e0
MT
491 return 0;
492
493 return 1;
494}
495
a5967330
MT
496LOC_EXPORT int loc_network_subnets(struct loc_network* network,
497 struct loc_network** subnet1, struct loc_network** subnet2) {
498 int r;
499 *subnet1 = NULL;
500 *subnet2 = NULL;
850e7516
MT
501
502 // New prefix length
503 unsigned int prefix = network->prefix + 1;
504
505 // Check if the new prefix is valid
506 if (valid_prefix(&network->first_address, prefix))
a5967330 507 return -1;
850e7516
MT
508
509 // Create the first half of the network
a5967330 510 r = loc_network_new(network->ctx, subnet1, &network->first_address, prefix);
850e7516 511 if (r)
a5967330 512 return r;
850e7516
MT
513
514 // The next subnet starts after the first one
a5967330 515 struct in6_addr first_address = address_increment(&(*subnet1)->last_address);
850e7516
MT
516
517 // Create the second half of the network
a5967330 518 r = loc_network_new(network->ctx, subnet2, &first_address, prefix);
850e7516 519 if (r)
a5967330 520 return r;
850e7516 521
594ca328
MT
522 // Copy country code
523 const char* country_code = loc_network_get_country_code(network);
524 if (country_code) {
a5967330
MT
525 loc_network_set_country_code(*subnet1, country_code);
526 loc_network_set_country_code(*subnet2, country_code);
594ca328
MT
527 }
528
529 // Copy ASN
530 uint32_t asn = loc_network_get_asn(network);
531 if (asn) {
a5967330
MT
532 loc_network_set_asn(*subnet1, asn);
533 loc_network_set_asn(*subnet2, asn);
594ca328
MT
534 }
535
a5967330
MT
536 return 0;
537}
850e7516 538
a5967330
MT
539static int __loc_network_exclude(struct loc_network* network,
540 struct loc_network* other, struct loc_network_list* list) {
541 struct loc_network* subnet1 = NULL;
542 struct loc_network* subnet2 = NULL;
543
544 int r = loc_network_subnets(network, &subnet1, &subnet2);
545 if (r)
546 goto ERROR;
547
da101d55 548 if (loc_network_cmp(other, subnet1) == 0) {
a5967330
MT
549 r = loc_network_list_push(list, subnet2);
550 if (r)
551 goto ERROR;
552
da101d55 553 } else if (loc_network_cmp(other, subnet2) == 0) {
a5967330
MT
554 r = loc_network_list_push(list, subnet1);
555 if (r)
556 goto ERROR;
557
d6a5092f 558 } else if (loc_network_is_subnet(subnet1, other)) {
a5967330
MT
559 r = loc_network_list_push(list, subnet2);
560 if (r)
561 goto ERROR;
562
563 r = __loc_network_exclude(subnet1, other, list);
564 if (r)
565 goto ERROR;
566
d6a5092f 567 } else if (loc_network_is_subnet(subnet2, other)) {
a5967330
MT
568 r = loc_network_list_push(list, subnet1);
569 if (r)
570 goto ERROR;
571
572 r = __loc_network_exclude(subnet2, other, list);
573 if (r)
574 goto ERROR;
575
576 } else {
577 ERROR(network->ctx, "We should never get here\n");
578 r = 1;
579 goto ERROR;
580 }
850e7516
MT
581
582ERROR:
583 if (subnet1)
584 loc_network_unref(subnet1);
585
586 if (subnet2)
587 loc_network_unref(subnet2);
588
a5967330 589 return r;
850e7516
MT
590}
591
c650008e
MT
592static int __loc_network_exclude_to_list(struct loc_network* self,
593 struct loc_network* other, struct loc_network_list* list) {
850e7516 594 // Other must be a subnet of self
d6a5092f 595 if (!loc_network_is_subnet(self, other)) {
850e7516
MT
596 DEBUG(self->ctx, "Network %p is not contained in network %p\n", other, self);
597
abf55926
MT
598 // Exit silently
599 return 0;
850e7516
MT
600 }
601
602 // We cannot perform this operation if both networks equal
da101d55 603 if (loc_network_cmp(self, other) == 0) {
850e7516
MT
604 DEBUG(self->ctx, "Networks %p and %p are equal\n", self, other);
605
abf55926
MT
606 // Exit silently
607 return 0;
850e7516
MT
608 }
609
c650008e
MT
610 return __loc_network_exclude(self, other, list);
611}
612
613LOC_EXPORT struct loc_network_list* loc_network_exclude(
614 struct loc_network* self, struct loc_network* other) {
615 struct loc_network_list* list;
616
617#ifdef ENABLE_DEBUG
618 char* n1 = loc_network_str(self);
619 char* n2 = loc_network_str(other);
620
621 DEBUG(self->ctx, "Returning %s excluding %s...\n", n1, n2);
622
623 free(n1);
624 free(n2);
625#endif
626
850e7516
MT
627 // Create a new list with the result
628 int r = loc_network_list_new(self->ctx, &list);
629 if (r) {
630 ERROR(self->ctx, "Could not create network list: %d\n", r);
c650008e 631
850e7516
MT
632 return NULL;
633 }
634
c650008e 635 r = __loc_network_exclude_to_list(self, other, list);
a5967330
MT
636 if (r) {
637 loc_network_list_unref(list);
850e7516 638
a5967330 639 return NULL;
850e7516
MT
640 }
641
850e7516
MT
642 // Return the result
643 return list;
850e7516
MT
644}
645
add5bb65
MT
646LOC_EXPORT struct loc_network_list* loc_network_exclude_list(
647 struct loc_network* network, struct loc_network_list* list) {
648 struct loc_network_list* to_check;
649
650 // Create a new list with all networks to look at
651 int r = loc_network_list_new(network->ctx, &to_check);
652 if (r)
653 return NULL;
654
655 struct loc_network* subnet = NULL;
656 struct loc_network_list* subnets = NULL;
657
658 for (unsigned int i = 0; i < loc_network_list_size(list); i++) {
659 subnet = loc_network_list_get(list, i);
660
661 // Find all excluded networks
c650008e
MT
662 if (!loc_network_list_contains(to_check, subnet)) {
663 r = __loc_network_exclude_to_list(network, subnet, to_check);
664 if (r) {
665 loc_network_list_unref(to_check);
666 loc_network_unref(subnet);
667
668 return NULL;
669 }
add5bb65
MT
670 }
671
672 // Cleanup
673 loc_network_unref(subnet);
674 }
675
676 r = loc_network_list_new(network->ctx, &subnets);
677 if (r) {
678 loc_network_list_unref(to_check);
679 return NULL;
680 }
681
682 while (!loc_network_list_empty(to_check)) {
683 struct loc_network* subnet_to_check = loc_network_list_pop(to_check);
684
06177d8c
MT
685 // Check whether the subnet to check is part of the input list
686 if (loc_network_list_contains(list, subnet_to_check)) {
687 loc_network_unref(subnet_to_check);
688 continue;
689 }
690
add5bb65
MT
691 // Marks whether this subnet passed all checks
692 int passed = 1;
693
694 for (unsigned int i = 0; i < loc_network_list_size(list); i++) {
695 subnet = loc_network_list_get(list, i);
696
add5bb65 697 // Drop this subnet if is a subnet of another subnet
d6a5092f 698 if (loc_network_is_subnet(subnet_to_check, subnet)) {
add5bb65
MT
699 passed = 0;
700 loc_network_unref(subnet);
701 break;
702 }
703
704 // Break it down if it overlaps
705 if (loc_network_overlaps(subnet_to_check, subnet)) {
706 passed = 0;
707
4fc034e2 708 __loc_network_exclude_to_list(subnet_to_check, subnet, to_check);
add5bb65
MT
709
710 loc_network_unref(subnet);
711 break;
712 }
713
714 loc_network_unref(subnet);
715 }
716
717 if (passed) {
718 r = loc_network_list_push(subnets, subnet_to_check);
719 }
720
721 loc_network_unref(subnet_to_check);
722 }
723
724 loc_network_list_unref(to_check);
725
d3375368
MT
726 // Sort the result
727 loc_network_list_sort(subnets);
728
add5bb65
MT
729 return subnets;
730}
731
b904896a 732LOC_EXPORT int loc_network_to_database_v1(struct loc_network* network, struct loc_database_network_v1* dbobj) {
f3e02bc5 733 // Add country code
a7a3d958 734 loc_country_code_copy(dbobj->country_code, network->country_code);
f3e02bc5
MT
735
736 // Add ASN
71ff3e69 737 dbobj->asn = htobe32(network->asn);
f3e02bc5 738
a99e7c2b 739 // Flags
eee6346d 740 dbobj->flags = htobe16(network->flags);
a99e7c2b 741
f3e02bc5
MT
742 return 0;
743}
744
b904896a
MT
745LOC_EXPORT int loc_network_new_from_database_v1(struct loc_ctx* ctx, struct loc_network** network,
746 struct in6_addr* address, unsigned int prefix, const struct loc_database_network_v1* dbobj) {
3dc8adfb 747 char country_code[3] = "\0\0";
a7a3d958 748
39a55353 749 int r = loc_network_new(ctx, network, address, prefix);
94a3f329
MT
750 if (r) {
751 ERROR(ctx, "Could not allocate a new network: %s", strerror(-r));
10778041 752 return r;
94a3f329 753 }
10778041
MT
754
755 // Import country code
a7a3d958 756 loc_country_code_copy(country_code, dbobj->country_code);
10778041
MT
757
758 r = loc_network_set_country_code(*network, country_code);
94a3f329
MT
759 if (r) {
760 ERROR(ctx, "Could not set country code: %s\n", country_code);
10778041 761 return r;
94a3f329 762 }
10778041
MT
763
764 // Import ASN
94a3f329
MT
765 uint32_t asn = be32toh(dbobj->asn);
766 r = loc_network_set_asn(*network, asn);
767 if (r) {
768 ERROR(ctx, "Could not set ASN: %d\n", asn);
10778041 769 return r;
94a3f329 770 }
10778041 771
a99e7c2b 772 // Import flags
94a3f329
MT
773 int flags = be16toh(dbobj->flags);
774 r = loc_network_set_flag(*network, flags);
775 if (r) {
776 ERROR(ctx, "Could not set flags: %d\n", flags);
a99e7c2b 777 return r;
94a3f329 778 }
a99e7c2b 779
10778041
MT
780 return 0;
781}
782
3b5f4af2
MT
783struct loc_network_tree {
784 struct loc_ctx* ctx;
785 int refcount;
786
787 struct loc_network_tree_node* root;
788};
789
790struct loc_network_tree_node {
438db08c
MT
791 struct loc_ctx* ctx;
792 int refcount;
793
3b5f4af2
MT
794 struct loc_network_tree_node* zero;
795 struct loc_network_tree_node* one;
796
797 struct loc_network* network;
798};
799
7933f5bf 800int loc_network_tree_new(struct loc_ctx* ctx, struct loc_network_tree** tree) {
3b5f4af2
MT
801 struct loc_network_tree* t = calloc(1, sizeof(*t));
802 if (!t)
803 return -ENOMEM;
804
805 t->ctx = loc_ref(ctx);
806 t->refcount = 1;
807
808 // Create the root node
438db08c
MT
809 int r = loc_network_tree_node_new(ctx, &t->root);
810 if (r) {
811 loc_network_tree_unref(t);
812 return r;
813 }
3b5f4af2
MT
814
815 DEBUG(t->ctx, "Network tree allocated at %p\n", t);
816 *tree = t;
817 return 0;
818}
819
7933f5bf 820struct loc_network_tree_node* loc_network_tree_get_root(struct loc_network_tree* tree) {
438db08c 821 return loc_network_tree_node_ref(tree->root);
3b5f4af2
MT
822}
823
824static struct loc_network_tree_node* loc_network_tree_get_node(struct loc_network_tree_node* node, int path) {
825 struct loc_network_tree_node** n;
826
2a30e4de 827 if (path == 0)
3b5f4af2 828 n = &node->zero;
3eda9cab
MT
829 else
830 n = &node->one;
3b5f4af2
MT
831
832 // If the desired node doesn't exist, yet, we will create it
833 if (*n == NULL) {
438db08c 834 int r = loc_network_tree_node_new(node->ctx, n);
3b5f4af2
MT
835 if (r)
836 return NULL;
837 }
838
839 return *n;
840}
841
39a55353 842static struct loc_network_tree_node* loc_network_tree_get_path(struct loc_network_tree* tree, const struct in6_addr* address, unsigned int prefix) {
3b5f4af2
MT
843 struct loc_network_tree_node* node = tree->root;
844
39a55353 845 for (unsigned int i = 0; i < prefix; i++) {
3b5f4af2 846 // Check if the ith bit is one or zero
2a30e4de 847 node = loc_network_tree_get_node(node, in6_addr_get_bit(address, i));
3b5f4af2
MT
848 }
849
850 return node;
851}
852
853static int __loc_network_tree_walk(struct loc_ctx* ctx, struct loc_network_tree_node* node,
f3e02bc5
MT
854 int(*filter_callback)(struct loc_network* network, void* data),
855 int(*callback)(struct loc_network* network, void* data), void* data) {
3b5f4af2
MT
856 int r;
857
858 // Finding a network ends the walk here
859 if (node->network) {
860 if (filter_callback) {
f3e02bc5 861 int f = filter_callback(node->network, data);
3b5f4af2
MT
862 if (f < 0)
863 return f;
864
865 // Skip network if filter function returns value greater than zero
866 if (f > 0)
867 return 0;
868 }
869
f3e02bc5 870 r = callback(node->network, data);
3b5f4af2
MT
871 if (r)
872 return r;
873 }
874
875 // Walk down on the left side of the tree first
876 if (node->zero) {
f3e02bc5 877 r = __loc_network_tree_walk(ctx, node->zero, filter_callback, callback, data);
3b5f4af2
MT
878 if (r)
879 return r;
880 }
881
882 // Then walk on the other side
883 if (node->one) {
f3e02bc5 884 r = __loc_network_tree_walk(ctx, node->one, filter_callback, callback, data);
3b5f4af2
MT
885 if (r)
886 return r;
887 }
888
889 return 0;
890}
891
7933f5bf 892int loc_network_tree_walk(struct loc_network_tree* tree,
f3e02bc5
MT
893 int(*filter_callback)(struct loc_network* network, void* data),
894 int(*callback)(struct loc_network* network, void* data), void* data) {
895 return __loc_network_tree_walk(tree->ctx, tree->root, filter_callback, callback, data);
896}
897
3b5f4af2
MT
898static void loc_network_tree_free(struct loc_network_tree* tree) {
899 DEBUG(tree->ctx, "Releasing network tree at %p\n", tree);
900
438db08c 901 loc_network_tree_node_unref(tree->root);
3b5f4af2
MT
902
903 loc_unref(tree->ctx);
904 free(tree);
905}
906
7933f5bf 907struct loc_network_tree* loc_network_tree_unref(struct loc_network_tree* tree) {
3b5f4af2
MT
908 if (--tree->refcount > 0)
909 return tree;
910
911 loc_network_tree_free(tree);
912 return NULL;
913}
914
e9b4e2a8 915static int __loc_network_tree_dump(struct loc_network* network, void* data) {
3b5f4af2
MT
916 DEBUG(network->ctx, "Dumping network at %p\n", network);
917
918 char* s = loc_network_str(network);
919 if (!s)
920 return 1;
921
922 INFO(network->ctx, "%s\n", s);
923 free(s);
924
925 return 0;
926}
927
7933f5bf 928int loc_network_tree_dump(struct loc_network_tree* tree) {
3b5f4af2
MT
929 DEBUG(tree->ctx, "Dumping network tree at %p\n", tree);
930
f3e02bc5 931 return loc_network_tree_walk(tree, NULL, __loc_network_tree_dump, NULL);
3b5f4af2
MT
932}
933
7933f5bf 934int loc_network_tree_add_network(struct loc_network_tree* tree, struct loc_network* network) {
3b5f4af2
MT
935 DEBUG(tree->ctx, "Adding network %p to tree %p\n", network, tree);
936
39a55353 937 struct loc_network_tree_node* node = loc_network_tree_get_path(tree,
ce4f5752 938 &network->first_address, network->prefix);
3b5f4af2
MT
939 if (!node) {
940 ERROR(tree->ctx, "Could not find a node\n");
941 return -ENOMEM;
942 }
943
944 // Check if node has not been set before
945 if (node->network) {
946 DEBUG(tree->ctx, "There is already a network at this path\n");
c04005bb 947 return -EBUSY;
3b5f4af2
MT
948 }
949
950 // Point node to the network
951 node->network = loc_network_ref(network);
952
953 return 0;
954}
f3e02bc5
MT
955
956static int __loc_network_tree_count(struct loc_network* network, void* data) {
957 size_t* counter = (size_t*)data;
958
959 // Increase the counter for each network
960 counter++;
961
962 return 0;
963}
964
7933f5bf 965size_t loc_network_tree_count_networks(struct loc_network_tree* tree) {
f3e02bc5
MT
966 size_t counter = 0;
967
968 int r = loc_network_tree_walk(tree, NULL, __loc_network_tree_count, &counter);
969 if (r)
970 return r;
971
972 return counter;
973}
940f9c2b
MT
974
975static size_t __loc_network_tree_count_nodes(struct loc_network_tree_node* node) {
976 size_t counter = 1;
977
978 if (node->zero)
979 counter += __loc_network_tree_count_nodes(node->zero);
980
981 if (node->one)
982 counter += __loc_network_tree_count_nodes(node->one);
983
984 return counter;
985}
986
7933f5bf 987size_t loc_network_tree_count_nodes(struct loc_network_tree* tree) {
940f9c2b
MT
988 return __loc_network_tree_count_nodes(tree->root);
989}
438db08c 990
7933f5bf 991int loc_network_tree_node_new(struct loc_ctx* ctx, struct loc_network_tree_node** node) {
438db08c
MT
992 struct loc_network_tree_node* n = calloc(1, sizeof(*n));
993 if (!n)
994 return -ENOMEM;
995
996 n->ctx = loc_ref(ctx);
997 n->refcount = 1;
998
999 n->zero = n->one = NULL;
1000
1001 DEBUG(n->ctx, "Network node allocated at %p\n", n);
1002 *node = n;
1003 return 0;
1004}
1005
7933f5bf 1006struct loc_network_tree_node* loc_network_tree_node_ref(struct loc_network_tree_node* node) {
438db08c
MT
1007 if (node)
1008 node->refcount++;
1009
1010 return node;
1011}
1012
1013static void loc_network_tree_node_free(struct loc_network_tree_node* node) {
1014 DEBUG(node->ctx, "Releasing network node at %p\n", node);
1015
1016 if (node->network)
1017 loc_network_unref(node->network);
1018
1019 if (node->zero)
1020 loc_network_tree_node_unref(node->zero);
1021
1022 if (node->one)
1023 loc_network_tree_node_unref(node->one);
1024
1025 loc_unref(node->ctx);
1026 free(node);
1027}
1028
7933f5bf 1029struct loc_network_tree_node* loc_network_tree_node_unref(struct loc_network_tree_node* node) {
438db08c
MT
1030 if (!node)
1031 return NULL;
1032
1033 if (--node->refcount > 0)
1034 return node;
1035
1036 loc_network_tree_node_free(node);
1037 return NULL;
1038}
1039
7933f5bf 1040struct loc_network_tree_node* loc_network_tree_node_get(struct loc_network_tree_node* node, unsigned int index) {
438db08c
MT
1041 if (index == 0)
1042 node = node->zero;
1043 else
1044 node = node->one;
1045
1046 if (!node)
1047 return NULL;
1048
1049 return loc_network_tree_node_ref(node);
1050}
1051
7933f5bf 1052int loc_network_tree_node_is_leaf(struct loc_network_tree_node* node) {
438db08c
MT
1053 return (!!node->network);
1054}
1055
7933f5bf 1056struct loc_network* loc_network_tree_node_get_network(struct loc_network_tree_node* node) {
438db08c
MT
1057 return loc_network_ref(node->network);
1058}