1 | /* vi: set sw=4 ts=4: */
|
---|
2 | /*
|
---|
3 | * Russ Dill <Russ.Dill@asu.edu> July 2001
|
---|
4 | *
|
---|
5 | * Licensed under GPLv2, see file LICENSE in this source tree.
|
---|
6 | */
|
---|
7 | #include "common.h"
|
---|
8 | #include "dhcpd.h"
|
---|
9 |
|
---|
10 | /* Find the oldest expired lease, NULL if there are no expired leases */
|
---|
11 | static struct dyn_lease *oldest_expired_lease(void)
|
---|
12 | {
|
---|
13 | struct dyn_lease *oldest_lease = NULL;
|
---|
14 | leasetime_t oldest_time = time(NULL);
|
---|
15 | unsigned i;
|
---|
16 |
|
---|
17 | /* Unexpired leases have g_leases[i].expires >= current time
|
---|
18 | * and therefore can't ever match */
|
---|
19 | for (i = 0; i < server_config.max_leases; i++) {
|
---|
20 | if (g_leases[i].expires < oldest_time) {
|
---|
21 | oldest_time = g_leases[i].expires;
|
---|
22 | oldest_lease = &g_leases[i];
|
---|
23 | }
|
---|
24 | }
|
---|
25 | return oldest_lease;
|
---|
26 | }
|
---|
27 |
|
---|
28 | /* Clear out all leases with matching nonzero chaddr OR yiaddr.
|
---|
29 | * If chaddr == NULL, this is a conflict lease.
|
---|
30 | */
|
---|
31 | static void clear_leases(const uint8_t *chaddr, uint32_t yiaddr)
|
---|
32 | {
|
---|
33 | unsigned i;
|
---|
34 |
|
---|
35 | for (i = 0; i < server_config.max_leases; i++) {
|
---|
36 | if ((chaddr && memcmp(g_leases[i].lease_mac, chaddr, 6) == 0)
|
---|
37 | || (yiaddr && g_leases[i].lease_nip == yiaddr)
|
---|
38 | ) {
|
---|
39 | memset(&g_leases[i], 0, sizeof(g_leases[i]));
|
---|
40 | }
|
---|
41 | }
|
---|
42 | }
|
---|
43 |
|
---|
44 | /* Add a lease into the table, clearing out any old ones.
|
---|
45 | * If chaddr == NULL, this is a conflict lease.
|
---|
46 | */
|
---|
47 | struct dyn_lease* FAST_FUNC add_lease(
|
---|
48 | const uint8_t *chaddr, uint32_t yiaddr,
|
---|
49 | leasetime_t leasetime,
|
---|
50 | const char *hostname, int hostname_len)
|
---|
51 | {
|
---|
52 | struct dyn_lease *oldest;
|
---|
53 |
|
---|
54 | /* clean out any old ones */
|
---|
55 | clear_leases(chaddr, yiaddr);
|
---|
56 |
|
---|
57 | oldest = oldest_expired_lease();
|
---|
58 |
|
---|
59 | if (oldest) {
|
---|
60 | memset(oldest, 0, sizeof(*oldest));
|
---|
61 | if (hostname) {
|
---|
62 | char *p;
|
---|
63 |
|
---|
64 | hostname_len++; /* include NUL */
|
---|
65 | if (hostname_len > sizeof(oldest->hostname))
|
---|
66 | hostname_len = sizeof(oldest->hostname);
|
---|
67 | p = safe_strncpy(oldest->hostname, hostname, hostname_len);
|
---|
68 | /* sanitization (s/non-ASCII/^/g) */
|
---|
69 | while (*p) {
|
---|
70 | if (*p < ' ' || *p > 126)
|
---|
71 | *p = '^';
|
---|
72 | p++;
|
---|
73 | }
|
---|
74 | }
|
---|
75 | if (chaddr)
|
---|
76 | memcpy(oldest->lease_mac, chaddr, 6);
|
---|
77 | oldest->lease_nip = yiaddr;
|
---|
78 | oldest->expires = time(NULL) + leasetime;
|
---|
79 | }
|
---|
80 |
|
---|
81 | return oldest;
|
---|
82 | }
|
---|
83 |
|
---|
84 | /* True if a lease has expired */
|
---|
85 | int FAST_FUNC is_expired_lease(struct dyn_lease *lease)
|
---|
86 | {
|
---|
87 | return (lease->expires < (leasetime_t) time(NULL));
|
---|
88 | }
|
---|
89 |
|
---|
90 | /* Find the first lease that matches MAC, NULL if no match */
|
---|
91 | struct dyn_lease* FAST_FUNC find_lease_by_mac(const uint8_t *mac)
|
---|
92 | {
|
---|
93 | unsigned i;
|
---|
94 |
|
---|
95 | for (i = 0; i < server_config.max_leases; i++)
|
---|
96 | if (memcmp(g_leases[i].lease_mac, mac, 6) == 0)
|
---|
97 | return &g_leases[i];
|
---|
98 |
|
---|
99 | return NULL;
|
---|
100 | }
|
---|
101 |
|
---|
102 | /* Find the first lease that matches IP, NULL is no match */
|
---|
103 | struct dyn_lease* FAST_FUNC find_lease_by_nip(uint32_t nip)
|
---|
104 | {
|
---|
105 | unsigned i;
|
---|
106 |
|
---|
107 | for (i = 0; i < server_config.max_leases; i++)
|
---|
108 | if (g_leases[i].lease_nip == nip)
|
---|
109 | return &g_leases[i];
|
---|
110 |
|
---|
111 | return NULL;
|
---|
112 | }
|
---|
113 |
|
---|
114 | /* Check if the IP is taken; if it is, add it to the lease table */
|
---|
115 | static int nobody_responds_to_arp(uint32_t nip, const uint8_t *safe_mac)
|
---|
116 | {
|
---|
117 | struct in_addr temp;
|
---|
118 | int r;
|
---|
119 |
|
---|
120 | r = arpping(nip, safe_mac,
|
---|
121 | server_config.server_nip,
|
---|
122 | server_config.server_mac,
|
---|
123 | server_config.interface);
|
---|
124 | if (r)
|
---|
125 | return r;
|
---|
126 |
|
---|
127 | temp.s_addr = nip;
|
---|
128 | bb_info_msg("%s belongs to someone, reserving it for %u seconds",
|
---|
129 | inet_ntoa(temp), (unsigned)server_config.conflict_time);
|
---|
130 | add_lease(NULL, nip, server_config.conflict_time, NULL, 0);
|
---|
131 | return 0;
|
---|
132 | }
|
---|
133 |
|
---|
134 | /* Find a new usable (we think) address */
|
---|
135 | uint32_t FAST_FUNC find_free_or_expired_nip(const uint8_t *safe_mac)
|
---|
136 | {
|
---|
137 | uint32_t addr;
|
---|
138 | struct dyn_lease *oldest_lease = NULL;
|
---|
139 |
|
---|
140 | #if ENABLE_FEATURE_UDHCPD_BASE_IP_ON_MAC
|
---|
141 | uint32_t stop;
|
---|
142 | unsigned i, hash;
|
---|
143 |
|
---|
144 | /* hash hwaddr: use the SDBM hashing algorithm. Seems to give good
|
---|
145 | * dispersal even with similarly-valued "strings".
|
---|
146 | */
|
---|
147 | hash = 0;
|
---|
148 | for (i = 0; i < 6; i++)
|
---|
149 | hash += safe_mac[i] + (hash << 6) + (hash << 16) - hash;
|
---|
150 |
|
---|
151 | /* pick a seed based on hwaddr then iterate until we find a free address. */
|
---|
152 | addr = server_config.start_ip
|
---|
153 | + (hash % (1 + server_config.end_ip - server_config.start_ip));
|
---|
154 | stop = addr;
|
---|
155 | #else
|
---|
156 | addr = server_config.start_ip;
|
---|
157 | #define stop (server_config.end_ip + 1)
|
---|
158 | #endif
|
---|
159 | do {
|
---|
160 | uint32_t nip;
|
---|
161 | struct dyn_lease *lease;
|
---|
162 |
|
---|
163 | /* ie, 192.168.55.0 */
|
---|
164 | if ((addr & 0xff) == 0)
|
---|
165 | goto next_addr;
|
---|
166 | /* ie, 192.168.55.255 */
|
---|
167 | if ((addr & 0xff) == 0xff)
|
---|
168 | goto next_addr;
|
---|
169 | nip = htonl(addr);
|
---|
170 | /* skip our own address */
|
---|
171 | if (nip == server_config.server_nip)
|
---|
172 | goto next_addr;
|
---|
173 | /* is this a static lease addr? */
|
---|
174 | if (is_nip_reserved(server_config.static_leases, nip))
|
---|
175 | goto next_addr;
|
---|
176 |
|
---|
177 | lease = find_lease_by_nip(nip);
|
---|
178 | if (!lease) {
|
---|
179 | //TODO: DHCP servers do not always sit on the same subnet as clients: should *ping*, not arp-ping!
|
---|
180 | if (nobody_responds_to_arp(nip, safe_mac))
|
---|
181 | return nip;
|
---|
182 | } else {
|
---|
183 | if (!oldest_lease || lease->expires < oldest_lease->expires)
|
---|
184 | oldest_lease = lease;
|
---|
185 | }
|
---|
186 |
|
---|
187 | next_addr:
|
---|
188 | addr++;
|
---|
189 | #if ENABLE_FEATURE_UDHCPD_BASE_IP_ON_MAC
|
---|
190 | if (addr > server_config.end_ip)
|
---|
191 | addr = server_config.start_ip;
|
---|
192 | #endif
|
---|
193 | } while (addr != stop);
|
---|
194 |
|
---|
195 | if (oldest_lease
|
---|
196 | && is_expired_lease(oldest_lease)
|
---|
197 | && nobody_responds_to_arp(oldest_lease->lease_nip, safe_mac)
|
---|
198 | ) {
|
---|
199 | return oldest_lease->lease_nip;
|
---|
200 | }
|
---|
201 |
|
---|
202 | return 0;
|
---|
203 | }
|
---|