sysmo-bts
/
barebox
9
0
Fork 0
Code Releases Activity

implement dhcp using new network stack 

Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
Sascha Hauer 2010-06-02 15:50:12 +02:00
parent 799c00c589
commit 870e64993b
1 changed files with 180 additions and 311 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

491
net/dhcp.c
View File

@ -14,64 +14,44 @@
#include <clock.h> #include <clock.h>
#include <net.h> #include <net.h>
#include <libbb.h> #include <libbb.h>
#include "tftp.h" #include <errno.h>
#include "nfs.h" #include <linux/err.h>
#define OPT_SIZE 312 /* Minimum DHCP Options size per RFC2131 - results in 576 byte pkt */ #define OPT_SIZE 312 /* Minimum DHCP Options size per RFC2131 - results in 576 byte pkt */
typedef struct struct bootp {
{ uint8_t bp_op; /* Operation */
uchar bp_op; /* Operation */ #define OP_BOOTREQUEST 1
# define OP_BOOTREQUEST 1 #define OP_BOOTREPLY 2
# define OP_BOOTREPLY 2 uint8_t bp_htype; /* Hardware type */
uchar bp_htype; /* Hardware type */ #define HWT_ETHER 1
# define HWT_ETHER 1 uint8_t bp_hlen; /* Hardware address length */
uchar bp_hlen; /* Hardware address length */ #define HWL_ETHER 6
# define HWL_ETHER 6 uint8_t bp_hops; /* Hop count (gateway thing) */
uchar bp_hops; /* Hop count (gateway thing) */ uint32_t bp_id; /* Transaction ID */
ulong bp_id; /* Transaction ID */ uint16_t bp_secs; /* Seconds since boot */
ushort bp_secs; /* Seconds since boot */ uint16_t bp_spare1; /* Alignment */
ushort bp_spare1; /* Alignment */
IPaddr_t bp_ciaddr; /* Client IP address */ IPaddr_t bp_ciaddr; /* Client IP address */
IPaddr_t bp_yiaddr; /* Your (client) IP address */ IPaddr_t bp_yiaddr; /* Your (client) IP address */
IPaddr_t bp_siaddr; /* Server IP address */ IPaddr_t bp_siaddr; /* Server IP address */
IPaddr_t bp_giaddr; /* Gateway IP address */ IPaddr_t bp_giaddr; /* Gateway IP address */
uchar bp_chaddr[16]; /* Client hardware address */ uint8_t bp_chaddr[16]; /* Client hardware address */
char bp_sname[64]; /* Server host name */ char bp_sname[64]; /* Server host name */
char bp_file[128]; /* Boot file name */ char bp_file[128]; /* Boot file name */
char bp_vend[OPT_SIZE]; /* Vendor information */ char bp_vend[0]; /* Vendor information */
} Bootp_t; };
#define BOOTP_HDR_SIZE sizeof (Bootp_t)
#define BOOTP_SIZE (ETHER_HDR_SIZE + IP_HDR_SIZE + BOOTP_HDR_SIZE)
/**********************************************************************/
/*
* Global functions and variables.
*/
/* bootp.c */
extern ulong BootpID; /* ID of cur BOOTP request */
extern char BootFile[128]; /* Boot file name */
#ifdef CONFIG_BOOTP_RANDOM_DELAY
ulong seed1, seed2; /* seed for random BOOTP delay */
#endif
/* Send a BOOTP request */
extern void BootpRequest (void);
/****************** DHCP Support *********************/
/* DHCP States */ /* DHCP States */
typedef enum { INIT, typedef enum {
INIT_REBOOT, INIT,
REBOOTING, INIT_REBOOT,
SELECTING, REBOOTING,
REQUESTING, SELECTING,
REBINDING, REQUESTING,
BOUND, REBINDING,
RENEWING } dhcp_state_t; BOUND,
RENEWING,
} dhcp_state_t;
#define DHCP_DISCOVER 1 #define DHCP_DISCOVER 1
#define DHCP_OFFER 2 #define DHCP_OFFER 2
@ -81,44 +61,27 @@ typedef enum { INIT,
#define DHCP_NAK 6 #define DHCP_NAK 6
#define DHCP_RELEASE 7 #define DHCP_RELEASE 7
#define SELECT_TIMEOUT 3 /* Seconds to wait for offers */
/**********************************************************************/
#define BOOTP_VENDOR_MAGIC 0x63825363 /* RFC1048 Magic Cookie */ #define BOOTP_VENDOR_MAGIC 0x63825363 /* RFC1048 Magic Cookie */
#define TIMEOUT 5 /* Seconds before trying BOOTP again */
#ifndef CONFIG_NET_RETRY_COUNT
# define TIMEOUT_COUNT 5 /* # of timeouts before giving up */
#else
# define TIMEOUT_COUNT (CONFIG_NET_RETRY_COUNT)
#endif
#define PORT_BOOTPS 67 /* BOOTP server UDP port */ #define PORT_BOOTPS 67 /* BOOTP server UDP port */
#define PORT_BOOTPC 68 /* BOOTP client UDP port */ #define PORT_BOOTPC 68 /* BOOTP client UDP port */
#ifndef CONFIG_DHCP_MIN_EXT_LEN /* minimal length of extension list */ #define DHCP_MIN_EXT_LEN 64 /* minimal length of extension list */
#define CONFIG_DHCP_MIN_EXT_LEN 64
#endif
ulong BootpID; static uint32_t Bootp_id;
#ifdef CONFIG_BOOTP_RANDOM_DELAY static dhcp_state_t dhcp_state;
ulong seed1, seed2; static uint32_t dhcp_leasetime;
#endif static IPaddr_t net_dhcp_server_ip;
static uint64_t dhcp_start;
dhcp_state_t dhcp_state = INIT; static int bootp_check_packet(unsigned char *pkt, unsigned src, unsigned len)
unsigned long dhcp_leasetime = 0;
IPaddr_t NetDHCPServerIP = 0;
static void DhcpHandler(uchar * pkt, unsigned dest, unsigned src, unsigned len);
static int BootpCheckPkt(uchar *pkt, unsigned dest, unsigned src, unsigned len)
{ {
Bootp_t *bp = (Bootp_t *) pkt; struct bootp *bp = (struct bootp *) pkt;
int retval = 0; int retval = 0;
if (dest != PORT_BOOTPC || src != PORT_BOOTPS) if (src != PORT_BOOTPS)
retval = -1; retval = -1;
else if (len < sizeof (Bootp_t) - OPT_SIZE) else if (len < sizeof(struct bootp))
retval = -2; retval = -2;
else if (bp->bp_op != OP_BOOTREQUEST && else if (bp->bp_op != OP_BOOTREQUEST &&
bp->bp_op != OP_BOOTREPLY && bp->bp_op != OP_BOOTREPLY &&
@ -131,11 +94,11 @@ static int BootpCheckPkt(uchar *pkt, unsigned dest, unsigned src, unsigned len)
retval = -4; retval = -4;
else if (bp->bp_hlen != HWL_ETHER) else if (bp->bp_hlen != HWL_ETHER)
retval = -5; retval = -5;
else if (NetReadLong((ulong*)&bp->bp_id) != BootpID) { else if (net_read_uint32(&bp->bp_id) != Bootp_id) {
retval = -6; retval = -6;
} }
debug ("Filtering pkt = %d\n", retval); debug("Filtering pkt = %d\n", retval);
return retval; return retval;
} }
@ -143,64 +106,31 @@ static int BootpCheckPkt(uchar *pkt, unsigned dest, unsigned src, unsigned len)
/* /*
* Copy parameters of interest from BOOTP_REPLY/DHCP_OFFER packet * Copy parameters of interest from BOOTP_REPLY/DHCP_OFFER packet
*/ */
static void BootpCopyNetParams(Bootp_t *bp) static void bootp_copy_net_params(struct bootp *bp)
{ {
IPaddr_t tmp_ip; IPaddr_t tmp_ip;
NetCopyIP(&NetOurIP, &bp->bp_yiaddr); tmp_ip = net_read_ip(&bp->bp_yiaddr);
NetCopyIP(&tmp_ip, &bp->bp_siaddr); net_set_ip(tmp_ip);
tmp_ip = net_read_ip(&bp->bp_siaddr);
if (tmp_ip != 0) if (tmp_ip != 0)
NetCopyIP(&NetServerIP, &bp->bp_siaddr); net_set_serverip(tmp_ip);
memcpy (NetServerEther, ((Ethernet_t *)NetRxPkt)->et_src, 6);
if (strlen(bp->bp_file) > 0) if (strlen(bp->bp_file) > 0)
safe_strncpy (BootFile, bp->bp_file, sizeof(BootFile)); setenv("bootfile", bp->bp_file);
debug ("Bootfile: %s\n", BootFile); debug("bootfile: %s\n", bp->bp_file);
/* Propagate to environment:
* don't delete exising entry when BOOTP / DHCP reply does
* not contain a new value
*/
if (*BootFile) {
setenv ("bootfile", BootFile);
}
}
static int truncate_sz (const char *name, int maxlen, int curlen)
{
if (curlen >= maxlen) {
printf("*** WARNING: %s is too long (%d - max: %d) - truncated\n",
name, curlen, maxlen);
curlen = maxlen - 1;
}
return (curlen);
} }
/* /*
* Timeout on BOOTP/DHCP request. * Initialize BOOTP extension fields in the request.
*/ */
static void static int dhcp_extended (u8 *e, int message_type, IPaddr_t ServerID, IPaddr_t RequestedIP)
BootpTimeout(void)
{
NetSetTimeout (TIMEOUT * SECOND, BootpTimeout);
BootpRequest ();
}
/*
* Initialize BOOTP extension fields in the request.
*/
static int DhcpExtended (u8 * e, int message_type, IPaddr_t ServerID, IPaddr_t RequestedIP)
{ {
u8 *start = e; u8 *start = e;
u8 *cnt; u8 *cnt;
#ifdef CONFIG_BOOTP_VENDOREX
u8 *x;
#endif
#ifdef CONFIG_BOOTP_SEND_HOSTNAME
char *hostname;
#endif
*e++ = 99; /* RFC1048 Magic Cookie */ *e++ = 99; /* RFC1048 Magic Cookie */
*e++ = 130; *e++ = 130;
*e++ = 83; *e++ = 83;
@ -236,175 +166,118 @@ static int DhcpExtended (u8 * e, int message_type, IPaddr_t ServerID, IPaddr_t R
*e++ = tmp >> 8; *e++ = tmp >> 8;
*e++ = tmp & 0xff; *e++ = tmp & 0xff;
} }
#ifdef CONFIG_BOOTP_SEND_HOSTNAME
if ((hostname = getenv ("hostname"))) {
int hostnamelen = strlen (hostname);
*e++ = 12; /* Hostname */
*e++ = hostnamelen;
memcpy (e, hostname, hostnamelen);
e += hostnamelen;
}
#endif
*e++ = 55; /* Parameter Request List */ *e++ = 55; /* Parameter Request List */
cnt = e++; /* Pointer to count of requested items */ cnt = e++; /* Pointer to count of requested items */
*cnt = 0; *cnt = 0;
#ifdef CONFIG_BOOTP_SUBNETMASK
*e++ = 1; /* Subnet Mask */ *e++ = 1; /* Subnet Mask */
*cnt += 1; *cnt += 1;
#endif
#ifdef CONFIG_BOOTP_TIMEOFFSET
*e++ = 2;
*cnt += 1;
#endif
#ifdef CONFIG_BOOTP_GATEWAY
*e++ = 3; /* Router Option */ *e++ = 3; /* Router Option */
*cnt += 1; *cnt += 1;
#endif
#ifdef CONFIG_BOOTP_DNS
*e++ = 6; /* DNS Server(s) */ *e++ = 6; /* DNS Server(s) */
*cnt += 1; *cnt += 1;
#endif
#ifdef CONFIG_BOOTP_HOSTNAME
*e++ = 12; /* Hostname */ *e++ = 12; /* Hostname */
*cnt += 1; *cnt += 1;
#endif *e++ = 15; /* domain name */
#ifdef CONFIG_BOOTP_BOOTFILESIZE
*e++ = 13; /* Boot File Size */
*cnt += 1; *cnt += 1;
#endif
#ifdef CONFIG_BOOTP_BOOTPATH
*e++ = 17; /* Boot path */ *e++ = 17; /* Boot path */
*cnt += 1; *cnt += 1;
#endif
#ifdef CONFIG_BOOTP_NISDOMAIN
*e++ = 40; /* NIS Domain name request */
*cnt += 1;
#endif
#ifdef CONFIG_BOOTP_NTPSERVER
*e++ = 42;
*cnt += 1;
#endif
*e++ = 255; /* End of the list */ *e++ = 255; /* End of the list */
/* Pad to minimal length */ /* Pad to minimal length */
#ifdef CONFIG_DHCP_MIN_EXT_LEN while ((e - start) <= DHCP_MIN_EXT_LEN)
while ((e - start) <= CONFIG_DHCP_MIN_EXT_LEN)
*e++ = 0; *e++ = 0;
#endif
return e - start; return e - start;
} }
void static struct net_connection *dhcp_con;
BootpRequest (void)
static int bootp_request(void)
{ {
uchar *pkt, *iphdr; struct bootp *bp;
Bootp_t *bp; int ext_len;
int ext_len, pktlen, iplen; int ret;
unsigned char *payload = net_udp_get_payload(dhcp_con);
const char *bfile;
dhcp_state = INIT; dhcp_state = INIT;
printf("BOOTP broadcast\n"); debug("BOOTP broadcast\n");
pkt = NetTxPacket;
memset ((void*)pkt, 0, PKTSIZE);
pkt += NetSetEther(pkt, NetBcastAddr, PROT_IP); bp = (struct bootp *)payload;
/*
* Next line results in incorrect packet size being transmitted, resulting
* in errors in some DHCP servers, reporting missing bytes. Size must be
* set in packet header after extension length has been determined.
* C. Hallinan, DS4.COM, Inc.
*/
/* NetSetIP(pkt, 0xFFFFFFFFL, PORT_BOOTPS, PORT_BOOTPC, sizeof (Bootp_t)); */
iphdr = pkt; /* We need this later for NetSetIP() */
pkt += IP_HDR_SIZE;
bp = (Bootp_t *)pkt;
bp->bp_op = OP_BOOTREQUEST; bp->bp_op = OP_BOOTREQUEST;
bp->bp_htype = HWT_ETHER; bp->bp_htype = HWT_ETHER;
bp->bp_hlen = HWL_ETHER; bp->bp_hlen = HWL_ETHER;
bp->bp_hops = 0; bp->bp_hops = 0;
bp->bp_secs = htons(get_time_ns() >> 30); bp->bp_secs = htons(get_time_ns() >> 30);
NetWriteIP(&bp->bp_ciaddr, 0); net_write_ip(&bp->bp_ciaddr, 0);
NetWriteIP(&bp->bp_yiaddr, 0); net_write_ip(&bp->bp_yiaddr, 0);
NetWriteIP(&bp->bp_siaddr, 0); net_write_ip(&bp->bp_siaddr, 0);
NetWriteIP(&bp->bp_giaddr, 0); net_write_ip(&bp->bp_giaddr, 0);
memcpy (bp->bp_chaddr, NetOurEther, 6); memcpy(bp->bp_chaddr, dhcp_con->et->et_src, 6);
safe_strncpy (bp->bp_file, BootFile, sizeof(bp->bp_file));
bfile = getenv("bootfile");
if (bfile)
safe_strncpy (bp->bp_file, bfile, sizeof(bp->bp_file));
/* Request additional information from the BOOTP/DHCP server */ /* Request additional information from the BOOTP/DHCP server */
ext_len = DhcpExtended((u8 *)bp->bp_vend, DHCP_DISCOVER, 0, 0); ext_len = dhcp_extended((u8 *)bp->bp_vend, DHCP_DISCOVER, 0, 0);
/* Bootp_id = (uint32_t)get_time_ns();
* Bootp ID is the lower 4 bytes of our ethernet address net_copy_uint32(&bp->bp_id, &Bootp_id);
* plus the current time in HZ.
*/
BootpID = ((ulong)NetOurEther[2] << 24)
| ((ulong)NetOurEther[3] << 16)
| ((ulong)NetOurEther[4] << 8)
| (ulong)NetOurEther[5];
BootpID += (uint32_t)get_time_ns();
BootpID = htonl(BootpID);
NetCopyLong(&bp->bp_id, &BootpID);
/*
* Calculate proper packet lengths taking into account the
* variable size of the options field
*/
pktlen = BOOTP_SIZE - sizeof(bp->bp_vend) + ext_len;
iplen = BOOTP_HDR_SIZE - sizeof(bp->bp_vend) + ext_len;
NetSetIP(iphdr, 0xFFFFFFFFL, PORT_BOOTPS, PORT_BOOTPC, iplen);
NetSetTimeout(SELECT_TIMEOUT * SECOND, BootpTimeout);
dhcp_state = SELECTING; dhcp_state = SELECTING;
NetSetHandler(DhcpHandler);
NetSendPacket(NetTxPacket, pktlen); ret = net_udp_send(dhcp_con, sizeof(*bp) + ext_len);
return ret;
} }
static void DhcpOptionsProcess (uchar * popt, Bootp_t *bp) static void dhcp_options_process(unsigned char *popt, struct bootp *bp)
{ {
uchar *end = popt + BOOTP_HDR_SIZE; unsigned char *end = popt + sizeof(*bp) + OPT_SIZE;
int oplen, size; int oplen;
IPaddr_t ip;
char str[256];
while (popt < end && *popt != 0xff) { while (popt < end && *popt != 0xff) {
oplen = *(popt + 1); oplen = *(popt + 1);
switch (*popt) { switch (*popt) {
case 1: case 1:
NetCopyIP (&NetOurSubnetMask, (popt + 2)); ip = net_read_ip(popt + 2);
net_set_netmask(ip);
break; break;
case 3: case 3:
NetCopyIP (&NetOurGatewayIP, (popt + 2)); ip = net_read_ip(popt + 2);
net_set_gateway(ip);
break; break;
case 6: case 6:
NetCopyIP (&NetOurDNSIP, (popt + 2)); ip = net_read_ip(popt + 2);
#ifdef CONFIG_BOOTP_DNS2 setenv_ip("nameserver", ip);
if (*(popt + 1) > 4) {
NetCopyIP (&NetOurDNS2IP, (popt + 2 + 4));
}
#endif
break; break;
case 12: case 12:
size = truncate_sz ("Host Name", sizeof (NetOurHostName), oplen); memcpy(str, popt + 2, oplen);
memcpy (&NetOurHostName, popt + 2, size); str[oplen] = 0;
NetOurHostName[size] = 0; setenv("hostname", str);
break; break;
case 15: /* Ignore Domain Name Option */ case 15:
memcpy(str, popt + 2, oplen);
str[oplen] = 0;
setenv("domainname", str);
break; break;
case 17: case 17:
size = truncate_sz ("Root Path", sizeof (NetOurRootPath), oplen); memcpy(str, popt + 2, oplen);
memcpy (&NetOurRootPath, popt + 2, size); str[oplen] = 0;
NetOurRootPath[size] = 0; setenv("rootpath", str);
break; break;
case 51: case 51:
NetCopyLong (&dhcp_leasetime, (ulong *) (popt + 2)); net_copy_uint32 (&dhcp_leasetime, (uint32_t *)(popt + 2));
break; break;
case 53: /* Ignore Message Type Option */ case 53: /* Ignore Message Type Option */
break; break;
case 54: case 54:
NetCopyIP (&NetDHCPServerIP, (popt + 2)); net_copy_ip(&net_dhcp_server_ip, (popt + 2));
break; break;
case 58: /* Ignore Renewal Time Option */ case 58: /* Ignore Renewal Time Option */
break; break;
@ -419,10 +292,9 @@ static void DhcpOptionsProcess (uchar * popt, Bootp_t *bp)
* pass the bootp packet pointer into here as the * pass the bootp packet pointer into here as the
* second arg * second arg
*/ */
size = truncate_sz ("Opt Boot File", memcpy(str, popt + 2, oplen);
sizeof(bp->bp_file), str[oplen] = 0;
oplen); if (bp->bp_file[0] == '\0') {
if (bp->bp_file[0] == '\0' && size > 0) {
/* /*
* only use vendor boot file if we didn't * only use vendor boot file if we didn't
* receive a boot file in the main non-vendor * receive a boot file in the main non-vendor
@ -434,8 +306,7 @@ static void DhcpOptionsProcess (uchar * popt, Bootp_t *bp)
*/ */
printf("*** WARNING: using vendor " printf("*** WARNING: using vendor "
"optional boot file\n"); "optional boot file\n");
memcpy(bp->bp_file, popt + 2, size); setenv("bootfile", str);
bp->bp_file[size] = '\0';
} }
break; break;
default: default:
@ -443,16 +314,16 @@ static void DhcpOptionsProcess (uchar * popt, Bootp_t *bp)
if (dhcp_vendorex_proc (popt)) if (dhcp_vendorex_proc (popt))
break; break;
#endif #endif
printf ("*** Unhandled DHCP Option in OFFER/ACK: %d\n", *popt); debug("*** Unhandled DHCP Option in OFFER/ACK: %d\n", *popt);
break; break;
} }
popt += oplen + 2; /* Process next option */ popt += oplen + 2; /* Process next option */
} }
} }
static int DhcpMessageType(unsigned char *popt) static int dhcp_message_type(unsigned char *popt)
{ {
if (NetReadLong((ulong*)popt) != htonl(BOOTP_VENDOR_MAGIC)) if (net_read_uint32((uint32_t *)popt) != htonl(BOOTP_VENDOR_MAGIC))
return -1; return -1;
popt += 4; popt += 4;
@ -464,77 +335,66 @@ static int DhcpMessageType(unsigned char *popt)
return -1; return -1;
} }
static void DhcpSendRequestPkt(Bootp_t *bp_offer) static void dhcp_send_request_packet(struct bootp *bp_offer)
{ {
uchar *pkt, *iphdr; struct bootp *bp;
Bootp_t *bp; int extlen;
int pktlen, iplen, extlen;
IPaddr_t OfferedIP; IPaddr_t OfferedIP;
unsigned char *payload = net_udp_get_payload(dhcp_con);
debug ("DhcpSendRequestPkt: Sending DHCPREQUEST\n"); debug("%s: Sending DHCPREQUEST\n", __func__);
pkt = NetTxPacket;
memset ((void*)pkt, 0, PKTSIZE);
pkt += NetSetEther(pkt, NetBcastAddr, PROT_IP); bp = (struct bootp *)payload;
iphdr = pkt; /* We'll need this later to set proper pkt size */
pkt += IP_HDR_SIZE;
bp = (Bootp_t *)pkt;
bp->bp_op = OP_BOOTREQUEST; bp->bp_op = OP_BOOTREQUEST;
bp->bp_htype = HWT_ETHER; bp->bp_htype = HWT_ETHER;
bp->bp_hlen = HWL_ETHER; bp->bp_hlen = HWL_ETHER;
bp->bp_hops = 0; bp->bp_hops = 0;
/* FIXME what is this? */ /* FIXME what is this? */
// bp->bp_secs = htons(get_timer(0) / CFG_HZ); // bp->bp_secs = htons(get_timer(0) / CFG_HZ);
NetCopyIP(&bp->bp_ciaddr, &bp_offer->bp_ciaddr); /* both in network byte order */ net_copy_ip(&bp->bp_ciaddr, &bp_offer->bp_ciaddr); /* both in network byte order */
NetCopyIP(&bp->bp_yiaddr, &bp_offer->bp_yiaddr); net_copy_ip(&bp->bp_yiaddr, &bp_offer->bp_yiaddr);
NetCopyIP(&bp->bp_siaddr, &bp_offer->bp_siaddr); net_copy_ip(&bp->bp_siaddr, &bp_offer->bp_siaddr);
/* /*
* RFC3046 requires Relay Agents to discard packets with * RFC3046 requires Relay Agents to discard packets with
* nonzero and offered giaddr * nonzero and offered giaddr
*/ */
NetWriteIP(&bp->bp_giaddr, 0); net_write_ip(&bp->bp_giaddr, 0);
memcpy (bp->bp_chaddr, NetOurEther, 6); memcpy(bp->bp_chaddr, dhcp_con->et->et_src, 6);
/* /*
* ID is the id of the OFFER packet * ID is the id of the OFFER packet
*/ */
NetCopyLong(&bp->bp_id, &bp_offer->bp_id); net_copy_uint32(&bp->bp_id, &bp_offer->bp_id);
/* /*
* Copy options from OFFER packet if present * Copy options from OFFER packet if present
*/ */
NetCopyIP(&OfferedIP, &bp->bp_yiaddr); net_copy_ip(&OfferedIP, &bp->bp_yiaddr);
extlen = DhcpExtended((u8 *)bp->bp_vend, DHCP_REQUEST, NetDHCPServerIP, OfferedIP); extlen = dhcp_extended((u8 *)bp->bp_vend, DHCP_REQUEST, net_dhcp_server_ip, OfferedIP);
pktlen = BOOTP_SIZE - sizeof(bp->bp_vend) + extlen; debug("Transmitting DHCPREQUEST packet\n");
iplen = BOOTP_HDR_SIZE - sizeof(bp->bp_vend) + extlen; net_udp_send(dhcp_con, sizeof(*bp) + extlen);
NetSetIP(iphdr, 0xFFFFFFFFL, PORT_BOOTPS, PORT_BOOTPC, iplen);
debug ("Transmitting DHCPREQUEST packet: len = %d\n", pktlen);
NetSendPacket(NetTxPacket, pktlen);
} }
/* /*
* Handle DHCP received packets. * Handle DHCP received packets.
*/ */
static void static void dhcp_handler(char *packet, unsigned int len)
DhcpHandler(uchar * pkt, unsigned dest, unsigned src, unsigned len)
{ {
Bootp_t *bp = (Bootp_t *)pkt; char *pkt = net_eth_to_udp_payload(packet);
struct udphdr *udp = net_eth_to_udphdr(packet);
struct bootp *bp = (struct bootp *)pkt;
debug ("DHCPHandler: got packet: (src=%d, dst=%d, len=%d) state: %d\n", len = net_eth_to_udplen(packet);
src, dest, len, dhcp_state);
if (BootpCheckPkt(pkt, dest, src, len)) /* Filter out pkts we don't want */ debug("DHCPHandler: got packet: (len=%d) state: %d\n",
len, dhcp_state);
if (bootp_check_packet(pkt, ntohs(udp->uh_sport), len)) /* Filter out pkts we don't want */
return; return;
debug ("DHCPHandler: got DHCP packet: (src=%d, dst=%d, len=%d) state: %d\n",
src, dest, len, dhcp_state);
switch (dhcp_state) { switch (dhcp_state) {
case SELECTING: case SELECTING:
/* /*
@ -543,69 +403,78 @@ DhcpHandler(uchar * pkt, unsigned dest, unsigned src, unsigned len)
* If filename is in format we recognize, assume it is a valid * If filename is in format we recognize, assume it is a valid
* OFFER from a server we want. * OFFER from a server we want.
*/ */
debug ("DHCP: state=SELECTING bp_file: \"%s\"\n", bp->bp_file); debug ("%s: state SELECTING, bp_file: \"%s\"\n", __func__, bp->bp_file);
#ifdef CFG_BOOTFILE_PREFIX dhcp_state = REQUESTING;
if (strncmp(bp->bp_file,
CFG_BOOTFILE_PREFIX,
strlen(CFG_BOOTFILE_PREFIX)) == 0 ) {
#endif /* CFG_BOOTFILE_PREFIX */
debug ("TRANSITIONING TO REQUESTING STATE\n"); if (net_read_uint32((uint32_t *)&bp->bp_vend[0]) == htonl(BOOTP_VENDOR_MAGIC))
dhcp_state = REQUESTING; dhcp_options_process((u8 *)&bp->bp_vend[4], bp);
if (NetReadLong((ulong*)&bp->bp_vend[0]) == htonl(BOOTP_VENDOR_MAGIC)) bootp_copy_net_params(bp); /* Store net params from reply */
DhcpOptionsProcess((u8 *)&bp->bp_vend[4], bp);
BootpCopyNetParams(bp); /* Store net params from reply */ dhcp_start = get_time_ns();
dhcp_send_request_packet(bp);
NetSetTimeout(TIMEOUT * SECOND, BootpTimeout);
DhcpSendRequestPkt(bp);
#ifdef CFG_BOOTFILE_PREFIX
}
#endif /* CFG_BOOTFILE_PREFIX */
return;
break; break;
case REQUESTING: case REQUESTING:
debug ("DHCP State: REQUESTING\n"); debug ("%s: State REQUESTING\n", __func__);
if ( DhcpMessageType((u8 *)bp->bp_vend) == DHCP_ACK ) { if (dhcp_message_type((u8 *)bp->bp_vend) == DHCP_ACK ) {
if (NetReadLong((ulong*)&bp->bp_vend[0]) == htonl(BOOTP_VENDOR_MAGIC)) if (net_read_uint32((uint32_t *)&bp->bp_vend[0]) == htonl(BOOTP_VENDOR_MAGIC))
DhcpOptionsProcess((u8 *)&bp->bp_vend[4], bp); dhcp_options_process((u8 *)&bp->bp_vend[4], bp);
BootpCopyNetParams(bp); /* Store net params from reply */ bootp_copy_net_params(bp); /* Store net params from reply */
dhcp_state = BOUND; dhcp_state = BOUND;
puts ("DHCP client bound to address "); puts ("DHCP client bound to address ");
print_IPaddr(NetOurIP); print_IPaddr(net_get_ip());
putchar('\n'); putchar('\n');
NetState = NETLOOP_SUCCESS;
return; return;
} }
break; break;
default: default:
puts ("DHCP: INVALID STATE\n"); debug("%s: INVALID STATE\n", __func__);
break; break;
} }
} }
static int do_dhcp(struct command *cmdtp, int argc, char *argv[]) static int do_dhcp(struct command *cmdtp, int argc, char *argv[])
{ {
int size; int ret;
if (NetLoopInit(DHCP) < 0) dhcp_con = net_udp_new(0xffffffff, PORT_BOOTPS, dhcp_handler);
return 1; if (IS_ERR(dhcp_con)) {
ret = PTR_ERR(dhcp_con);
goto out;
}
NetOurIP = 0; ret = net_udp_bind(dhcp_con, PORT_BOOTPC);
BootpRequest(); /* Basically same as BOOTP */ if (ret)
goto out1;
if ((size = NetLoop()) < 0) net_set_ip(0);
return 1;
/* NetLoop ok, update environment */ ret = bootp_request(); /* Basically same as BOOTP */
netboot_update_env(); if (ret)
goto out1;
return 0; while (dhcp_state != BOUND) {
if (ctrlc())
break;
net_poll();
if (is_timeout(dhcp_start, 3 * SECOND)) {
dhcp_start = get_time_ns();
printf("T ");
ret = bootp_request();
if (ret)
goto out1;
}
}
out1:
net_unregister(dhcp_con);
out:
if (ret)
printf("dhcp failed: %s\n", strerror(-ret));
return ret ? 1 : 0;
} }
BAREBOX_CMD_START(dhcp) BAREBOX_CMD_START(dhcp)