1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
|
#include <stdlib.h>
#include <string.h>
#include "list.h"
#include "log.h"
#include "pingu_route.h"
static void pingu_route_add_sorted(struct list_head *route_list,
struct pingu_route *new_gw)
{
struct pingu_route *gw;
list_for_each_entry(gw, route_list, route_list_entry) {
if (gw->metric > new_gw->metric) {
list_add_tail(&new_gw->route_list_entry,
&gw->route_list_entry);
return;
}
}
list_add_tail(&new_gw->route_list_entry, route_list);
}
static struct pingu_route *pingu_route_clone(struct pingu_route *gw)
{
struct pingu_route *new_gw = calloc(1, sizeof(struct pingu_route));
if (gw == NULL) {
log_perror("Failed to allocate gateway");
return NULL;
}
/* copy the fields without overwriting the list entry */
memcpy(&new_gw->dest, &gw->dest, sizeof(new_gw->dest));
memcpy(&new_gw->gw_addr, &gw->gw_addr, sizeof(new_gw->gw_addr));
new_gw->dst_len = gw->dst_len;
new_gw->src_len = gw->src_len;
new_gw->metric = gw->metric;
new_gw->protocol = gw->protocol;
new_gw->scope = gw->scope;
new_gw->type = gw->type;
return new_gw;
}
static void log_debug_gw(char *msg, struct pingu_route *gw)
{
char destbuf[64], gwaddrbuf[64];
log_debug("%s: %s/%i via %s metric %i", msg,
sockaddr_to_string(&gw->dest, destbuf, sizeof(destbuf)),
gw->dst_len,
sockaddr_to_string(&gw->gw_addr, gwaddrbuf, sizeof(gwaddrbuf)),
gw->metric);
}
static int gateway_cmp(struct pingu_route *a, struct pingu_route *b)
{
int r;
if (a->dst_len != b->dst_len)
return a->dst_len - b->dst_len;
r = sockaddr_cmp(&a->dest, &b->dest);
if (r != 0)
return r;
r = sockaddr_cmp(&a->gw_addr, &b->gw_addr);
if (r != 0)
return r;
return a->metric - b->metric;
}
static struct pingu_route *pingu_route_get(struct list_head *route_list,
struct pingu_route *gw)
{
struct pingu_route *entry;
list_for_each_entry(entry, route_list, route_list_entry) {
if (gateway_cmp(entry, gw) == 0)
return entry;
}
return NULL;
}
void pingu_route_del_all(struct list_head *head)
{
struct pingu_route *gw, *n;
list_for_each_entry_safe(gw, n, head, route_list_entry) {
list_del(&gw->route_list_entry);
free(gw);
}
}
void pingu_route_add(struct list_head *route_list,
struct pingu_route *gw)
{
struct pingu_route *new_gw = pingu_route_clone(gw);
if (new_gw == NULL)
return;
pingu_route_add_sorted(route_list, new_gw);
}
void pingu_route_del(struct list_head *route_list,
struct pingu_route *delete)
{
struct pingu_route *gw = pingu_route_get(route_list, delete);
if (gw == NULL)
return;
log_debug_gw("removed", gw);
list_del(&gw->route_list_entry);
free(gw);
}
int is_default_gw(struct pingu_route *route)
{
switch (route->dest.sa.sa_family) {
case AF_INET:
return ((route->dest.sin.sin_addr.s_addr == 0)
&& (route->gw_addr.sin.sin_addr.s_addr != 0));
break;
case AF_INET6:
log_debug("TODO: ipv6");
break;
}
return 0;
}
struct pingu_route *pingu_route_first_default(struct list_head *route_list)
{
struct pingu_route *entry;
list_for_each_entry(entry, route_list, route_list_entry) {
if (is_default_gw(entry))
return entry;
}
return NULL;
}
void pingu_route_cleanup(struct list_head *route_list)
{
struct pingu_route *entry, *n;
list_for_each_entry_safe(entry, n, route_list, route_list_entry) {
list_del(&entry->route_list_entry);
free(entry);
}
}
|
