]> git.ipfire.org Git - location/libloc.git/blob - src/network.c
network: Call subnet function with the correct order of arguments
[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 // Exit silently
599 return 0;
600 }
601
602 // We cannot perform this operation if both networks equal
603 if (loc_network_cmp(self, other) == 0) {
604 DEBUG(self->ctx, "Networks %p and %p are equal\n", self, other);
605
606 // Exit silently
607 return 0;
608 }
609
610 return __loc_network_exclude(self, other, list);
611 }
612
613 LOC_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
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);
631
632 return NULL;
633 }
634
635 r = __loc_network_exclude_to_list(self, other, list);
636 if (r) {
637 loc_network_list_unref(list);
638
639 return NULL;
640 }
641
642 // Return the result
643 return list;
644 }
645
646 LOC_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
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 }
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
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
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
697 // Drop this subnet if is a subnet of another subnet
698 if (loc_network_is_subnet(subnet, subnet_to_check)) {
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, subnet_to_check)) {
706 passed = 0;
707
708 __loc_network_exclude_to_list(subnet_to_check, subnet, to_check);
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
726 // Sort the result
727 loc_network_list_sort(subnets);
728
729 return subnets;
730 }
731
732 LOC_EXPORT int loc_network_to_database_v1(struct loc_network* network, struct loc_database_network_v1* dbobj) {
733 // Add country code
734 loc_country_code_copy(dbobj->country_code, network->country_code);
735
736 // Add ASN
737 dbobj->asn = htobe32(network->asn);
738
739 // Flags
740 dbobj->flags = htobe16(network->flags);
741
742 return 0;
743 }
744
745 LOC_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) {
747 char country_code[3] = "\0\0";
748
749 int r = loc_network_new(ctx, network, address, prefix);
750 if (r) {
751 ERROR(ctx, "Could not allocate a new network: %s", strerror(-r));
752 return r;
753 }
754
755 // Import country code
756 loc_country_code_copy(country_code, dbobj->country_code);
757
758 r = loc_network_set_country_code(*network, country_code);
759 if (r) {
760 ERROR(ctx, "Could not set country code: %s\n", country_code);
761 return r;
762 }
763
764 // Import ASN
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);
769 return r;
770 }
771
772 // Import flags
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);
777 return r;
778 }
779
780 return 0;
781 }
782
783 struct loc_network_tree {
784 struct loc_ctx* ctx;
785 int refcount;
786
787 struct loc_network_tree_node* root;
788 };
789
790 struct loc_network_tree_node {
791 struct loc_ctx* ctx;
792 int refcount;
793
794 struct loc_network_tree_node* zero;
795 struct loc_network_tree_node* one;
796
797 struct loc_network* network;
798 };
799
800 int loc_network_tree_new(struct loc_ctx* ctx, struct loc_network_tree** tree) {
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
809 int r = loc_network_tree_node_new(ctx, &t->root);
810 if (r) {
811 loc_network_tree_unref(t);
812 return r;
813 }
814
815 DEBUG(t->ctx, "Network tree allocated at %p\n", t);
816 *tree = t;
817 return 0;
818 }
819
820 struct loc_network_tree_node* loc_network_tree_get_root(struct loc_network_tree* tree) {
821 return loc_network_tree_node_ref(tree->root);
822 }
823
824 static 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
827 if (path == 0)
828 n = &node->zero;
829 else
830 n = &node->one;
831
832 // If the desired node doesn't exist, yet, we will create it
833 if (*n == NULL) {
834 int r = loc_network_tree_node_new(node->ctx, n);
835 if (r)
836 return NULL;
837 }
838
839 return *n;
840 }
841
842 static struct loc_network_tree_node* loc_network_tree_get_path(struct loc_network_tree* tree, const struct in6_addr* address, unsigned int prefix) {
843 struct loc_network_tree_node* node = tree->root;
844
845 for (unsigned int i = 0; i < prefix; i++) {
846 // Check if the ith bit is one or zero
847 node = loc_network_tree_get_node(node, in6_addr_get_bit(address, i));
848 }
849
850 return node;
851 }
852
853 static int __loc_network_tree_walk(struct loc_ctx* ctx, struct loc_network_tree_node* node,
854 int(*filter_callback)(struct loc_network* network, void* data),
855 int(*callback)(struct loc_network* network, void* data), void* data) {
856 int r;
857
858 // Finding a network ends the walk here
859 if (node->network) {
860 if (filter_callback) {
861 int f = filter_callback(node->network, data);
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
870 r = callback(node->network, data);
871 if (r)
872 return r;
873 }
874
875 // Walk down on the left side of the tree first
876 if (node->zero) {
877 r = __loc_network_tree_walk(ctx, node->zero, filter_callback, callback, data);
878 if (r)
879 return r;
880 }
881
882 // Then walk on the other side
883 if (node->one) {
884 r = __loc_network_tree_walk(ctx, node->one, filter_callback, callback, data);
885 if (r)
886 return r;
887 }
888
889 return 0;
890 }
891
892 int loc_network_tree_walk(struct loc_network_tree* tree,
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
898 static void loc_network_tree_free(struct loc_network_tree* tree) {
899 DEBUG(tree->ctx, "Releasing network tree at %p\n", tree);
900
901 loc_network_tree_node_unref(tree->root);
902
903 loc_unref(tree->ctx);
904 free(tree);
905 }
906
907 struct loc_network_tree* loc_network_tree_unref(struct loc_network_tree* tree) {
908 if (--tree->refcount > 0)
909 return tree;
910
911 loc_network_tree_free(tree);
912 return NULL;
913 }
914
915 static int __loc_network_tree_dump(struct loc_network* network, void* data) {
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
928 int loc_network_tree_dump(struct loc_network_tree* tree) {
929 DEBUG(tree->ctx, "Dumping network tree at %p\n", tree);
930
931 return loc_network_tree_walk(tree, NULL, __loc_network_tree_dump, NULL);
932 }
933
934 int loc_network_tree_add_network(struct loc_network_tree* tree, struct loc_network* network) {
935 DEBUG(tree->ctx, "Adding network %p to tree %p\n", network, tree);
936
937 struct loc_network_tree_node* node = loc_network_tree_get_path(tree,
938 &network->first_address, network->prefix);
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");
947 return -EBUSY;
948 }
949
950 // Point node to the network
951 node->network = loc_network_ref(network);
952
953 return 0;
954 }
955
956 static 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
965 size_t loc_network_tree_count_networks(struct loc_network_tree* tree) {
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 }
974
975 static 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
987 size_t loc_network_tree_count_nodes(struct loc_network_tree* tree) {
988 return __loc_network_tree_count_nodes(tree->root);
989 }
990
991 int loc_network_tree_node_new(struct loc_ctx* ctx, struct loc_network_tree_node** node) {
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
1006 struct loc_network_tree_node* loc_network_tree_node_ref(struct loc_network_tree_node* node) {
1007 if (node)
1008 node->refcount++;
1009
1010 return node;
1011 }
1012
1013 static 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
1029 struct loc_network_tree_node* loc_network_tree_node_unref(struct loc_network_tree_node* node) {
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
1040 struct loc_network_tree_node* loc_network_tree_node_get(struct loc_network_tree_node* node, unsigned int index) {
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
1052 int loc_network_tree_node_is_leaf(struct loc_network_tree_node* node) {
1053 return (!!node->network);
1054 }
1055
1056 struct loc_network* loc_network_tree_node_get_network(struct loc_network_tree_node* node) {
1057 return loc_network_ref(node->network);
1058 }