]> git.ipfire.org Git - location/libloc.git/blob - src/network.c
networks: Remove comparing family
[location/libloc.git] / src / network.c
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>
20 #include <stdio.h>
21 #include <stdlib.h>
22 #include <string.h>
23
24 #ifdef HAVE_ENDIAN_H
25 # include <endian.h>
26 #endif
27
28 #include <loc/libloc.h>
29 #include <loc/compat.h>
30 #include <loc/country.h>
31 #include <loc/network.h>
32 #include <loc/network-list.h>
33 #include <loc/private.h>
34
35 struct loc_network {
36 struct loc_ctx* ctx;
37 int refcount;
38
39 int family;
40 struct in6_addr first_address;
41 struct in6_addr last_address;
42 unsigned int prefix;
43
44 char country_code[3];
45 uint32_t asn;
46 enum loc_network_flags flags;
47 };
48
49 static 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
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
62 return 0;
63 }
64
65 static 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
71 for (int i = prefix, j = 0; i > 0; i -= 8, j++) {
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
81 static struct in6_addr make_first_address(const struct in6_addr* address, const struct in6_addr* bitmask) {
82 struct in6_addr a;
83
84 // Perform bitwise AND
85 for (unsigned int i = 0; i < 4; i++)
86 a.s6_addr32[i] = address->s6_addr32[i] & bitmask->s6_addr32[i];
87
88 return a;
89 }
90
91 static struct in6_addr make_last_address(const struct in6_addr* address, const struct in6_addr* bitmask) {
92 struct in6_addr a;
93
94 // Perform bitwise OR
95 for (unsigned int i = 0; i < 4; i++)
96 a.s6_addr32[i] = address->s6_addr32[i] | ~bitmask->s6_addr32[i];
97
98 return a;
99 }
100
101 static 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
116 LOC_EXPORT int loc_network_new(struct loc_ctx* ctx, struct loc_network** network,
117 struct in6_addr* address, unsigned int prefix) {
118 // Address cannot be unspecified
119 if (IN6_IS_ADDR_UNSPECIFIED(address)) {
120 DEBUG(ctx, "Start address is unspecified\n");
121 return -EINVAL;
122 }
123
124 // Address cannot be loopback
125 if (IN6_IS_ADDR_LOOPBACK(address)) {
126 DEBUG(ctx, "Start address is loopback address\n");
127 return -EINVAL;
128 }
129
130 // Address cannot be link-local
131 if (IN6_IS_ADDR_LINKLOCAL(address)) {
132 DEBUG(ctx, "Start address cannot be link-local\n");
133 return -EINVAL;
134 }
135
136 // Address cannot be site-local
137 if (IN6_IS_ADDR_SITELOCAL(address)) {
138 DEBUG(ctx, "Start address cannot be site-local\n");
139 return -EINVAL;
140 }
141
142 // Validate the prefix
143 if (valid_prefix(address, prefix) != 0) {
144 DEBUG(ctx, "Invalid prefix: %u\n", prefix);
145 return -EINVAL;
146 }
147
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
155 // Store the prefix
156 n->prefix = prefix;
157
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
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
171 DEBUG(n->ctx, "Network allocated at %p\n", n);
172 *network = n;
173 return 0;
174 }
175
176 LOC_EXPORT int loc_network_new_from_string(struct loc_ctx* ctx, struct loc_network** network,
177 const char* address_string) {
178 struct in6_addr first_address;
179 char* prefix_string;
180 unsigned int prefix = 128;
181 int r = -EINVAL;
182
183 DEBUG(ctx, "Attempting to parse network %s\n", address_string);
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
192 DEBUG(ctx, " Split into address = %s, prefix = %s\n", address_string, prefix_string);
193
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;
199 }
200
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 }
215
216 FAIL:
217 // Free temporary buffer
218 free(buffer);
219
220 // Exit if the parsing was unsuccessful
221 if (r)
222 return r;
223
224 // Create a new network
225 return loc_network_new(ctx, network, &first_address, prefix);
226 }
227
228 LOC_EXPORT struct loc_network* loc_network_ref(struct loc_network* network) {
229 network->refcount++;
230
231 return network;
232 }
233
234 static void loc_network_free(struct loc_network* network) {
235 DEBUG(network->ctx, "Releasing network at %p\n", network);
236
237 loc_unref(network->ctx);
238 free(network);
239 }
240
241 LOC_EXPORT struct loc_network* loc_network_unref(struct loc_network* network) {
242 if (!network)
243 return NULL;
244
245 if (--network->refcount > 0)
246 return network;
247
248 loc_network_free(network);
249 return NULL;
250 }
251
252 static 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);
254 if (!ret)
255 return -1;
256
257 return 0;
258 }
259
260 static int format_ipv4_address(const struct in6_addr* address, char* string, size_t length) {
261 struct in_addr ipv4_address;
262 ipv4_address.s_addr = address->s6_addr32[3];
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
271 LOC_EXPORT char* loc_network_str(struct loc_network* network) {
272 int r;
273 const size_t length = INET6_ADDRSTRLEN + 4;
274
275 char* string = malloc(length);
276 if (!string)
277 return NULL;
278
279 unsigned int prefix = network->prefix;
280
281 switch (network->family) {
282 case AF_INET6:
283 r = format_ipv6_address(&network->first_address, string, length);
284 break;
285
286 case AF_INET:
287 r = format_ipv4_address(&network->first_address, string, length);
288 prefix -= 96;
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));
298 free(string);
299
300 return NULL;
301 }
302
303 // Append prefix
304 sprintf(string + strlen(string), "/%u", prefix);
305
306 return string;
307 }
308
309 LOC_EXPORT int loc_network_address_family(struct loc_network* network) {
310 return network->family;
311 }
312
313 LOC_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
325 static 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
334 switch (network->family) {
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
358 LOC_EXPORT const struct in6_addr* loc_network_get_first_address(struct loc_network* network) {
359 return &network->first_address;
360 }
361
362 LOC_EXPORT char* loc_network_format_first_address(struct loc_network* network) {
363 return loc_network_format_address(network, &network->first_address);
364 }
365
366 LOC_EXPORT const struct in6_addr* loc_network_get_last_address(struct loc_network* network) {
367 return &network->last_address;
368 }
369
370 LOC_EXPORT char* loc_network_format_last_address(struct loc_network* network) {
371 return loc_network_format_address(network, &network->last_address);
372 }
373
374 LOC_EXPORT int loc_network_match_address(struct loc_network* network, const struct in6_addr* address) {
375 // Address must be larger than the start address
376 if (in6_addr_cmp(&network->first_address, address) > 0)
377 return 0;
378
379 // Address must be smaller than the last address
380 if (in6_addr_cmp(&network->last_address, address) < 0)
381 return 0;
382
383 // The address is inside this network
384 return 1;
385 }
386
387 LOC_EXPORT const char* loc_network_get_country_code(struct loc_network* network) {
388 return network->country_code;
389 }
390
391 LOC_EXPORT int loc_network_set_country_code(struct loc_network* network, const char* country_code) {
392 // Set empty country code
393 if (!country_code || !*country_code) {
394 *network->country_code = '\0';
395 return 0;
396 }
397
398 // Check country code
399 if (!loc_country_code_is_valid(country_code))
400 return -EINVAL;
401
402 loc_country_code_copy(network->country_code, country_code);
403
404 return 0;
405 }
406
407 LOC_EXPORT int loc_network_match_country_code(struct loc_network* network, const char* country_code) {
408 // Check country code
409 if (!loc_country_code_is_valid(country_code))
410 return -EINVAL;
411
412 return (network->country_code[0] == country_code[0])
413 && (network->country_code[1] == country_code[1]);
414 }
415
416 LOC_EXPORT uint32_t loc_network_get_asn(struct loc_network* network) {
417 return network->asn;
418 }
419
420 LOC_EXPORT int loc_network_set_asn(struct loc_network* network, uint32_t asn) {
421 network->asn = asn;
422
423 return 0;
424 }
425
426 LOC_EXPORT int loc_network_match_asn(struct loc_network* network, uint32_t asn) {
427 return network->asn == asn;
428 }
429
430 LOC_EXPORT int loc_network_has_flag(struct loc_network* network, uint32_t flag) {
431 return network->flags & flag;
432 }
433
434 LOC_EXPORT int loc_network_set_flag(struct loc_network* network, uint32_t flag) {
435 network->flags |= flag;
436
437 return 0;
438 }
439
440 LOC_EXPORT int loc_network_match_flag(struct loc_network* network, uint32_t flag) {
441 return loc_network_has_flag(network, flag);
442 }
443
444 LOC_EXPORT int loc_network_cmp(struct loc_network* self, struct loc_network* other) {
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
460 LOC_EXPORT int loc_network_overlaps(struct loc_network* self, struct loc_network* other) {
461 // Either of the start addresses must be in the other subnet
462 if (loc_network_match_address(self, &other->first_address))
463 return 1;
464
465 if (loc_network_match_address(other, &self->first_address))
466 return 1;
467
468 // Or either of the end addresses is in the other subnet
469 if (loc_network_match_address(self, &other->last_address))
470 return 1;
471
472 if (loc_network_match_address(other, &self->last_address))
473 return 1;
474
475 return 0;
476 }
477
478 LOC_EXPORT int loc_network_is_subnet(struct loc_network* self, struct loc_network* other) {
479 // The prefix must be smaller (this avoids the more complex comparisons later)
480 if (self->prefix > other->prefix)
481 return 0;
482
483 // If the start address of the other network is smaller than this network,
484 // it cannot be a subnet.
485 if (in6_addr_cmp(&self->first_address, &other->first_address) > 0)
486 return 0;
487
488 // If the end address of the other network is greater than this network,
489 // it cannot be a subnet.
490 if (in6_addr_cmp(&self->last_address, &other->last_address) < 0)
491 return 0;
492
493 return 1;
494 }
495
496 LOC_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;
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))
507 return -1;
508
509 // Create the first half of the network
510 r = loc_network_new(network->ctx, subnet1, &network->first_address, prefix);
511 if (r)
512 return r;
513
514 // The next subnet starts after the first one
515 struct in6_addr first_address = address_increment(&(*subnet1)->last_address);
516
517 // Create the second half of the network
518 r = loc_network_new(network->ctx, subnet2, &first_address, prefix);
519 if (r)
520 return r;
521
522 // Copy country code
523 const char* country_code = loc_network_get_country_code(network);
524 if (country_code) {
525 loc_network_set_country_code(*subnet1, country_code);
526 loc_network_set_country_code(*subnet2, country_code);
527 }
528
529 // Copy ASN
530 uint32_t asn = loc_network_get_asn(network);
531 if (asn) {
532 loc_network_set_asn(*subnet1, asn);
533 loc_network_set_asn(*subnet2, asn);
534 }
535
536 return 0;
537 }
538
539 static 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
548 if (loc_network_cmp(other, subnet1) == 0) {
549 r = loc_network_list_push(list, subnet2);
550 if (r)
551 goto ERROR;
552
553 } else if (loc_network_cmp(other, subnet2) == 0) {
554 r = loc_network_list_push(list, subnet1);
555 if (r)
556 goto ERROR;
557
558 } else if (loc_network_is_subnet(subnet1, other)) {
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
567 } else if (loc_network_is_subnet(subnet2, other)) {
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 }
581
582 ERROR:
583 if (subnet1)
584 loc_network_unref(subnet1);
585
586 if (subnet2)
587 loc_network_unref(subnet2);
588
589 return r;
590 }
591
592 static int __loc_network_exclude_to_list(struct loc_network* self,
593 struct loc_network* other, struct loc_network_list* list) {
594 // Other must be a subnet of self
595 if (!loc_network_is_subnet(self, other)) {
596 DEBUG(self->ctx, "Network %p is not contained in network %p\n", other, self);
597
598 return 1;
599 }
600
601 // We cannot perform this operation if both networks equal
602 if (loc_network_cmp(self, other) == 0) {
603 DEBUG(self->ctx, "Networks %p and %p are equal\n", self, other);
604
605 return 1;
606 }
607
608 return __loc_network_exclude(self, other, list);
609 }
610
611 LOC_EXPORT struct loc_network_list* loc_network_exclude(
612 struct loc_network* self, struct loc_network* other) {
613 struct loc_network_list* list;
614
615 #ifdef ENABLE_DEBUG
616 char* n1 = loc_network_str(self);
617 char* n2 = loc_network_str(other);
618
619 DEBUG(self->ctx, "Returning %s excluding %s...\n", n1, n2);
620
621 free(n1);
622 free(n2);
623 #endif
624
625 // Create a new list with the result
626 int r = loc_network_list_new(self->ctx, &list);
627 if (r) {
628 ERROR(self->ctx, "Could not create network list: %d\n", r);
629
630 return NULL;
631 }
632
633 r = __loc_network_exclude_to_list(self, other, list);
634 if (r) {
635 loc_network_list_unref(list);
636
637 return NULL;
638 }
639
640 // Return the result
641 return list;
642 }
643
644 LOC_EXPORT struct loc_network_list* loc_network_exclude_list(
645 struct loc_network* network, struct loc_network_list* list) {
646 struct loc_network_list* to_check;
647
648 // Create a new list with all networks to look at
649 int r = loc_network_list_new(network->ctx, &to_check);
650 if (r)
651 return NULL;
652
653 struct loc_network* subnet = NULL;
654 struct loc_network_list* subnets = NULL;
655
656 for (unsigned int i = 0; i < loc_network_list_size(list); i++) {
657 subnet = loc_network_list_get(list, i);
658
659 // Find all excluded networks
660 if (!loc_network_list_contains(to_check, subnet)) {
661 r = __loc_network_exclude_to_list(network, subnet, to_check);
662 if (r) {
663 loc_network_list_unref(to_check);
664 loc_network_unref(subnet);
665
666 return NULL;
667 }
668 }
669
670 // Cleanup
671 loc_network_unref(subnet);
672 }
673
674 r = loc_network_list_new(network->ctx, &subnets);
675 if (r) {
676 loc_network_list_unref(to_check);
677 return NULL;
678 }
679
680 while (!loc_network_list_empty(to_check)) {
681 struct loc_network* subnet_to_check = loc_network_list_pop(to_check);
682
683 // Check whether the subnet to check is part of the input list
684 if (loc_network_list_contains(list, subnet_to_check)) {
685 loc_network_unref(subnet_to_check);
686 continue;
687 }
688
689 // Marks whether this subnet passed all checks
690 int passed = 1;
691
692 for (unsigned int i = 0; i < loc_network_list_size(list); i++) {
693 subnet = loc_network_list_get(list, i);
694
695 // Drop this subnet if is a subnet of another subnet
696 if (loc_network_is_subnet(subnet_to_check, subnet)) {
697 passed = 0;
698 loc_network_unref(subnet);
699 break;
700 }
701
702 // Break it down if it overlaps
703 if (loc_network_overlaps(subnet_to_check, subnet)) {
704 passed = 0;
705
706 struct loc_network_list* excluded = loc_network_exclude(subnet_to_check, subnet);
707 if (excluded) {
708 loc_network_list_merge(to_check, excluded);
709 loc_network_list_unref(excluded);
710 }
711
712 loc_network_unref(subnet);
713 break;
714 }
715
716 loc_network_unref(subnet);
717 }
718
719 if (passed) {
720 r = loc_network_list_push(subnets, subnet_to_check);
721 }
722
723 loc_network_unref(subnet_to_check);
724 }
725
726 loc_network_list_unref(to_check);
727
728 // Sort the result
729 loc_network_list_sort(subnets);
730
731 return subnets;
732 }
733
734 LOC_EXPORT int loc_network_to_database_v1(struct loc_network* network, struct loc_database_network_v1* dbobj) {
735 // Add country code
736 loc_country_code_copy(dbobj->country_code, network->country_code);
737
738 // Add ASN
739 dbobj->asn = htobe32(network->asn);
740
741 // Flags
742 dbobj->flags = htobe16(network->flags);
743
744 return 0;
745 }
746
747 LOC_EXPORT int loc_network_new_from_database_v1(struct loc_ctx* ctx, struct loc_network** network,
748 struct in6_addr* address, unsigned int prefix, const struct loc_database_network_v1* dbobj) {
749 char country_code[3] = "\0\0";
750
751 int r = loc_network_new(ctx, network, address, prefix);
752 if (r) {
753 ERROR(ctx, "Could not allocate a new network: %s", strerror(-r));
754 return r;
755 }
756
757 // Import country code
758 loc_country_code_copy(country_code, dbobj->country_code);
759
760 r = loc_network_set_country_code(*network, country_code);
761 if (r) {
762 ERROR(ctx, "Could not set country code: %s\n", country_code);
763 return r;
764 }
765
766 // Import ASN
767 uint32_t asn = be32toh(dbobj->asn);
768 r = loc_network_set_asn(*network, asn);
769 if (r) {
770 ERROR(ctx, "Could not set ASN: %d\n", asn);
771 return r;
772 }
773
774 // Import flags
775 int flags = be16toh(dbobj->flags);
776 r = loc_network_set_flag(*network, flags);
777 if (r) {
778 ERROR(ctx, "Could not set flags: %d\n", flags);
779 return r;
780 }
781
782 return 0;
783 }
784
785 struct loc_network_tree {
786 struct loc_ctx* ctx;
787 int refcount;
788
789 struct loc_network_tree_node* root;
790 };
791
792 struct loc_network_tree_node {
793 struct loc_ctx* ctx;
794 int refcount;
795
796 struct loc_network_tree_node* zero;
797 struct loc_network_tree_node* one;
798
799 struct loc_network* network;
800 };
801
802 int loc_network_tree_new(struct loc_ctx* ctx, struct loc_network_tree** tree) {
803 struct loc_network_tree* t = calloc(1, sizeof(*t));
804 if (!t)
805 return -ENOMEM;
806
807 t->ctx = loc_ref(ctx);
808 t->refcount = 1;
809
810 // Create the root node
811 int r = loc_network_tree_node_new(ctx, &t->root);
812 if (r) {
813 loc_network_tree_unref(t);
814 return r;
815 }
816
817 DEBUG(t->ctx, "Network tree allocated at %p\n", t);
818 *tree = t;
819 return 0;
820 }
821
822 struct loc_network_tree_node* loc_network_tree_get_root(struct loc_network_tree* tree) {
823 return loc_network_tree_node_ref(tree->root);
824 }
825
826 static struct loc_network_tree_node* loc_network_tree_get_node(struct loc_network_tree_node* node, int path) {
827 struct loc_network_tree_node** n;
828
829 if (path == 0)
830 n = &node->zero;
831 else
832 n = &node->one;
833
834 // If the desired node doesn't exist, yet, we will create it
835 if (*n == NULL) {
836 int r = loc_network_tree_node_new(node->ctx, n);
837 if (r)
838 return NULL;
839 }
840
841 return *n;
842 }
843
844 static struct loc_network_tree_node* loc_network_tree_get_path(struct loc_network_tree* tree, const struct in6_addr* address, unsigned int prefix) {
845 struct loc_network_tree_node* node = tree->root;
846
847 for (unsigned int i = 0; i < prefix; i++) {
848 // Check if the ith bit is one or zero
849 node = loc_network_tree_get_node(node, in6_addr_get_bit(address, i));
850 }
851
852 return node;
853 }
854
855 static int __loc_network_tree_walk(struct loc_ctx* ctx, struct loc_network_tree_node* node,
856 int(*filter_callback)(struct loc_network* network, void* data),
857 int(*callback)(struct loc_network* network, void* data), void* data) {
858 int r;
859
860 // Finding a network ends the walk here
861 if (node->network) {
862 if (filter_callback) {
863 int f = filter_callback(node->network, data);
864 if (f < 0)
865 return f;
866
867 // Skip network if filter function returns value greater than zero
868 if (f > 0)
869 return 0;
870 }
871
872 r = callback(node->network, data);
873 if (r)
874 return r;
875 }
876
877 // Walk down on the left side of the tree first
878 if (node->zero) {
879 r = __loc_network_tree_walk(ctx, node->zero, filter_callback, callback, data);
880 if (r)
881 return r;
882 }
883
884 // Then walk on the other side
885 if (node->one) {
886 r = __loc_network_tree_walk(ctx, node->one, filter_callback, callback, data);
887 if (r)
888 return r;
889 }
890
891 return 0;
892 }
893
894 int loc_network_tree_walk(struct loc_network_tree* tree,
895 int(*filter_callback)(struct loc_network* network, void* data),
896 int(*callback)(struct loc_network* network, void* data), void* data) {
897 return __loc_network_tree_walk(tree->ctx, tree->root, filter_callback, callback, data);
898 }
899
900 static void loc_network_tree_free(struct loc_network_tree* tree) {
901 DEBUG(tree->ctx, "Releasing network tree at %p\n", tree);
902
903 loc_network_tree_node_unref(tree->root);
904
905 loc_unref(tree->ctx);
906 free(tree);
907 }
908
909 struct loc_network_tree* loc_network_tree_unref(struct loc_network_tree* tree) {
910 if (--tree->refcount > 0)
911 return tree;
912
913 loc_network_tree_free(tree);
914 return NULL;
915 }
916
917 static int __loc_network_tree_dump(struct loc_network* network, void* data) {
918 DEBUG(network->ctx, "Dumping network at %p\n", network);
919
920 char* s = loc_network_str(network);
921 if (!s)
922 return 1;
923
924 INFO(network->ctx, "%s\n", s);
925 free(s);
926
927 return 0;
928 }
929
930 int loc_network_tree_dump(struct loc_network_tree* tree) {
931 DEBUG(tree->ctx, "Dumping network tree at %p\n", tree);
932
933 return loc_network_tree_walk(tree, NULL, __loc_network_tree_dump, NULL);
934 }
935
936 int loc_network_tree_add_network(struct loc_network_tree* tree, struct loc_network* network) {
937 DEBUG(tree->ctx, "Adding network %p to tree %p\n", network, tree);
938
939 struct loc_network_tree_node* node = loc_network_tree_get_path(tree,
940 &network->first_address, network->prefix);
941 if (!node) {
942 ERROR(tree->ctx, "Could not find a node\n");
943 return -ENOMEM;
944 }
945
946 // Check if node has not been set before
947 if (node->network) {
948 DEBUG(tree->ctx, "There is already a network at this path\n");
949 return -EBUSY;
950 }
951
952 // Point node to the network
953 node->network = loc_network_ref(network);
954
955 return 0;
956 }
957
958 static int __loc_network_tree_count(struct loc_network* network, void* data) {
959 size_t* counter = (size_t*)data;
960
961 // Increase the counter for each network
962 counter++;
963
964 return 0;
965 }
966
967 size_t loc_network_tree_count_networks(struct loc_network_tree* tree) {
968 size_t counter = 0;
969
970 int r = loc_network_tree_walk(tree, NULL, __loc_network_tree_count, &counter);
971 if (r)
972 return r;
973
974 return counter;
975 }
976
977 static size_t __loc_network_tree_count_nodes(struct loc_network_tree_node* node) {
978 size_t counter = 1;
979
980 if (node->zero)
981 counter += __loc_network_tree_count_nodes(node->zero);
982
983 if (node->one)
984 counter += __loc_network_tree_count_nodes(node->one);
985
986 return counter;
987 }
988
989 size_t loc_network_tree_count_nodes(struct loc_network_tree* tree) {
990 return __loc_network_tree_count_nodes(tree->root);
991 }
992
993 int loc_network_tree_node_new(struct loc_ctx* ctx, struct loc_network_tree_node** node) {
994 struct loc_network_tree_node* n = calloc(1, sizeof(*n));
995 if (!n)
996 return -ENOMEM;
997
998 n->ctx = loc_ref(ctx);
999 n->refcount = 1;
1000
1001 n->zero = n->one = NULL;
1002
1003 DEBUG(n->ctx, "Network node allocated at %p\n", n);
1004 *node = n;
1005 return 0;
1006 }
1007
1008 struct loc_network_tree_node* loc_network_tree_node_ref(struct loc_network_tree_node* node) {
1009 if (node)
1010 node->refcount++;
1011
1012 return node;
1013 }
1014
1015 static void loc_network_tree_node_free(struct loc_network_tree_node* node) {
1016 DEBUG(node->ctx, "Releasing network node at %p\n", node);
1017
1018 if (node->network)
1019 loc_network_unref(node->network);
1020
1021 if (node->zero)
1022 loc_network_tree_node_unref(node->zero);
1023
1024 if (node->one)
1025 loc_network_tree_node_unref(node->one);
1026
1027 loc_unref(node->ctx);
1028 free(node);
1029 }
1030
1031 struct loc_network_tree_node* loc_network_tree_node_unref(struct loc_network_tree_node* node) {
1032 if (!node)
1033 return NULL;
1034
1035 if (--node->refcount > 0)
1036 return node;
1037
1038 loc_network_tree_node_free(node);
1039 return NULL;
1040 }
1041
1042 struct loc_network_tree_node* loc_network_tree_node_get(struct loc_network_tree_node* node, unsigned int index) {
1043 if (index == 0)
1044 node = node->zero;
1045 else
1046 node = node->one;
1047
1048 if (!node)
1049 return NULL;
1050
1051 return loc_network_tree_node_ref(node);
1052 }
1053
1054 int loc_network_tree_node_is_leaf(struct loc_network_tree_node* node) {
1055 return (!!node->network);
1056 }
1057
1058 struct loc_network* loc_network_tree_node_get_network(struct loc_network_tree_node* node) {
1059 return loc_network_ref(node->network);
1060 }