2006-07-02 19:47:05 +00:00
|
|
|
/* vi: set sw=4 ts=4: */
|
2006-05-08 03:20:50 +00:00
|
|
|
/* serverpacket.c
|
|
|
|
*
|
|
|
|
* Construct and send DHCP server packets
|
|
|
|
*
|
|
|
|
* Russ Dill <Russ.Dill@asu.edu> July 2001
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
|
|
* (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "common.h"
|
2008-02-04 13:12:16 +00:00
|
|
|
#include "dhcpc.h"
|
2006-05-08 03:20:50 +00:00
|
|
|
#include "dhcpd.h"
|
|
|
|
#include "options.h"
|
2006-11-18 19:51:32 +00:00
|
|
|
|
2006-05-08 03:20:50 +00:00
|
|
|
|
2009-06-16 08:23:55 +00:00
|
|
|
/* send a packet to gateway_nip using the kernel ip stack */
|
2006-05-08 03:20:50 +00:00
|
|
|
static int send_packet_to_relay(struct dhcpMessage *payload)
|
|
|
|
{
|
2006-09-06 18:36:50 +00:00
|
|
|
DEBUG("Forwarding packet to relay");
|
2006-05-08 03:20:50 +00:00
|
|
|
|
2009-06-16 08:20:27 +00:00
|
|
|
return udhcp_send_kernel_packet(payload,
|
2009-06-16 08:23:55 +00:00
|
|
|
server_config.server_nip, SERVER_PORT,
|
|
|
|
payload->gateway_nip, SERVER_PORT);
|
2006-05-08 03:20:50 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* send a packet to a specific arp address and ip address by creating our own ip packet */
|
|
|
|
static int send_packet_to_client(struct dhcpMessage *payload, int force_broadcast)
|
|
|
|
{
|
2007-04-07 01:05:47 +00:00
|
|
|
const uint8_t *chaddr;
|
2006-05-08 03:20:50 +00:00
|
|
|
uint32_t ciaddr;
|
|
|
|
|
2009-06-16 08:20:27 +00:00
|
|
|
// Was:
|
|
|
|
//if (force_broadcast) { /* broadcast */ }
|
|
|
|
//else if (payload->ciaddr) { /* unicast to payload->ciaddr */ }
|
|
|
|
//else if (payload->flags & htons(BROADCAST_FLAG)) { /* broadcast */ }
|
|
|
|
//else { /* unicast to payload->yiaddr */ }
|
|
|
|
// But this is wrong: yiaddr is _our_ idea what client's IP is
|
|
|
|
// (for example, from lease file). Client may not know that,
|
|
|
|
// and may not have UDP socket listening on that IP!
|
|
|
|
// We should never unicast to payload->yiaddr!
|
|
|
|
// payload->ciaddr, OTOH, comes from client's request packet,
|
|
|
|
// and can be used.
|
|
|
|
|
|
|
|
if (force_broadcast
|
|
|
|
|| (payload->flags & htons(BROADCAST_FLAG))
|
|
|
|
|| !payload->ciaddr
|
|
|
|
) {
|
|
|
|
DEBUG("broadcasting packet to client");
|
2006-05-08 03:20:50 +00:00
|
|
|
ciaddr = INADDR_BROADCAST;
|
|
|
|
chaddr = MAC_BCAST_ADDR;
|
2009-06-16 08:20:27 +00:00
|
|
|
} else {
|
2006-09-06 18:36:50 +00:00
|
|
|
DEBUG("unicasting packet to client ciaddr");
|
2006-05-08 03:20:50 +00:00
|
|
|
ciaddr = payload->ciaddr;
|
|
|
|
chaddr = payload->chaddr;
|
|
|
|
}
|
2009-06-16 08:20:27 +00:00
|
|
|
|
2008-09-26 16:29:12 +00:00
|
|
|
return udhcp_send_raw_packet(payload,
|
2009-06-16 08:23:55 +00:00
|
|
|
/*src*/ server_config.server_nip, SERVER_PORT,
|
2008-09-26 16:29:12 +00:00
|
|
|
/*dst*/ ciaddr, CLIENT_PORT, chaddr,
|
|
|
|
server_config.ifindex);
|
2006-05-08 03:20:50 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* send a dhcp packet, if force broadcast is set, the packet will be broadcast to the client */
|
|
|
|
static int send_packet(struct dhcpMessage *payload, int force_broadcast)
|
|
|
|
{
|
2009-06-16 08:23:55 +00:00
|
|
|
if (payload->gateway_nip)
|
2008-05-21 07:05:06 +00:00
|
|
|
return send_packet_to_relay(payload);
|
|
|
|
return send_packet_to_client(payload, force_broadcast);
|
2006-05-08 03:20:50 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void init_packet(struct dhcpMessage *packet, struct dhcpMessage *oldpacket, char type)
|
|
|
|
{
|
2006-05-28 01:06:36 +00:00
|
|
|
udhcp_init_header(packet, type);
|
2006-05-08 03:20:50 +00:00
|
|
|
packet->xid = oldpacket->xid;
|
|
|
|
memcpy(packet->chaddr, oldpacket->chaddr, 16);
|
|
|
|
packet->flags = oldpacket->flags;
|
2009-06-16 08:23:55 +00:00
|
|
|
packet->gateway_nip = oldpacket->gateway_nip;
|
2006-05-08 03:20:50 +00:00
|
|
|
packet->ciaddr = oldpacket->ciaddr;
|
2009-06-16 08:23:55 +00:00
|
|
|
add_simple_option(packet->options, DHCP_SERVER_ID, server_config.server_nip);
|
2006-05-08 03:20:50 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* add in the bootp options */
|
|
|
|
static void add_bootp_options(struct dhcpMessage *packet)
|
|
|
|
{
|
2009-06-16 08:25:35 +00:00
|
|
|
packet->siaddr_nip = server_config.siaddr_nip;
|
2006-05-08 03:20:50 +00:00
|
|
|
if (server_config.sname)
|
|
|
|
strncpy((char*)packet->sname, server_config.sname, sizeof(packet->sname) - 1);
|
|
|
|
if (server_config.boot_file)
|
|
|
|
strncpy((char*)packet->file, server_config.boot_file, sizeof(packet->file) - 1);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* send a DHCP OFFER to a DHCP DISCOVER */
|
2008-09-26 09:34:59 +00:00
|
|
|
int FAST_FUNC send_offer(struct dhcpMessage *oldpacket)
|
2006-05-08 03:20:50 +00:00
|
|
|
{
|
|
|
|
struct dhcpMessage packet;
|
2008-12-08 22:56:18 +00:00
|
|
|
uint32_t req_align;
|
|
|
|
uint32_t lease_time_aligned = server_config.lease;
|
2009-01-01 17:52:09 +00:00
|
|
|
uint32_t static_lease_ip;
|
2009-04-01 12:36:09 +00:00
|
|
|
uint8_t *req, *lease_time, *p_host_name;
|
2006-05-08 03:20:50 +00:00
|
|
|
struct option_set *curr;
|
|
|
|
struct in_addr addr;
|
|
|
|
|
|
|
|
init_packet(&packet, oldpacket, DHCPOFFER);
|
|
|
|
|
|
|
|
static_lease_ip = getIpByMac(server_config.static_leases, oldpacket->chaddr);
|
|
|
|
|
|
|
|
/* ADDME: if static, short circuit */
|
2006-11-18 19:51:32 +00:00
|
|
|
if (!static_lease_ip) {
|
2009-01-01 17:52:09 +00:00
|
|
|
struct dhcpOfferedAddr *lease;
|
|
|
|
|
2006-11-18 19:51:32 +00:00
|
|
|
lease = find_lease_by_chaddr(oldpacket->chaddr);
|
2009-06-16 08:20:27 +00:00
|
|
|
/* The client is in our lease/offered table */
|
2006-11-18 19:51:32 +00:00
|
|
|
if (lease) {
|
2009-01-01 17:52:09 +00:00
|
|
|
signed_leasetime_t tmp = lease->expires - time(NULL);
|
|
|
|
if (tmp >= 0)
|
|
|
|
lease_time_aligned = tmp;
|
2009-06-16 08:23:01 +00:00
|
|
|
packet.yiaddr = lease->lease_nip;
|
2009-06-16 08:20:27 +00:00
|
|
|
}
|
|
|
|
/* Or the client has requested an IP */
|
|
|
|
else if ((req = get_option(oldpacket, DHCP_REQUESTED_IP)) != NULL
|
|
|
|
/* (read IP) */
|
2009-01-01 17:52:09 +00:00
|
|
|
&& (move_from_unaligned32(req_align, req), 1)
|
2009-06-16 08:20:27 +00:00
|
|
|
/* and the IP is in the lease range */
|
2007-07-01 17:05:57 +00:00
|
|
|
&& ntohl(req_align) >= server_config.start_ip
|
|
|
|
&& ntohl(req_align) <= server_config.end_ip
|
|
|
|
/* and is not already taken/offered */
|
|
|
|
&& (!(lease = find_lease_by_yiaddr(req_align))
|
2009-01-01 17:52:09 +00:00
|
|
|
/* or its taken, but expired */
|
2007-07-01 17:05:57 +00:00
|
|
|
|| lease_expired(lease))
|
2006-11-18 19:51:32 +00:00
|
|
|
) {
|
2009-01-01 17:52:09 +00:00
|
|
|
packet.yiaddr = req_align;
|
2009-06-16 08:20:27 +00:00
|
|
|
}
|
|
|
|
/* Otherwise, find a free IP */
|
|
|
|
else {
|
|
|
|
packet.yiaddr = find_free_or_expired_address(oldpacket->chaddr);
|
2006-11-18 19:51:32 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
if (!packet.yiaddr) {
|
|
|
|
bb_error_msg("no IP addresses to give - OFFER abandoned");
|
|
|
|
return -1;
|
|
|
|
}
|
2009-04-01 12:36:09 +00:00
|
|
|
p_host_name = get_option(oldpacket, DHCP_HOST_NAME);
|
|
|
|
if (!add_lease(packet.chaddr, packet.yiaddr, server_config.offer_time, p_host_name)) {
|
2006-11-18 19:51:32 +00:00
|
|
|
bb_error_msg("lease pool is full - OFFER abandoned");
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
lease_time = get_option(oldpacket, DHCP_LEASE_TIME);
|
|
|
|
if (lease_time) {
|
2008-12-08 22:56:18 +00:00
|
|
|
move_from_unaligned32(lease_time_aligned, lease_time);
|
|
|
|
lease_time_aligned = ntohl(lease_time_aligned);
|
|
|
|
if (lease_time_aligned > server_config.lease)
|
|
|
|
lease_time_aligned = server_config.lease;
|
2006-11-18 19:51:32 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Make sure we aren't just using the lease time from the previous offer */
|
2008-12-08 22:56:18 +00:00
|
|
|
if (lease_time_aligned < server_config.min_lease)
|
2009-01-01 17:52:09 +00:00
|
|
|
lease_time_aligned = server_config.min_lease;
|
2006-11-18 19:51:32 +00:00
|
|
|
} else {
|
2006-05-08 03:20:50 +00:00
|
|
|
/* It is a static lease... use it */
|
|
|
|
packet.yiaddr = static_lease_ip;
|
|
|
|
}
|
|
|
|
|
2008-12-08 22:56:18 +00:00
|
|
|
add_simple_option(packet.options, DHCP_LEASE_TIME, htonl(lease_time_aligned));
|
2006-05-08 03:20:50 +00:00
|
|
|
|
|
|
|
curr = server_config.options;
|
|
|
|
while (curr) {
|
|
|
|
if (curr->data[OPT_CODE] != DHCP_LEASE_TIME)
|
|
|
|
add_option_string(packet.options, curr->data);
|
|
|
|
curr = curr->next;
|
|
|
|
}
|
|
|
|
|
|
|
|
add_bootp_options(&packet);
|
|
|
|
|
|
|
|
addr.s_addr = packet.yiaddr;
|
2006-09-06 18:36:50 +00:00
|
|
|
bb_info_msg("Sending OFFER of %s", inet_ntoa(addr));
|
2006-05-08 03:20:50 +00:00
|
|
|
return send_packet(&packet, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2008-09-26 09:34:59 +00:00
|
|
|
int FAST_FUNC send_NAK(struct dhcpMessage *oldpacket)
|
2006-05-08 03:20:50 +00:00
|
|
|
{
|
|
|
|
struct dhcpMessage packet;
|
|
|
|
|
|
|
|
init_packet(&packet, oldpacket, DHCPNAK);
|
|
|
|
|
2006-09-06 18:36:50 +00:00
|
|
|
DEBUG("Sending NAK");
|
2006-05-08 03:20:50 +00:00
|
|
|
return send_packet(&packet, 1);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2008-09-26 09:34:59 +00:00
|
|
|
int FAST_FUNC send_ACK(struct dhcpMessage *oldpacket, uint32_t yiaddr)
|
2006-05-08 03:20:50 +00:00
|
|
|
{
|
|
|
|
struct dhcpMessage packet;
|
|
|
|
struct option_set *curr;
|
|
|
|
uint8_t *lease_time;
|
2008-12-08 22:56:18 +00:00
|
|
|
uint32_t lease_time_aligned = server_config.lease;
|
2006-05-08 03:20:50 +00:00
|
|
|
struct in_addr addr;
|
2009-04-01 12:36:09 +00:00
|
|
|
uint8_t *p_host_name;
|
2006-05-08 03:20:50 +00:00
|
|
|
|
|
|
|
init_packet(&packet, oldpacket, DHCPACK);
|
|
|
|
packet.yiaddr = yiaddr;
|
|
|
|
|
2007-07-01 17:05:57 +00:00
|
|
|
lease_time = get_option(oldpacket, DHCP_LEASE_TIME);
|
|
|
|
if (lease_time) {
|
2008-12-08 22:56:18 +00:00
|
|
|
move_from_unaligned32(lease_time_aligned, lease_time);
|
|
|
|
lease_time_aligned = ntohl(lease_time_aligned);
|
|
|
|
if (lease_time_aligned > server_config.lease)
|
|
|
|
lease_time_aligned = server_config.lease;
|
|
|
|
else if (lease_time_aligned < server_config.min_lease)
|
2009-01-01 17:52:09 +00:00
|
|
|
lease_time_aligned = server_config.min_lease;
|
2006-05-08 03:20:50 +00:00
|
|
|
}
|
|
|
|
|
2008-12-08 22:56:18 +00:00
|
|
|
add_simple_option(packet.options, DHCP_LEASE_TIME, htonl(lease_time_aligned));
|
2006-05-08 03:20:50 +00:00
|
|
|
|
|
|
|
curr = server_config.options;
|
|
|
|
while (curr) {
|
|
|
|
if (curr->data[OPT_CODE] != DHCP_LEASE_TIME)
|
|
|
|
add_option_string(packet.options, curr->data);
|
|
|
|
curr = curr->next;
|
|
|
|
}
|
|
|
|
|
|
|
|
add_bootp_options(&packet);
|
|
|
|
|
|
|
|
addr.s_addr = packet.yiaddr;
|
2006-09-06 18:36:50 +00:00
|
|
|
bb_info_msg("Sending ACK to %s", inet_ntoa(addr));
|
2006-05-08 03:20:50 +00:00
|
|
|
|
|
|
|
if (send_packet(&packet, 0) < 0)
|
|
|
|
return -1;
|
|
|
|
|
2009-04-01 12:36:09 +00:00
|
|
|
p_host_name = get_option(oldpacket, DHCP_HOST_NAME);
|
|
|
|
add_lease(packet.chaddr, packet.yiaddr, lease_time_aligned, p_host_name);
|
2007-07-01 17:05:57 +00:00
|
|
|
if (ENABLE_FEATURE_UDHCPD_WRITE_LEASES_EARLY) {
|
|
|
|
/* rewrite the file with leases at every new acceptance */
|
|
|
|
write_leases();
|
|
|
|
}
|
2006-05-08 03:20:50 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2008-09-26 09:34:59 +00:00
|
|
|
int FAST_FUNC send_inform(struct dhcpMessage *oldpacket)
|
2006-05-08 03:20:50 +00:00
|
|
|
{
|
|
|
|
struct dhcpMessage packet;
|
|
|
|
struct option_set *curr;
|
|
|
|
|
|
|
|
init_packet(&packet, oldpacket, DHCPACK);
|
|
|
|
|
|
|
|
curr = server_config.options;
|
|
|
|
while (curr) {
|
|
|
|
if (curr->data[OPT_CODE] != DHCP_LEASE_TIME)
|
|
|
|
add_option_string(packet.options, curr->data);
|
|
|
|
curr = curr->next;
|
|
|
|
}
|
|
|
|
|
|
|
|
add_bootp_options(&packet);
|
|
|
|
|
|
|
|
return send_packet(&packet, 0);
|
|
|
|
}
|