2 * Copyright (C) 2012-2013 Steven Barth <steven@midlink.org>
3 * Copyright (C) 2016 Hans Dedecker <dedeckeh@gmail.com>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License v2 as published by
7 * the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
26 #include <net/if_arp.h>
27 #include <netinet/ip.h>
28 #include <sys/ioctl.h>
29 #include <sys/timerfd.h>
30 #include <arpa/inet.h>
32 #include <libubox/md5.h>
38 static void dhcpv4_netevent_cb(unsigned long event
, struct netevent_handler_info
*info
);
39 static int setup_dhcpv4_addresses(struct interface
*iface
);
40 static void update_static_assignments(struct interface
*iface
);
41 static void valid_until_cb(struct uloop_timeout
*event
);
42 static void handle_addrlist_change(struct interface
*iface
);
43 static void free_dhcpv4_assignment(struct dhcpv4_assignment
*a
);
44 static void dhcpv4_fr_start(struct dhcpv4_assignment
*a
);
45 static void dhcpv4_fr_stop(struct dhcpv4_assignment
*a
);
46 static void handle_dhcpv4(void *addr
, void *data
, size_t len
,
47 struct interface
*iface
, void *dest_addr
);
48 static struct dhcpv4_assignment
* dhcpv4_lease(struct interface
*iface
,
49 enum dhcpv4_msg msg
, const uint8_t *mac
, const uint32_t reqaddr
,
50 uint32_t *leasetime
, const char *hostname
, const size_t hostname_len
,
51 const bool accept_fr_nonce
, bool *incl_fr_opt
, uint32_t *fr_serverid
);
53 static struct netevent_handler dhcpv4_netevent_handler
= { .cb
= dhcpv4_netevent_cb
, };
54 static struct uloop_timeout valid_until_timeout
= {.cb
= valid_until_cb
};
55 static uint32_t serial
= 0;
57 struct odhcpd_ref_ip
{
58 struct list_head head
;
60 struct odhcpd_ipaddr addr
;
63 /* Create socket and register events */
66 uloop_timeout_set(&valid_until_timeout
, 1000);
67 netlink_add_netevent_handler(&dhcpv4_netevent_handler
);
72 int dhcpv4_setup_interface(struct interface
*iface
, bool enable
)
76 if (iface
->dhcpv4_event
.uloop
.fd
> 0) {
77 uloop_fd_delete(&iface
->dhcpv4_event
.uloop
);
78 close(iface
->dhcpv4_event
.uloop
.fd
);
79 iface
->dhcpv4_event
.uloop
.fd
= -1;
82 if (iface
->dhcpv4
&& enable
) {
83 struct sockaddr_in bind_addr
= {AF_INET
, htons(DHCPV4_SERVER_PORT
),
87 if (!iface
->dhcpv4_assignments
.next
)
88 INIT_LIST_HEAD(&iface
->dhcpv4_assignments
);
90 if (!iface
->dhcpv4_fr_ips
.next
)
91 INIT_LIST_HEAD(&iface
->dhcpv4_fr_ips
);
93 iface
->dhcpv4_event
.uloop
.fd
= socket(AF_INET
, SOCK_DGRAM
| SOCK_CLOEXEC
, IPPROTO_UDP
);
94 if (iface
->dhcpv4_event
.uloop
.fd
< 0) {
95 syslog(LOG_ERR
, "socket(AF_INET): %m");
100 /* Basic IPv4 configuration */
101 if (setsockopt(iface
->dhcpv4_event
.uloop
.fd
, SOL_SOCKET
, SO_REUSEADDR
,
102 &val
, sizeof(val
)) < 0) {
103 syslog(LOG_ERR
, "setsockopt(SO_REUSEADDR): %m");
108 if (setsockopt(iface
->dhcpv4_event
.uloop
.fd
, SOL_SOCKET
, SO_BROADCAST
,
109 &val
, sizeof(val
)) < 0) {
110 syslog(LOG_ERR
, "setsockopt(SO_BROADCAST): %m");
115 if (setsockopt(iface
->dhcpv4_event
.uloop
.fd
, IPPROTO_IP
, IP_PKTINFO
,
116 &val
, sizeof(val
)) < 0) {
117 syslog(LOG_ERR
, "setsockopt(IP_PKTINFO): %m");
122 val
= IPTOS_PREC_INTERNETCONTROL
;
123 if (setsockopt(iface
->dhcpv4_event
.uloop
.fd
, IPPROTO_IP
, IP_TOS
,
124 &val
, sizeof(val
)) < 0) {
125 syslog(LOG_ERR
, "setsockopt(IP_TOS): %m");
130 val
= IP_PMTUDISC_DONT
;
131 if (setsockopt(iface
->dhcpv4_event
.uloop
.fd
, IPPROTO_IP
, IP_MTU_DISCOVER
,
132 &val
, sizeof(val
)) < 0) {
133 syslog(LOG_ERR
, "setsockopt(IP_MTU_DISCOVER): %m");
138 if (setsockopt(iface
->dhcpv4_event
.uloop
.fd
, SOL_SOCKET
, SO_BINDTODEVICE
,
139 iface
->ifname
, strlen(iface
->ifname
)) < 0) {
140 syslog(LOG_ERR
, "setsockopt(SO_BINDTODEVICE): %m");
145 if (bind(iface
->dhcpv4_event
.uloop
.fd
, (struct sockaddr
*)&bind_addr
,
146 sizeof(bind_addr
)) < 0) {
147 syslog(LOG_ERR
, "bind(): %m");
152 if (setup_dhcpv4_addresses(iface
) < 0) {
157 iface
->dhcpv4_event
.handle_dgram
= handle_dhcpv4
;
158 odhcpd_register(&iface
->dhcpv4_event
);
160 update_static_assignments(iface
);
161 } else if (iface
->dhcpv4_assignments
.next
) {
162 while (!list_empty(&iface
->dhcpv4_assignments
))
163 free_dhcpv4_assignment(list_first_entry(&iface
->dhcpv4_assignments
,
164 struct dhcpv4_assignment
, head
));
168 if (ret
< 0 && iface
->dhcpv4_event
.uloop
.fd
> 0) {
169 close(iface
->dhcpv4_event
.uloop
.fd
);
170 iface
->dhcpv4_event
.uloop
.fd
= -1;
177 static void dhcpv4_netevent_cb(unsigned long event
, struct netevent_handler_info
*info
)
179 struct interface
*iface
= info
->iface
;
181 if (!iface
|| iface
->dhcpv4
== MODE_DISABLED
)
185 case NETEV_IFINDEX_CHANGE
:
186 dhcpv4_setup_interface(iface
, true);
188 case NETEV_ADDRLIST_CHANGE
:
189 handle_addrlist_change(iface
);
196 static struct dhcpv4_assignment
*find_assignment_by_hwaddr(struct interface
*iface
, const uint8_t *hwaddr
)
198 struct dhcpv4_assignment
*a
;
200 list_for_each_entry(a
, &iface
->dhcpv4_assignments
, head
)
201 if (!memcmp(a
->hwaddr
, hwaddr
, 6))
207 static struct dhcpv4_assignment
*find_assignment_by_addr(struct interface
*iface
, const uint32_t addr
)
209 struct dhcpv4_assignment
*a
;
211 list_for_each_entry(a
, &iface
->dhcpv4_assignments
, head
)
218 static int setup_dhcpv4_addresses(struct interface
*iface
)
220 iface
->dhcpv4_start_ip
.s_addr
= INADDR_ANY
;
221 iface
->dhcpv4_end_ip
.s_addr
= INADDR_ANY
;
222 iface
->dhcpv4_local
.s_addr
= INADDR_ANY
;
223 iface
->dhcpv4_bcast
.s_addr
= INADDR_ANY
;
224 iface
->dhcpv4_mask
.s_addr
= INADDR_ANY
;
227 if (iface
->dhcpv4_start
.s_addr
& htonl(0xffff0000) ||
228 iface
->dhcpv4_end
.s_addr
& htonl(0xffff0000) ||
229 ntohl(iface
->dhcpv4_start
.s_addr
) > ntohl(iface
->dhcpv4_end
.s_addr
)) {
230 syslog(LOG_ERR
, "invalid DHCP range for %s", iface
->name
);
234 if (!iface
->addr4_len
) {
235 syslog(LOG_WARNING
, "no network(s) available on %s", iface
->name
);
239 uint32_t start
= ntohl(iface
->dhcpv4_start
.s_addr
);
240 uint32_t end
= ntohl(iface
->dhcpv4_end
.s_addr
);
242 for (size_t i
= 0; i
< iface
->addr4_len
&& start
&& end
; i
++) {
243 struct in_addr
*addr
= &iface
->addr4
[i
].addr
.in
;
246 odhcpd_bitlen2netmask(false, iface
->addr4
[i
].prefix
, &mask
);
247 if ((start
& ntohl(~mask
.s_addr
)) == start
&&
248 (end
& ntohl(~mask
.s_addr
)) == end
) {
249 iface
->dhcpv4_start_ip
.s_addr
= htonl(start
) |
250 (addr
->s_addr
& mask
.s_addr
);
251 iface
->dhcpv4_end_ip
.s_addr
= htonl(end
) |
252 (addr
->s_addr
& mask
.s_addr
);
253 iface
->dhcpv4_local
= *addr
;
254 iface
->dhcpv4_bcast
= iface
->addr4
[i
].broadcast
;
255 iface
->dhcpv4_mask
= mask
;
260 /* Don't allocate IP range for subnets bigger than 28 */
261 if (iface
->addr4
[0].prefix
> 28) {
262 syslog(LOG_WARNING
, "auto allocation of DHCP range fails on %s", iface
->name
);
266 iface
->dhcpv4_local
= iface
->addr4
[0].addr
.in
;
267 iface
->dhcpv4_bcast
= iface
->addr4
[0].broadcast
;
268 odhcpd_bitlen2netmask(false, iface
->addr4
[0].prefix
, &iface
->dhcpv4_mask
);
269 end
= start
= iface
->dhcpv4_local
.s_addr
& iface
->dhcpv4_mask
.s_addr
;
271 /* Auto allocate ranges */
272 if (ntohl(iface
->dhcpv4_mask
.s_addr
) <= 0xffffff00) {
273 iface
->dhcpv4_start_ip
.s_addr
= start
| htonl(100);
274 iface
->dhcpv4_end_ip
.s_addr
= end
| htonl(250);
275 } else if (ntohl(iface
->dhcpv4_mask
.s_addr
) <= 0xffffffc0) {
276 iface
->dhcpv4_start_ip
.s_addr
= start
| htonl(10);
277 iface
->dhcpv4_end_ip
.s_addr
= end
| htonl(60);
278 } else if (ntohl(iface
->dhcpv4_mask
.s_addr
) <= 0xffffffe0) {
279 iface
->dhcpv4_start_ip
.s_addr
= start
| htonl(10);
280 iface
->dhcpv4_end_ip
.s_addr
= end
| htonl(30);
282 iface
->dhcpv4_start_ip
.s_addr
= start
| htonl(3);
283 iface
->dhcpv4_end_ip
.s_addr
= end
| htonl(12);
289 static void update_static_assignments(struct interface
*iface
)
291 struct dhcpv4_assignment
*a
, *c
;
293 /* Cleanup static entries not belonging to the network */
294 list_for_each_entry_safe(a
, c
, &iface
->dhcpv4_assignments
, head
) {
295 if ((a
->flags
& OAF_STATIC
) &&
296 ((a
->addr
& iface
->dhcpv4_mask
.s_addr
) !=
297 (iface
->dhcpv4_start
.s_addr
& iface
->dhcpv4_mask
.s_addr
)))
298 free_dhcpv4_assignment(a
);
301 /* Parse static entries */
303 list_for_each_entry(lease
, &leases
, head
) {
304 if ((iface
->dhcpv4_start_ip
.s_addr
& iface
->dhcpv4_mask
.s_addr
) !=
305 (lease
->ipaddr
.s_addr
& iface
->dhcpv4_mask
.s_addr
)) {
309 a
= find_assignment_by_hwaddr(iface
, lease
->mac
.ether_addr_octet
);
312 /* Check if there's an assignment with the specified IP address */
313 if (find_assignment_by_addr(iface
, lease
->ipaddr
.s_addr
))
316 /* Construct entry */
317 a
= calloc(1, sizeof(*a
));
319 syslog(LOG_ERR
, "Calloc failed for static lease on interface %s",
323 memcpy(a
->hwaddr
, lease
->mac
.ether_addr_octet
, sizeof(a
->hwaddr
));
326 a
->leasetime
= lease
->dhcpv4_leasetime
;
328 a
->addr
= lease
->ipaddr
.s_addr
;
329 /* Static assignment */
330 a
->flags
|= OAF_STATIC
;
334 if (lease
->hostname
[0]) {
336 a
->hostname
= strdup(lease
->hostname
);
339 /* Assign to all interfaces */
340 list_for_each_entry(c
, &iface
->dhcpv4_assignments
, head
) {
341 if (ntohl(c
->addr
) > ntohl(a
->addr
)) {
342 list_add_tail(&a
->head
, &c
->head
);
347 if (&c
->head
== &iface
->dhcpv4_assignments
)
348 list_add(&a
->head
, &iface
->dhcpv4_assignments
);
352 static void inc_ref_cnt_ip(struct odhcpd_ref_ip
**ptr
, struct odhcpd_ref_ip
*ip
)
358 static void decr_ref_cnt_ip(struct odhcpd_ref_ip
**ptr
, struct interface
*iface
)
360 struct odhcpd_ref_ip
*ip
= *ptr
;
362 if (--ip
->ref_cnt
== 0) {
363 netlink_setup_addr(&ip
->addr
, iface
->ifindex
, false, false);
372 static bool leases_require_fr(struct interface
*iface
, struct odhcpd_ipaddr
*addr
,
375 struct dhcpv4_assignment
*a
= NULL
;
376 struct odhcpd_ref_ip
*fr_ip
= NULL
;
378 list_for_each_entry(a
, &iface
->dhcpv4_assignments
, head
) {
379 if ((a
->accept_fr_nonce
|| iface
->dhcpv4_forcereconf
) &&
381 ((a
->addr
& mask
) == (addr
->addr
.in
.s_addr
& mask
))) {
383 fr_ip
= calloc(1, sizeof(*fr_ip
));
387 list_add(&fr_ip
->head
, &iface
->dhcpv4_fr_ips
);
390 inc_ref_cnt_ip(&a
->fr_ip
, fr_ip
);
394 return fr_ip
? true : false;
397 static void valid_until_cb(struct uloop_timeout
*event
)
399 time_t now
= odhcpd_time();
400 struct interface
*iface
;
401 list_for_each_entry(iface
, &interfaces
, head
) {
402 if (iface
->dhcpv4
!= MODE_SERVER
|| iface
->dhcpv4_assignments
.next
== NULL
)
405 struct dhcpv4_assignment
*a
, *n
;
406 list_for_each_entry_safe(a
, n
, &iface
->dhcpv4_assignments
, head
) {
407 if (!INFINITE_VALID(a
->valid_until
) && a
->valid_until
< now
)
408 free_dhcpv4_assignment(a
);
411 uloop_timeout_set(event
, 1000);
414 static void handle_addrlist_change(struct interface
*iface
)
416 struct odhcpd_ipaddr ip
;
417 struct odhcpd_ref_ip
*a
;
418 struct dhcpv4_assignment
*c
;
419 uint32_t mask
= iface
->dhcpv4_mask
.s_addr
;
421 memset(&ip
, 0, sizeof(ip
));
422 ip
.addr
.in
= iface
->dhcpv4_local
;
423 ip
.prefix
= odhcpd_netmask2bitlen(false, &iface
->dhcpv4_mask
);
424 ip
.broadcast
= iface
->dhcpv4_bcast
;
426 setup_dhcpv4_addresses(iface
);
428 if ((ip
.addr
.in
.s_addr
& mask
) ==
429 (iface
->dhcpv4_local
.s_addr
& iface
->dhcpv4_mask
.s_addr
))
432 if (ip
.addr
.in
.s_addr
&& !leases_require_fr(iface
, &ip
, mask
))
435 if (iface
->dhcpv4_local
.s_addr
== INADDR_ANY
|| list_empty(&iface
->dhcpv4_fr_ips
))
438 a
= list_first_entry(&iface
->dhcpv4_fr_ips
, struct odhcpd_ref_ip
, head
);
440 if (netlink_setup_addr(&a
->addr
, iface
->ifindex
, false, true)) {
441 syslog(LOG_ERR
, "Failed to add ip address");
445 list_for_each_entry(c
, &iface
->dhcpv4_assignments
, head
) {
446 if ((c
->flags
& OAF_BOUND
) && c
->fr_ip
&& !c
->fr_cnt
) {
447 if (c
->accept_fr_nonce
|| iface
->dhcpv4_forcereconf
)
455 static char *dhcpv4_msg_to_string(uint8_t reqmsg
)
458 case (DHCPV4_MSG_DISCOVER
):
459 return "DHCPV4_MSG_DISCOVER";
460 case (DHCPV4_MSG_OFFER
):
461 return "DHCPV4_MSG_OFFER";
462 case (DHCPV4_MSG_REQUEST
):
463 return "DHCPV4_MSG_REQUEST";
464 case (DHCPV4_MSG_DECLINE
):
465 return "DHCPV4_MSG_DECLINE";
466 case (DHCPV4_MSG_ACK
):
467 return "DHCPV4_MSG_ACK";
468 case (DHCPV4_MSG_NAK
):
469 return "DHCPV4_MSG_NAK";
470 case (DHCPV4_MSG_RELEASE
):
471 return "DHCPV4_MSG_RELEASE";
472 case (DHCPV4_MSG_INFORM
):
473 return "DHCPV4_MSG_INFORM";
474 case (DHCPV4_MSG_FORCERENEW
):
475 return "DHCPV4_MSG_FORCERENEW";
481 static void free_dhcpv4_assignment(struct dhcpv4_assignment
*a
)
493 static void dhcpv4_put(struct dhcpv4_message
*msg
, uint8_t **cookie
,
494 uint8_t type
, uint8_t len
, const void *data
)
496 uint8_t *c
= *cookie
;
497 uint8_t *end
= (uint8_t *)msg
+ sizeof(*msg
);
499 if (*cookie
+ 2 + len
> end
)
504 memcpy(c
, data
, len
);
509 static void dhcpv4_fr_send(struct dhcpv4_assignment
*a
)
511 struct dhcpv4_message fr_msg
= {
512 .op
= DHCPV4_BOOTREPLY
,
518 .ciaddr
= {INADDR_ANY
},
519 .yiaddr
= {INADDR_ANY
},
520 .siaddr
= {INADDR_ANY
},
521 .giaddr
= {INADDR_ANY
},
526 struct dhcpv4_auth_forcerenew
*auth_o
, auth
= {
530 .replay
= {htonl(time(NULL
)), htonl(++serial
)},
534 struct interface
*iface
= a
->iface
;
536 odhcpd_urandom(&fr_msg
.xid
, sizeof(fr_msg
.xid
));
537 memcpy(fr_msg
.chaddr
, a
->hwaddr
, fr_msg
.hlen
);
539 fr_msg
.options
[0] = 0x63;
540 fr_msg
.options
[1] = 0x82;
541 fr_msg
.options
[2] = 0x53;
542 fr_msg
.options
[3] = 0x63;
544 uint8_t *cookie
= &fr_msg
.options
[4];
545 uint8_t msg
= DHCPV4_MSG_FORCERENEW
;
547 dhcpv4_put(&fr_msg
, &cookie
, DHCPV4_OPT_MESSAGE
, 1, &msg
);
548 if (a
->accept_fr_nonce
) {
549 dhcpv4_put(&fr_msg
, &cookie
, DHCPV4_OPT_AUTHENTICATION
, sizeof(auth
), &auth
);
550 auth_o
= (struct dhcpv4_auth_forcerenew
*)(cookie
- sizeof(auth
));
551 dhcpv4_put(&fr_msg
, &cookie
, DHCPV4_OPT_END
, 0, NULL
);
554 uint8_t secretbytes
[64];
555 memset(secretbytes
, 0, sizeof(secretbytes
));
556 memcpy(secretbytes
, a
->key
, sizeof(a
->key
));
558 for (size_t i
= 0; i
< sizeof(secretbytes
); ++i
)
559 secretbytes
[i
] ^= 0x36;
562 md5_hash(secretbytes
, sizeof(secretbytes
), &md5
);
563 md5_hash(&fr_msg
, sizeof(fr_msg
), &md5
);
564 md5_end(auth_o
->key
, &md5
);
566 for (size_t i
= 0; i
< sizeof(secretbytes
); ++i
) {
567 secretbytes
[i
] ^= 0x36;
568 secretbytes
[i
] ^= 0x5c;
572 md5_hash(secretbytes
, sizeof(secretbytes
), &md5
);
573 md5_hash(auth_o
->key
, sizeof(auth_o
->key
), &md5
);
574 md5_end(auth_o
->key
, &md5
);
576 dhcpv4_put(&fr_msg
, &cookie
, DHCPV4_OPT_SERVERID
, 4,
577 &a
->fr_ip
->addr
.addr
.in
.s_addr
);
578 dhcpv4_put(&fr_msg
, &cookie
, DHCPV4_OPT_END
, 0, NULL
);
581 struct sockaddr_in dest
;
582 memset(&dest
, 0, sizeof(dest
));
583 dest
.sin_family
= AF_INET
;
584 dest
.sin_port
= htons(DHCPV4_CLIENT_PORT
);
585 dest
.sin_addr
.s_addr
= a
->addr
;
587 if (sendto(iface
->dhcpv4_event
.uloop
.fd
, &fr_msg
, sizeof(fr_msg
),
588 MSG_DONTWAIT
, (struct sockaddr
*)&dest
, sizeof(dest
)) < 0)
589 syslog(LOG_ERR
, "Failed to send %s to %s - %s: %m", dhcpv4_msg_to_string(msg
),
590 odhcpd_print_mac(a
->hwaddr
, sizeof(a
->hwaddr
)), inet_ntoa(dest
.sin_addr
));
592 syslog(LOG_WARNING
, "Sent %s to %s - %s", dhcpv4_msg_to_string(msg
),
593 odhcpd_print_mac(a
->hwaddr
, sizeof(a
->hwaddr
)), inet_ntoa(dest
.sin_addr
));
596 static void dhcpv4_fr_timer(struct uloop_timeout
*event
)
598 struct dhcpv4_assignment
*a
= container_of(event
, struct dhcpv4_assignment
, fr_timer
);
600 if (a
->fr_cnt
> 0 && a
->fr_cnt
< 8) {
602 uloop_timeout_set(&a
->fr_timer
, 1000 << a
->fr_cnt
);
608 static void dhcpv4_fr_start(struct dhcpv4_assignment
*a
)
610 uloop_timeout_set(&a
->fr_timer
, 1000 << a
->fr_cnt
);
611 a
->fr_timer
.cb
= dhcpv4_fr_timer
;
617 static void dhcpv4_fr_stop(struct dhcpv4_assignment
*a
)
619 uloop_timeout_cancel(&a
->fr_timer
);
620 decr_ref_cnt_ip(&a
->fr_ip
, a
->iface
);
622 a
->fr_timer
.cb
= NULL
;
625 /* Handler for DHCPv4 messages */
626 static void handle_dhcpv4(void *addr
, void *data
, size_t len
,
627 struct interface
*iface
, _unused
void *dest_addr
)
632 struct dhcpv4_message
*req
= data
;
633 if (len
< offsetof(struct dhcpv4_message
, options
) + 4 ||
634 req
->op
!= DHCPV4_BOOTREQUEST
|| req
->hlen
!= 6)
638 syslog(LOG_NOTICE
, "Got DHCPv4 request");
640 if (!iface
->dhcpv4_start_ip
.s_addr
&& !iface
->dhcpv4_end_ip
.s_addr
) {
641 syslog(LOG_WARNING
, "No DHCP range available on %s", iface
->name
);
645 int sock
= iface
->dhcpv4_event
.uloop
.fd
;
647 struct dhcpv4_message reply
= {
648 .op
= DHCPV4_BOOTREPLY
,
655 .ciaddr
= {INADDR_ANY
},
656 .giaddr
= req
->giaddr
,
657 .siaddr
= iface
->dhcpv4_local
,
659 memcpy(reply
.chaddr
, req
->chaddr
, sizeof(reply
.chaddr
));
661 reply
.options
[0] = 0x63;
662 reply
.options
[1] = 0x82;
663 reply
.options
[2] = 0x53;
664 reply
.options
[3] = 0x63;
666 uint8_t *cookie
= &reply
.options
[4];
667 uint8_t reqmsg
= DHCPV4_MSG_REQUEST
;
668 uint8_t msg
= DHCPV4_MSG_ACK
;
670 uint32_t reqaddr
= INADDR_ANY
;
671 uint32_t leasetime
= 0;
672 size_t hostname_len
= 0;
674 bool accept_fr_nonce
= false;
675 bool incl_fr_opt
= false;
677 uint8_t *start
= &req
->options
[4];
678 uint8_t *end
= ((uint8_t*)data
) + len
;
679 struct dhcpv4_option
*opt
;
680 dhcpv4_for_each_option(start
, end
, opt
) {
681 if (opt
->type
== DHCPV4_OPT_MESSAGE
&& opt
->len
== 1)
682 reqmsg
= opt
->data
[0];
683 else if (opt
->type
== DHCPV4_OPT_HOSTNAME
&& opt
->len
> 0) {
684 hostname_len
= opt
->len
;
685 memcpy(hostname
, opt
->data
, hostname_len
);
686 hostname
[hostname_len
] = 0;
687 } else if (opt
->type
== DHCPV4_OPT_IPADDRESS
&& opt
->len
== 4)
688 memcpy(&reqaddr
, opt
->data
, 4);
689 else if (opt
->type
== DHCPV4_OPT_SERVERID
&& opt
->len
== 4) {
690 if (memcmp(opt
->data
, &iface
->dhcpv4_local
, 4))
692 } else if (iface
->filter_class
&& opt
->type
== DHCPV4_OPT_USER_CLASS
) {
693 uint8_t *c
= opt
->data
, *cend
= &opt
->data
[opt
->len
];
694 for (; c
< cend
&& &c
[*c
] < cend
; c
= &c
[1 + *c
]) {
695 size_t elen
= strlen(iface
->filter_class
);
696 if (*c
== elen
&& !memcmp(&c
[1], iface
->filter_class
, elen
))
697 return; // Ignore from homenet
699 } else if (opt
->type
== DHCPV4_OPT_LEASETIME
&& opt
->len
== 4)
700 memcpy(&leasetime
, opt
->data
, 4);
701 else if (opt
->type
== DHCPV4_OPT_FORCERENEW_NONCE_CAPABLE
&& opt
->len
> 0) {
702 for (uint8_t i
= 0; i
< opt
->len
; i
++) {
703 if (opt
->data
[i
] == 1) {
704 accept_fr_nonce
= true;
712 if (reqmsg
!= DHCPV4_MSG_DISCOVER
&& reqmsg
!= DHCPV4_MSG_REQUEST
&&
713 reqmsg
!= DHCPV4_MSG_INFORM
&& reqmsg
!= DHCPV4_MSG_DECLINE
&&
714 reqmsg
!= DHCPV4_MSG_RELEASE
)
717 struct dhcpv4_assignment
*lease
= NULL
;
718 uint32_t serverid
= iface
->dhcpv4_local
.s_addr
;
719 uint32_t fr_serverid
= INADDR_ANY
;
721 if (reqmsg
!= DHCPV4_MSG_INFORM
)
722 lease
= dhcpv4_lease(iface
, reqmsg
, req
->chaddr
, reqaddr
,
723 &leasetime
, hostname
, hostname_len
,
724 accept_fr_nonce
, &incl_fr_opt
, &fr_serverid
);
727 if (reqmsg
== DHCPV4_MSG_REQUEST
)
728 msg
= DHCPV4_MSG_NAK
;
729 else if (reqmsg
== DHCPV4_MSG_DISCOVER
)
731 } else if (reqmsg
== DHCPV4_MSG_DISCOVER
)
732 msg
= DHCPV4_MSG_OFFER
;
733 else if (reqmsg
== DHCPV4_MSG_REQUEST
&&
734 ((reqaddr
&& reqaddr
!= lease
->addr
) ||
735 (req
->ciaddr
.s_addr
&& req
->ciaddr
.s_addr
!= lease
->addr
))) {
736 msg
= DHCPV4_MSG_NAK
;
738 * DHCP client requested an IP which we can't offer to him. Probably the
739 * client changed the network or the network has been changed. The reply
740 * type is set to DHCPV4_MSG_NAK, because the client should not use that IP.
742 * For modern devices we build an answer that includes a valid IP, like
743 * a DHCPV4_MSG_ACK. The client will use that IP and doesn't need to
744 * perform additional DHCP round trips.
750 * Buggy clients do serverid checking in nack messages; therefore set the
751 * serverid in nack messages triggered by a previous force renew equal to
752 * the server id in use at that time by the server
756 serverid
= fr_serverid
;
758 if (req
->ciaddr
.s_addr
&&
759 ((iface
->dhcpv4_start_ip
.s_addr
& iface
->dhcpv4_mask
.s_addr
) !=
760 (req
->ciaddr
.s_addr
& iface
->dhcpv4_mask
.s_addr
)))
761 req
->ciaddr
.s_addr
= INADDR_ANY
;
764 syslog(LOG_WARNING
, "received %s from %s", dhcpv4_msg_to_string(reqmsg
),
765 odhcpd_print_mac(req
->chaddr
, req
->hlen
));
768 if (reqmsg
== DHCPV4_MSG_RELEASE
)
769 ubus_bcast_dhcp_event("dhcp.release", req
->chaddr
, req
->hlen
,
770 &req
->ciaddr
, hostname
, iface
->ifname
);
772 if (reqmsg
== DHCPV4_MSG_DECLINE
|| reqmsg
== DHCPV4_MSG_RELEASE
)
775 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_MESSAGE
, 1, &msg
);
776 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_SERVERID
, 4, &serverid
);
781 reply
.yiaddr
.s_addr
= lease
->addr
;
783 val
= htonl(leasetime
);
784 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_LEASETIME
, 4, &val
);
786 if (leasetime
!= UINT32_MAX
) {
787 val
= htonl(500 * leasetime
/ 1000);
788 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_RENEW
, 4, &val
);
790 val
= htonl(875 * leasetime
/ 1000);
791 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_REBIND
, 4, &val
);
794 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_NETMASK
, 4,
795 &iface
->dhcpv4_mask
.s_addr
);
798 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_HOSTNAME
,
799 strlen(lease
->hostname
), lease
->hostname
);
801 if (iface
->dhcpv4_bcast
.s_addr
!= INADDR_ANY
)
802 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_BROADCAST
, 4, &iface
->dhcpv4_bcast
);
805 if (reqmsg
== DHCPV4_MSG_REQUEST
) {
806 struct dhcpv4_auth_forcerenew auth
= {
810 .replay
= {htonl(time(NULL
)), htonl(++serial
)},
815 memcpy(auth
.key
, lease
->key
, sizeof(auth
.key
));
816 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_AUTHENTICATION
, sizeof(auth
), &auth
);
819 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_FORCERENEW_NONCE_CAPABLE
,
827 memset(&ifr
, 0, sizeof(ifr
));
828 strncpy(ifr
.ifr_name
, iface
->ifname
, sizeof(ifr
.ifr_name
) - 1);
830 if (!ioctl(sock
, SIOCGIFMTU
, &ifr
)) {
831 uint16_t mtu
= htons(ifr
.ifr_mtu
);
832 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_MTU
, 2, &mtu
);
835 if (iface
->search
&& iface
->search_len
<= 255)
836 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_SEARCH_DOMAIN
,
837 iface
->search_len
, iface
->search
);
838 else if (!res_init() && _res
.dnsrch
[0] && _res
.dnsrch
[0][0]) {
839 uint8_t search_buf
[256];
840 int len
= dn_comp(_res
.dnsrch
[0], search_buf
,
841 sizeof(search_buf
), NULL
, NULL
);
843 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_SEARCH_DOMAIN
,
847 if (iface
->dhcpv4_router_cnt
== 0)
848 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_ROUTER
, 4, &iface
->dhcpv4_local
);
850 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_ROUTER
,
851 4 * iface
->dhcpv4_router_cnt
, iface
->dhcpv4_router
);
854 if (iface
->dhcpv4_dns_cnt
== 0)
855 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_DNSSERVER
, 4, &iface
->dhcpv4_local
);
857 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_DNSSERVER
,
858 4 * iface
->dhcpv4_dns_cnt
, iface
->dhcpv4_dns
);
861 dhcpv4_put(&reply
, &cookie
, DHCPV4_OPT_END
, 0, NULL
);
863 struct sockaddr_in dest
= *((struct sockaddr_in
*)addr
);
864 if (req
->giaddr
.s_addr
) {
866 * relay agent is configured, send reply to the agent
868 dest
.sin_addr
= req
->giaddr
;
869 dest
.sin_port
= htons(DHCPV4_SERVER_PORT
);
870 } else if (req
->ciaddr
.s_addr
&& req
->ciaddr
.s_addr
!= dest
.sin_addr
.s_addr
) {
872 * client has existing configuration (ciaddr is set) AND this address is
873 * not the address it used for the dhcp message
875 dest
.sin_addr
= req
->ciaddr
;
876 dest
.sin_port
= htons(DHCPV4_CLIENT_PORT
);
877 } else if ((ntohs(req
->flags
) & DHCPV4_FLAG_BROADCAST
) ||
878 req
->hlen
!= reply
.hlen
|| !reply
.yiaddr
.s_addr
) {
880 * client requests a broadcast reply OR we can't offer an IP
882 dest
.sin_addr
.s_addr
= INADDR_BROADCAST
;
883 dest
.sin_port
= htons(DHCPV4_CLIENT_PORT
);
884 } else if (!req
->ciaddr
.s_addr
&& msg
== DHCPV4_MSG_NAK
) {
886 * client has no previous configuration -> no IP, so we need to reply
887 * with a broadcast packet
889 dest
.sin_addr
.s_addr
= INADDR_BROADCAST
;
890 dest
.sin_port
= htons(DHCPV4_CLIENT_PORT
);
893 * send reply to the newly (in this proccess) allocated IP
895 dest
.sin_addr
= reply
.yiaddr
;
896 dest
.sin_port
= htons(DHCPV4_CLIENT_PORT
);
898 struct arpreq arp
= {.arp_flags
= ATF_COM
};
899 memcpy(arp
.arp_ha
.sa_data
, req
->chaddr
, 6);
900 memcpy(&arp
.arp_pa
, &dest
, sizeof(arp
.arp_pa
));
901 memcpy(arp
.arp_dev
, iface
->ifname
, sizeof(arp
.arp_dev
));
902 ioctl(sock
, SIOCSARP
, &arp
);
906 if (sendto(sock
, &reply
, sizeof(reply
), MSG_DONTWAIT
,
907 (struct sockaddr
*)&dest
, sizeof(dest
)) < 0)
908 syslog(LOG_ERR
, "Failed to send %s to %s - %s: %m",
909 dhcpv4_msg_to_string(msg
),
910 dest
.sin_addr
.s_addr
== INADDR_BROADCAST
?
911 "ff:ff:ff:ff:ff:ff": odhcpd_print_mac(req
->chaddr
, req
->hlen
),
912 inet_ntoa(dest
.sin_addr
));
914 syslog(LOG_ERR
, "Sent %s to %s - %s",
915 dhcpv4_msg_to_string(msg
),
916 dest
.sin_addr
.s_addr
== INADDR_BROADCAST
?
917 "ff:ff:ff:ff:ff:ff": odhcpd_print_mac(req
->chaddr
, req
->hlen
),
918 inet_ntoa(dest
.sin_addr
));
922 if (msg
== DHCPV4_MSG_ACK
)
923 ubus_bcast_dhcp_event("dhcp.ack", req
->chaddr
, req
->hlen
, &reply
.yiaddr
,
924 hostname
, iface
->ifname
);
928 static bool dhcpv4_assign(struct interface
*iface
,
929 struct dhcpv4_assignment
*assign
, uint32_t raddr
)
931 uint32_t start
= ntohl(iface
->dhcpv4_start_ip
.s_addr
);
932 uint32_t end
= ntohl(iface
->dhcpv4_end_ip
.s_addr
);
933 uint32_t count
= end
- start
+ 1;
935 /* try to assign the IP the client asked for */
936 if (start
<= ntohl(raddr
) && ntohl(raddr
) <= end
&&
937 !find_assignment_by_addr(iface
, raddr
)) {
938 assign
->addr
= raddr
;
939 syslog(LOG_INFO
, "assigning the IP the client asked for: %u.%u.%u.%u",
940 ((uint8_t *)&assign
->addr
)[0],
941 ((uint8_t *)&assign
->addr
)[1],
942 ((uint8_t *)&assign
->addr
)[2],
943 ((uint8_t *)&assign
->addr
)[3]);
947 /* Seed RNG with checksum of hwaddress */
949 for (size_t i
= 0; i
< sizeof(assign
->hwaddr
); ++i
) {
950 /* Knuth's multiplicative method */
951 uint8_t o
= assign
->hwaddr
[i
];
952 seed
+= (o
*2654435761) % UINT32_MAX
;
957 uint32_t try = (((uint32_t)rand()) % count
) + start
;
959 if (list_empty(&iface
->dhcpv4_assignments
)) {
960 assign
->addr
= htonl(try);
961 syslog(LOG_INFO
, "assigning mapped IP (empty list): %u.%u.%u.%u",
962 ((uint8_t *)&assign
->addr
)[0],
963 ((uint8_t *)&assign
->addr
)[1],
964 ((uint8_t *)&assign
->addr
)[2],
965 ((uint8_t *)&assign
->addr
)[3]);
969 for (uint32_t i
= 0; i
< count
; ++i
) {
970 if (!find_assignment_by_addr(iface
, htonl(try))) {
971 /* test was successful: IP address is not assigned, assign it */
972 assign
->addr
= htonl(try);
973 syslog(LOG_DEBUG
, "assigning mapped IP: %u.%u.%u.%u (try %u of %u)",
974 ((uint8_t *)&assign
->addr
)[0],
975 ((uint8_t *)&assign
->addr
)[1],
976 ((uint8_t *)&assign
->addr
)[2],
977 ((uint8_t *)&assign
->addr
)[3],
981 try = (((try - start
) + 1) % count
) + start
;
984 syslog(LOG_WARNING
, "can't assign any IP address -> address space is full");
989 static struct dhcpv4_assignment
* dhcpv4_lease(struct interface
*iface
,
990 enum dhcpv4_msg msg
, const uint8_t *mac
, const uint32_t reqaddr
,
991 uint32_t *leasetime
, const char *hostname
, const size_t hostname_len
,
992 const bool accept_fr_nonce
, bool *incl_fr_opt
, uint32_t *fr_serverid
)
994 struct dhcpv4_assignment
*a
= find_assignment_by_hwaddr(iface
, mac
);
995 struct dhcpv4_assignment
*lease
= NULL
;
996 time_t now
= odhcpd_time();
998 if (a
&& (a
->flags
& OAF_BOUND
) && a
->fr_ip
) {
999 *fr_serverid
= a
->fr_ip
->addr
.addr
.in
.s_addr
;
1003 if (msg
== DHCPV4_MSG_DISCOVER
|| msg
== DHCPV4_MSG_REQUEST
) {
1004 bool assigned
= !!a
;
1007 if (!iface
->no_dynamic_dhcp
) {
1008 /* Create new binding */
1009 a
= calloc(1, sizeof(*a
));
1011 syslog(LOG_ERR
, "Failed to calloc binding on interface %s",
1015 memcpy(a
->hwaddr
, mac
, sizeof(a
->hwaddr
));
1016 /* Don't consider new assignment as infinite */
1017 a
->valid_until
= now
;
1019 assigned
= dhcpv4_assign(iface
, a
, reqaddr
);
1022 list_add(&a
->head
, &iface
->dhcpv4_assignments
);
1025 } else if ((a
->addr
& iface
->dhcpv4_mask
.s_addr
) !=
1026 (iface
->dhcpv4_start_ip
.s_addr
& iface
->dhcpv4_mask
.s_addr
)) {
1029 assigned
= dhcpv4_assign(iface
, a
, reqaddr
);
1031 list_add(&a
->head
, &iface
->dhcpv4_assignments
);
1035 uint32_t my_leasetime
;
1038 my_leasetime
= a
->leasetime
;
1040 my_leasetime
= iface
->dhcpv4_leasetime
;
1042 if ((*leasetime
== 0) || (my_leasetime
< *leasetime
))
1043 *leasetime
= my_leasetime
;
1045 if (msg
== DHCPV4_MSG_DISCOVER
) {
1046 a
->flags
&= ~OAF_BOUND
;
1048 *incl_fr_opt
= accept_fr_nonce
;
1049 if (!(a
->flags
& OAF_STATIC
))
1050 a
->valid_until
= now
;
1052 if (hostname_len
> 0) {
1053 a
->hostname
= realloc(a
->hostname
, hostname_len
+ 1);
1055 memcpy(a
->hostname
, hostname
, hostname_len
);
1056 a
->hostname
[hostname_len
] = 0;
1060 if (!(a
->flags
& OAF_BOUND
)) {
1061 a
->accept_fr_nonce
= accept_fr_nonce
;
1062 *incl_fr_opt
= accept_fr_nonce
;
1063 odhcpd_urandom(a
->key
, sizeof(a
->key
));
1064 a
->flags
|= OAF_BOUND
;
1066 *incl_fr_opt
= false;
1068 if (!(a
->flags
& OAF_STATIC
))
1069 a
->valid_until
= ((*leasetime
== UINT32_MAX
) ? 0 : (time_t)(now
+ *leasetime
));
1071 } else if (!assigned
&& a
) {
1072 /* Cleanup failed assignment */
1073 free_dhcpv4_assignment(a
);
1079 } else if (msg
== DHCPV4_MSG_RELEASE
&& a
) {
1080 a
->flags
&= ~OAF_BOUND
;
1082 if (!(a
->flags
& OAF_STATIC
))
1083 a
->valid_until
= now
- 1;
1085 } else if (msg
== DHCPV4_MSG_DECLINE
&& a
) {
1086 a
->flags
&= ~OAF_BOUND
;
1088 if (!(a
->flags
& OAF_STATIC
)) {
1089 memset(a
->hwaddr
, 0, sizeof(a
->hwaddr
));
1090 a
->valid_until
= now
+ 3600; /* Block address for 1h */
1094 dhcpv6_write_statefile();