bootp.c 22.7 KB
Newer Older
W
wdenk 已提交
1 2 3 4 5 6 7
/*
 *	Based on LiMon - BOOTP.
 *
 *	Copyright 1994, 1995, 2000 Neil Russell.
 *	(See License)
 *	Copyright 2000 Roland Borde
 *	Copyright 2000 Paolo Scaffardi
8
 *	Copyright 2000-2004 Wolfgang Denk, wd@denx.de
W
wdenk 已提交
9 10 11
 */

#if 0
12 13
#define DEBUG		1	/* general debug */
#define DEBUG_BOOTP_EXT 1	/* Debug received vendor fields */
W
wdenk 已提交
14 15 16 17 18 19 20 21 22 23 24 25 26
#endif

#ifdef DEBUG_BOOTP_EXT
#define debug_ext(fmt,args...)	printf (fmt ,##args)
#else
#define debug_ext(fmt,args...)
#endif

#include <common.h>
#include <command.h>
#include <net.h>
#include "bootp.h"
#include "tftp.h"
27
#include "nfs.h"
W
wdenk 已提交
28 29 30 31
#ifdef CONFIG_STATUS_LED
#include <status_led.h>
#endif

32
#define BOOTP_VENDOR_MAGIC	0x63825363	/* RFC1048 Magic Cookie		*/
W
wdenk 已提交
33

34
#if defined(CONFIG_CMD_NET)
W
wdenk 已提交
35

36
#define TIMEOUT		5UL		/* Seconds before trying BOOTP again	*/
37
#ifndef CONFIG_NET_RETRY_COUNT
W
wdenk 已提交
38 39
# define TIMEOUT_COUNT	5		/* # of timeouts before giving up  */
#else
40
# define TIMEOUT_COUNT	(CONFIG_NET_RETRY_COUNT)
W
wdenk 已提交
41 42 43 44 45 46
#endif

#define PORT_BOOTPS	67		/* BOOTP server UDP port		*/
#define PORT_BOOTPC	68		/* BOOTP client UDP port		*/

#ifndef CONFIG_DHCP_MIN_EXT_LEN		/* minimal length of extension list	*/
47
#define CONFIG_DHCP_MIN_EXT_LEN 64
W
wdenk 已提交
48 49 50 51 52 53 54 55
#endif

ulong		BootpID;
int		BootpTry;
#ifdef CONFIG_BOOTP_RANDOM_DELAY
ulong		seed1, seed2;
#endif

56
#if defined(CONFIG_CMD_DHCP)
W
wdenk 已提交
57
dhcp_state_t dhcp_state = INIT;
58
unsigned long dhcp_leasetime = 0;
59
IPaddr_t NetDHCPServerIP = 0;
W
wdenk 已提交
60 61 62
static void DhcpHandler(uchar * pkt, unsigned dest, unsigned src, unsigned len);

/* For Debug */
W
wdenk 已提交
63 64
#if 0
static char *dhcpmsg2str(int type)
W
wdenk 已提交
65 66
{
	switch (type) {
67 68 69 70 71 72 73
	case 1:	 return "DHCPDISCOVER"; break;
	case 2:	 return "DHCPOFFER";	break;
	case 3:	 return "DHCPREQUEST";	break;
	case 4:	 return "DHCPDECLINE";	break;
	case 5:	 return "DHCPACK";	break;
	case 6:	 return "DHCPNACK";	break;
	case 7:	 return "DHCPRELEASE";	break;
W
wdenk 已提交
74 75 76
	default: return "UNKNOWN/INVALID MSG TYPE"; break;
	}
}
W
wdenk 已提交
77
#endif
W
wdenk 已提交
78

79
#if defined(CONFIG_BOOTP_VENDOREX)
W
wdenk 已提交
80 81 82 83
extern u8 *dhcp_vendorex_prep (u8 *e); /*rtn new e after add own opts. */
extern u8 *dhcp_vendorex_proc (u8 *e); /*rtn next e if mine,else NULL  */
#endif

84
#endif
W
wdenk 已提交
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

static int BootpCheckPkt(uchar *pkt, unsigned dest, unsigned src, unsigned len)
{
	Bootp_t *bp = (Bootp_t *) pkt;
	int retval = 0;

	if (dest != PORT_BOOTPC || src != PORT_BOOTPS)
		retval = -1;
	else if (len < sizeof (Bootp_t) - OPT_SIZE)
		retval = -2;
	else if (bp->bp_op != OP_BOOTREQUEST &&
	    bp->bp_op != OP_BOOTREPLY &&
	    bp->bp_op != DHCP_OFFER &&
	    bp->bp_op != DHCP_ACK &&
	    bp->bp_op != DHCP_NAK ) {
		retval = -3;
	}
	else if (bp->bp_htype != HWT_ETHER)
		retval = -4;
	else if (bp->bp_hlen != HWL_ETHER)
		retval = -5;
	else if (NetReadLong((ulong*)&bp->bp_id) != BootpID) {
		retval = -6;
	}

	debug ("Filtering pkt = %d\n", retval);

	return retval;
}

/*
 * Copy parameters of interest from BOOTP_REPLY/DHCP_OFFER packet
 */
W
wdenk 已提交
118
static void BootpCopyNetParams(Bootp_t *bp)
W
wdenk 已提交
119
{
W
wdenk 已提交
120 121
	IPaddr_t tmp_ip;

W
wdenk 已提交
122
	NetCopyIP(&NetOurIP, &bp->bp_yiaddr);
W
Wilson Callan 已提交
123
#if !defined(CONFIG_BOOTP_SERVERIP)
W
wdenk 已提交
124 125 126
	NetCopyIP(&tmp_ip, &bp->bp_siaddr);
	if (tmp_ip != 0)
		NetCopyIP(&NetServerIP, &bp->bp_siaddr);
W
wdenk 已提交
127
	memcpy (NetServerEther, ((Ethernet_t *)NetRxPkt)->et_src, 6);
W
Wilson Callan 已提交
128
#endif
W
wdenk 已提交
129 130
	if (strlen(bp->bp_file) > 0)
		copy_filename (BootFile, bp->bp_file, sizeof(BootFile));
W
wdenk 已提交
131 132 133 134

	debug ("Bootfile: %s\n", BootFile);

	/* Propagate to environment:
W
wdenk 已提交
135
	 * don't delete exising entry when BOOTP / DHCP reply does
W
wdenk 已提交
136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152
	 * 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);
}

153
#if !defined(CONFIG_CMD_DHCP)
W
wdenk 已提交
154

155
static void BootpVendorFieldProcess (u8 * ext)
W
wdenk 已提交
156
{
157
	int size = *(ext + 1);
W
wdenk 已提交
158

159 160
	debug_ext ("[BOOTP] Processing extension %d... (%d bytes)\n", *ext,
		   *(ext + 1));
W
wdenk 已提交
161

162
	NetBootFileSize = 0;
W
wdenk 已提交
163

164 165
	switch (*ext) {
		/* Fixed length fields */
166
	case 1:			/* Subnet mask					*/
W
wdenk 已提交
167
		if (NetOurSubnetMask == 0)
168
			NetCopyIP (&NetOurSubnetMask, (IPaddr_t *) (ext + 2));
W
wdenk 已提交
169
		break;
170
	case 2:			/* Time offset - Not yet supported		*/
W
wdenk 已提交
171
		break;
172
		/* Variable length fields */
173
	case 3:			/* Gateways list				*/
W
wdenk 已提交
174
		if (NetOurGatewayIP == 0) {
175
			NetCopyIP (&NetOurGatewayIP, (IPaddr_t *) (ext + 2));
W
wdenk 已提交
176 177
		}
		break;
178
	case 4:			/* Time server - Not yet supported		*/
W
wdenk 已提交
179
		break;
180
	case 5:			/* IEN-116 name server - Not yet supported	*/
W
wdenk 已提交
181 182 183
		break;
	case 6:
		if (NetOurDNSIP == 0) {
184
			NetCopyIP (&NetOurDNSIP, (IPaddr_t *) (ext + 2));
W
wdenk 已提交
185
		}
186
#if defined(CONFIG_BOOTP_DNS2)
187
		if ((NetOurDNS2IP == 0) && (size > 4)) {
188
			NetCopyIP (&NetOurDNS2IP, (IPaddr_t *) (ext + 2 + 4));
189 190
		}
#endif
W
wdenk 已提交
191
		break;
192
	case 7:			/* Log server - Not yet supported		*/
W
wdenk 已提交
193
		break;
194
	case 8:			/* Cookie/Quote server - Not yet supported	*/
W
wdenk 已提交
195
		break;
196
	case 9:			/* LPR server - Not yet supported		*/
W
wdenk 已提交
197
		break;
198
	case 10:		/* Impress server - Not yet supported		*/
W
wdenk 已提交
199
		break;
200
	case 11:		/* RPL server - Not yet supported		*/
W
wdenk 已提交
201
		break;
202
	case 12:		/* Host name					*/
W
wdenk 已提交
203
		if (NetOurHostName[0] == 0) {
204 205 206
			size = truncate_sz ("Host Name", sizeof (NetOurHostName), size);
			memcpy (&NetOurHostName, ext + 2, size);
			NetOurHostName[size] = 0;
W
wdenk 已提交
207 208
		}
		break;
209
	case 13:		/* Boot file size				*/
W
wdenk 已提交
210
		if (size == 2)
211
			NetBootFileSize = ntohs (*(ushort *) (ext + 2));
W
wdenk 已提交
212
		else if (size == 4)
213
			NetBootFileSize = ntohl (*(ulong *) (ext + 2));
W
wdenk 已提交
214
		break;
215
	case 14:		/* Merit dump file - Not yet supported		*/
W
wdenk 已提交
216
		break;
217
	case 15:		/* Domain name - Not yet supported		*/
W
wdenk 已提交
218
		break;
219
	case 16:		/* Swap server - Not yet supported		*/
W
wdenk 已提交
220
		break;
221
	case 17:		/* Root path					*/
W
wdenk 已提交
222
		if (NetOurRootPath[0] == 0) {
223 224 225
			size = truncate_sz ("Root Path", sizeof (NetOurRootPath), size);
			memcpy (&NetOurRootPath, ext + 2, size);
			NetOurRootPath[size] = 0;
W
wdenk 已提交
226 227
		}
		break;
228
	case 18:		/* Extension path - Not yet supported		*/
W
wdenk 已提交
229
		/*
W
wdenk 已提交
230 231 232
		 * This can be used to send the information of the
		 * vendor area in another file that the client can
		 * access via TFTP.
W
wdenk 已提交
233 234
		 */
		break;
235
		/* IP host layer fields */
236
	case 40:		/* NIS Domain name				*/
W
wdenk 已提交
237
		if (NetOurNISDomain[0] == 0) {
238 239 240
			size = truncate_sz ("NIS Domain Name", sizeof (NetOurNISDomain), size);
			memcpy (&NetOurNISDomain, ext + 2, size);
			NetOurNISDomain[size] = 0;
W
wdenk 已提交
241 242
		}
		break;
243
		/* Application layer fields */
244
	case 43:		/* Vendor specific info - Not yet supported	*/
W
wdenk 已提交
245
		/*
W
wdenk 已提交
246 247
		 * Binary information to exchange specific
		 * product information.
W
wdenk 已提交
248 249
		 */
		break;
250 251
		/* Reserved (custom) fields (128..254) */
	}
W
wdenk 已提交
252 253
}

254
static void BootpVendorProcess (u8 * ext, int size)
W
wdenk 已提交
255
{
256
	u8 *end = ext + size;
W
wdenk 已提交
257

258
	debug_ext ("[BOOTP] Checking extension (%d bytes)...\n", size);
W
wdenk 已提交
259

260 261 262 263 264 265 266 267 268 269
	while ((ext < end) && (*ext != 0xff)) {
		if (*ext == 0) {
			ext++;
		} else {
			u8 *opt = ext;

			ext += ext[1] + 2;
			if (ext <= end)
				BootpVendorFieldProcess (opt);
		}
W
wdenk 已提交
270 271 272
	}

#ifdef DEBUG_BOOTP_EXT
273
	puts ("[BOOTP] Received fields: \n");
274 275 276 277 278 279 280 281 282 283 284 285 286 287 288
	if (NetOurSubnetMask) {
		puts ("NetOurSubnetMask : ");
		print_IPaddr (NetOurSubnetMask);
		putc ('\n');
	}

	if (NetOurGatewayIP) {
		puts ("NetOurGatewayIP	: ");
		print_IPaddr (NetOurGatewayIP);
		putc ('\n');
	}

	if (NetBootFileSize) {
		printf ("NetBootFileSize : %d\n", NetBootFileSize);
	}
W
wdenk 已提交
289

290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306
	if (NetOurHostName[0]) {
		printf ("NetOurHostName  : %s\n", NetOurHostName);
	}

	if (NetOurRootPath[0]) {
		printf ("NetOurRootPath  : %s\n", NetOurRootPath);
	}

	if (NetOurNISDomain[0]) {
		printf ("NetOurNISDomain : %s\n", NetOurNISDomain);
	}

	if (NetBootFileSize) {
		printf ("NetBootFileSize: %d\n", NetBootFileSize);
	}
#endif /* DEBUG_BOOTP_EXT */
}
W
wdenk 已提交
307 308 309 310 311 312 313 314 315
/*
 *	Handle a BOOTP received packet.
 */
static void
BootpHandler(uchar * pkt, unsigned dest, unsigned src, unsigned len)
{
	Bootp_t *bp;
	char	*s;

316
	debug ("got BOOTP packet (src=%d, dst=%d, len=%d want_len=%zu)\n",
W
wdenk 已提交
317 318 319 320
		src, dest, len, sizeof (Bootp_t));

	bp = (Bootp_t *)pkt;

321
	if (BootpCheckPkt(pkt, dest, src, len)) /* Filter out pkts we don't want */
W
wdenk 已提交
322 323 324
		return;

	/*
325
	 *	Got a good BOOTP reply.	 Copy the data into our variables.
W
wdenk 已提交
326 327 328 329 330 331 332 333 334
	 */
#ifdef CONFIG_STATUS_LED
	status_led_set (STATUS_LED_BOOT, STATUS_LED_OFF);
#endif

	BootpCopyNetParams(bp);		/* Store net parameters from reply */

	/* Retrieve extended information (we must parse the vendor area) */
	if (NetReadLong((ulong*)&bp->bp_vend[0]) == htonl(BOOTP_VENDOR_MAGIC))
W
Wolfgang Denk 已提交
335
		BootpVendorProcess((uchar *)&bp->bp_vend[4], len);
W
wdenk 已提交
336 337 338 339 340

	NetSetTimeout(0, (thand_f *)0);

	debug ("Got good BOOTP\n");

W
wdenk 已提交
341 342 343 344 345 346 347 348
	if ((s = getenv("autoload")) != NULL) {
		if (*s == 'n') {
			/*
			 * Just use BOOTP to configure system;
			 * Do not use TFTP to load the bootfile.
			 */
			NetState = NETLOOP_SUCCESS;
			return;
349
#if defined(CONFIG_CMD_NFS)
W
wdenk 已提交
350 351 352 353 354 355
		} else if (strcmp(s, "NFS") == 0) {
			/*
			 * Use NFS to load the bootfile.
			 */
			NfsStart();
			return;
W
wdenk 已提交
356
#endif
W
wdenk 已提交
357
		}
W
wdenk 已提交
358 359
	}

W
wdenk 已提交
360
	TftpStart();
W
wdenk 已提交
361
}
362
#endif
W
wdenk 已提交
363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381

/*
 *	Timeout on BOOTP/DHCP request.
 */
static void
BootpTimeout(void)
{
	if (BootpTry >= TIMEOUT_COUNT) {
		puts ("\nRetry count exceeded; starting again\n");
		NetStartAgain ();
	} else {
		NetSetTimeout (TIMEOUT * CFG_HZ, BootpTimeout);
		BootpRequest ();
	}
}

/*
 *	Initialize BOOTP extension fields in the request.
 */
382
#if defined(CONFIG_CMD_DHCP)
383
static int DhcpExtended (u8 * e, int message_type, IPaddr_t ServerID, IPaddr_t RequestedIP)
W
wdenk 已提交
384
{
385 386 387
	u8 *start = e;
	u8 *cnt;

388
#if defined(CONFIG_BOOTP_VENDOREX)
389
	u8 *x;
W
wdenk 已提交
390
#endif
391
#if defined(CONFIG_BOOTP_SEND_HOSTNAME)
W
Wolfgang Denk 已提交
392
	char *hostname;
393
#endif
W
wdenk 已提交
394

395 396 397 398
	*e++ = 99;		/* RFC1048 Magic Cookie */
	*e++ = 130;
	*e++ = 83;
	*e++ = 99;
W
wdenk 已提交
399

400 401 402
	*e++ = 53;		/* DHCP Message Type */
	*e++ = 1;
	*e++ = message_type;
W
wdenk 已提交
403

404 405 406 407
	*e++ = 57;		/* Maximum DHCP Message Size */
	*e++ = 2;
	*e++ = (576 - 312 + OPT_SIZE) >> 8;
	*e++ = (576 - 312 + OPT_SIZE) & 0xff;
W
wdenk 已提交
408

409 410
	if (ServerID) {
		int tmp = ntohl (ServerID);
W
wdenk 已提交
411

412 413 414 415 416 417 418
		*e++ = 54;	/* ServerID */
		*e++ = 4;
		*e++ = tmp >> 24;
		*e++ = tmp >> 16;
		*e++ = tmp >> 8;
		*e++ = tmp & 0xff;
	}
W
wdenk 已提交
419

420 421
	if (RequestedIP) {
		int tmp = ntohl (RequestedIP);
W
wdenk 已提交
422

423 424 425 426 427 428 429
		*e++ = 50;	/* Requested IP */
		*e++ = 4;
		*e++ = tmp >> 24;
		*e++ = tmp >> 16;
		*e++ = tmp >> 8;
		*e++ = tmp & 0xff;
	}
430
#if defined(CONFIG_BOOTP_SEND_HOSTNAME)
431 432 433 434 435 436 437 438
	if ((hostname = getenv ("hostname"))) {
		int hostnamelen = strlen (hostname);

		*e++ = 12;	/* Hostname */
		*e++ = hostnamelen;
		memcpy (e, hostname, hostnamelen);
		e += hostnamelen;
	}
439 440
#endif

441
#if defined(CONFIG_BOOTP_VENDOREX)
442 443
	if ((x = dhcp_vendorex_prep (e)))
		return x - start;
W
wdenk 已提交
444 445
#endif

446 447 448
	*e++ = 55;		/* Parameter Request List */
	 cnt = e++;		/* Pointer to count of requested items */
	*cnt = 0;
449
#if defined(CONFIG_BOOTP_SUBNETMASK)
450 451
	*e++  = 1;		/* Subnet Mask */
	*cnt += 1;
W
wdenk 已提交
452
#endif
453
#if defined(CONFIG_BOOTP_TIMEOFFSET)
W
wdenk 已提交
454 455 456
	*e++  = 2;
	*cnt += 1;
#endif
457
#if defined(CONFIG_BOOTP_GATEWAY)
458 459
	*e++  = 3;		/* Router Option */
	*cnt += 1;
W
wdenk 已提交
460
#endif
461
#if defined(CONFIG_BOOTP_DNS)
462 463
	*e++  = 6;		/* DNS Server(s) */
	*cnt += 1;
W
wdenk 已提交
464
#endif
465
#if defined(CONFIG_BOOTP_HOSTNAME)
466 467
	*e++  = 12;		/* Hostname */
	*cnt += 1;
W
wdenk 已提交
468
#endif
469
#if defined(CONFIG_BOOTP_BOOTFILESIZE)
470 471
	*e++  = 13;		/* Boot File Size */
	*cnt += 1;
W
wdenk 已提交
472
#endif
473
#if defined(CONFIG_BOOTP_BOOTPATH)
474 475
	*e++  = 17;		/* Boot path */
	*cnt += 1;
W
wdenk 已提交
476
#endif
477
#if defined(CONFIG_BOOTP_NISDOMAIN)
478 479
	*e++  = 40;		/* NIS Domain name request */
	*cnt += 1;
W
wdenk 已提交
480
#endif
481
#if defined(CONFIG_BOOTP_NTPSERVER)
W
wdenk 已提交
482 483
	*e++  = 42;
	*cnt += 1;
W
wdenk 已提交
484
#endif
485
	*e++  = 255;		/* End of the list */
W
wdenk 已提交
486

487
	/* Pad to minimal length */
W
wdenk 已提交
488
#ifdef	CONFIG_DHCP_MIN_EXT_LEN
489 490
	while ((e - start) <= CONFIG_DHCP_MIN_EXT_LEN)
		*e++ = 0;
W
wdenk 已提交
491 492
#endif

493
	return e - start;
W
wdenk 已提交
494 495
}

496
#else
W
wdenk 已提交
497
/*
498
 *	Warning: no field size check - change CONFIG_BOOTP_* at your own risk!
W
wdenk 已提交
499
 */
500
static int BootpExtended (u8 * e)
W
wdenk 已提交
501
{
502
	u8 *start = e;
W
wdenk 已提交
503

504 505 506 507
	*e++ = 99;		/* RFC1048 Magic Cookie */
	*e++ = 130;
	*e++ = 83;
	*e++ = 99;
W
wdenk 已提交
508

509
#if defined(CONFIG_CMD_DHCP)
510 511 512 513 514 515 516 517
	*e++ = 53;		/* DHCP Message Type */
	*e++ = 1;
	*e++ = DHCP_DISCOVER;

	*e++ = 57;		/* Maximum DHCP Message Size */
	*e++ = 2;
	*e++ = (576 - 312 + OPT_SIZE) >> 16;
	*e++ = (576 - 312 + OPT_SIZE) & 0xff;
518
#endif
W
wdenk 已提交
519

520
#if defined(CONFIG_BOOTP_SUBNETMASK)
521 522 523
	*e++ = 1;		/* Subnet mask request */
	*e++ = 4;
	e   += 4;
W
wdenk 已提交
524 525
#endif

526
#if defined(CONFIG_BOOTP_GATEWAY)
527 528 529
	*e++ = 3;		/* Default gateway request */
	*e++ = 4;
	e   += 4;
W
wdenk 已提交
530 531
#endif

532
#if defined(CONFIG_BOOTP_DNS)
533 534 535
	*e++ = 6;		/* Domain Name Server */
	*e++ = 4;
	e   += 4;
W
wdenk 已提交
536 537
#endif

538
#if defined(CONFIG_BOOTP_HOSTNAME)
539 540 541
	*e++ = 12;		/* Host name request */
	*e++ = 32;
	e   += 32;
W
wdenk 已提交
542 543
#endif

544
#if defined(CONFIG_BOOTP_BOOTFILESIZE)
545 546 547
	*e++ = 13;		/* Boot file size */
	*e++ = 2;
	e   += 2;
W
wdenk 已提交
548 549
#endif

550
#if defined(CONFIG_BOOTP_BOOTPATH)
551 552 553
	*e++ = 17;		/* Boot path */
	*e++ = 32;
	e   += 32;
W
wdenk 已提交
554 555
#endif

556
#if defined(CONFIG_BOOTP_NISDOMAIN)
557 558 559
	*e++ = 40;		/* NIS Domain name request */
	*e++ = 32;
	e   += 32;
W
wdenk 已提交
560 561
#endif

562
	*e++ = 255;		/* End of the list */
W
wdenk 已提交
563

564
	return e - start;
W
wdenk 已提交
565
}
566
#endif
W
wdenk 已提交
567 568 569 570 571 572 573 574

void
BootpRequest (void)
{
	volatile uchar *pkt, *iphdr;
	Bootp_t *bp;
	int ext_len, pktlen, iplen;

575
#if defined(CONFIG_CMD_DHCP)
W
wdenk 已提交
576 577 578 579 580 581 582
	dhcp_state = INIT;
#endif

#ifdef CONFIG_BOOTP_RANDOM_DELAY		/* Random BOOTP delay */
	unsigned char bi_enetaddr[6];
	int   reg;
	char  *e,*s;
W
Wolfgang Denk 已提交
583
	char tmp[64];
W
wdenk 已提交
584 585 586 587 588 589 590 591 592 593 594 595 596 597
	ulong tst1, tst2, sum, m_mask, m_value = 0;

	if (BootpTry ==0) {
		/* get our mac */
		reg = getenv_r ("ethaddr", tmp, sizeof(tmp));
		s = (reg > 0) ? tmp : NULL;

		for (reg=0; reg<6; ++reg) {
			bi_enetaddr[reg] = s ? simple_strtoul(s, &e, 16) : 0;
			if (s) {
				s = (*e) ? e+1 : e;
			}
		}
#ifdef DEBUG
598
		puts ("BootpRequest => Our Mac: ");
W
wdenk 已提交
599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636
		for (reg=0; reg<6; reg++) {
			printf ("%x%c",
				bi_enetaddr[reg],
				reg==5 ? '\n' : ':');
		}
#endif /* DEBUG */

		/* Mac-Manipulation 2 get seed1 */
		tst1=0;
		tst2=0;
		for (reg=2; reg<6; reg++) {
			tst1 = tst1 << 8;
			tst1 = tst1 | bi_enetaddr[reg];
		}
		for (reg=0; reg<2; reg++) {
			tst2 = tst2 | bi_enetaddr[reg];
			tst2 = tst2 << 8;
		}

		seed1 = tst1^tst2;

		/* Mirror seed1*/
		m_mask=0x1;
		for (reg=1;reg<=32;reg++) {
			m_value |= (m_mask & seed1);
			seed1 = seed1 >> 1;
			m_value = m_value << 1;
		}
		seed1 = m_value;
		seed2 = 0xB78D0945;
	}

	/* Random Number Generator */

	for (reg=0;reg<=0;reg++) {
		sum = seed1 + seed2;
		if (sum < seed1 || sum < seed2)
			sum++;
W
wdenk 已提交
637
		seed2 = seed1;
W
wdenk 已提交
638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656
		seed1 = sum;

		if (BootpTry<=2) {	/* Start with max 1024 * 1ms */
			sum = sum >> (22-BootpTry);
		} else {		/*After 3rd BOOTP request max 8192 * 1ms */
			sum = sum >> 19;
		}
	}

	printf ("Random delay: %ld ms...\n", sum);
	for (reg=0; reg <sum; reg++) {
		udelay(1000); /*Wait 1ms*/
	}
#endif	/* CONFIG_BOOTP_RANDOM_DELAY */

	printf("BOOTP broadcast %d\n", ++BootpTry);
	pkt = NetTxPacket;
	memset ((void*)pkt, 0, PKTSIZE);

657
	pkt += NetSetEther(pkt, NetBcastAddr, PROT_IP);
W
wdenk 已提交
658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682

	/*
	 * 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_htype = HWT_ETHER;
	bp->bp_hlen = HWL_ETHER;
	bp->bp_hops = 0;
	bp->bp_secs = htons(get_timer(0) / CFG_HZ);
	NetWriteIP(&bp->bp_ciaddr, 0);
	NetWriteIP(&bp->bp_yiaddr, 0);
	NetWriteIP(&bp->bp_siaddr, 0);
	NetWriteIP(&bp->bp_giaddr, 0);
	memcpy (bp->bp_chaddr, NetOurEther, 6);
	copy_filename (bp->bp_file, BootFile, sizeof(bp->bp_file));

	/* Request additional information from the BOOTP/DHCP server */
683
#if defined(CONFIG_CMD_DHCP)
W
Wolfgang Denk 已提交
684
	ext_len = DhcpExtended((u8 *)bp->bp_vend, DHCP_DISCOVER, 0, 0);
W
wdenk 已提交
685
#else
W
Wolfgang Denk 已提交
686
	ext_len = BootpExtended((u8 *)bp->bp_vend);
687
#endif
W
wdenk 已提交
688 689 690 691 692 693 694 695 696 697

	/*
	 *	Bootp ID is the lower 4 bytes of our ethernet address
	 *	plus the current time in HZ.
	 */
	BootpID = ((ulong)NetOurEther[2] << 24)
		| ((ulong)NetOurEther[3] << 16)
		| ((ulong)NetOurEther[4] << 8)
		| (ulong)NetOurEther[5];
	BootpID += get_timer(0);
698
	BootpID	 = htonl(BootpID);
W
wdenk 已提交
699 700 701 702 703 704 705 706 707 708 709
	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 * CFG_HZ, BootpTimeout);

710
#if defined(CONFIG_CMD_DHCP)
W
wdenk 已提交
711 712 713 714
	dhcp_state = SELECTING;
	NetSetHandler(DhcpHandler);
#else
	NetSetHandler(BootpHandler);
715
#endif
W
wdenk 已提交
716 717 718
	NetSendPacket(NetTxPacket, pktlen);
}

719
#if defined(CONFIG_CMD_DHCP)
720
static void DhcpOptionsProcess (uchar * popt, Bootp_t *bp)
W
wdenk 已提交
721
{
W
wdenk 已提交
722
	uchar *end = popt + BOOTP_HDR_SIZE;
W
wdenk 已提交
723 724
	int oplen, size;

725
	while (popt < end && *popt != 0xff) {
W
wdenk 已提交
726
		oplen = *(popt + 1);
727 728 729 730
		switch (*popt) {
		case 1:
			NetCopyIP (&NetOurSubnetMask, (popt + 2));
			break;
731
#if defined(CONFIG_CMD_SNTP) && defined(CONFIG_BOOTP_TIMEOFFSET)
W
wdenk 已提交
732
		case 2:		/* Time offset	*/
W
Wolfgang Denk 已提交
733
			NetCopyLong ((ulong *)&NetTimeOffset, (ulong *) (popt + 2));
W
wdenk 已提交
734 735 736
			NetTimeOffset = ntohl (NetTimeOffset);
			break;
#endif
737 738 739 740 741
		case 3:
			NetCopyIP (&NetOurGatewayIP, (popt + 2));
			break;
		case 6:
			NetCopyIP (&NetOurDNSIP, (popt + 2));
742
#if defined(CONFIG_BOOTP_DNS2)
743 744 745
			if (*(popt + 1) > 4) {
				NetCopyIP (&NetOurDNS2IP, (popt + 2 + 4));
			}
746
#endif
747 748 749 750 751 752 753 754 755 756 757 758 759
			break;
		case 12:
			size = truncate_sz ("Host Name", sizeof (NetOurHostName), oplen);
			memcpy (&NetOurHostName, popt + 2, size);
			NetOurHostName[size] = 0;
			break;
		case 15:	/* Ignore Domain Name Option */
			break;
		case 17:
			size = truncate_sz ("Root Path", sizeof (NetOurRootPath), oplen);
			memcpy (&NetOurRootPath, popt + 2, size);
			NetOurRootPath[size] = 0;
			break;
760
#if defined(CONFIG_CMD_SNTP) && defined(CONFIG_BOOTP_NTPSERVER)
W
wdenk 已提交
761 762 763 764
		case 42:	/* NTP server IP */
			NetCopyIP (&NetNtpServerIP, (popt + 2));
			break;
#endif
765 766 767 768 769 770 771 772 773 774 775 776
		case 51:
			NetCopyLong (&dhcp_leasetime, (ulong *) (popt + 2));
			break;
		case 53:	/* Ignore Message Type Option */
			break;
		case 54:
			NetCopyIP (&NetDHCPServerIP, (popt + 2));
			break;
		case 58:	/* Ignore Renewal Time Option */
			break;
		case 59:	/* Ignore Rebinding Time Option */
			break;
777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804
		case 66:	/* Ignore TFTP server name */
			break;
		case 67:	/* vendor opt bootfile */
			/*
			 * I can't use dhcp_vendorex_proc here because I need
			 * to write into the bootp packet - even then I had to
			 * pass the bootp packet pointer into here as the
			 * second arg
			 */
			size = truncate_sz ("Opt Boot File",
					    sizeof(bp->bp_file),
					    oplen);
			if (bp->bp_file[0] == '\0' && size > 0) {
				/*
				 * only use vendor boot file if we didn't
				 * receive a boot file in the main non-vendor
				 * part of the packet - god only knows why
				 * some vendors chose not to use this perfectly
				 * good spot to store the boot file (join on
				 * Tru64 Unix) it seems mind bogglingly crazy
				 * to me
				 */
				printf("*** WARNING: using vendor "
					"optional boot file\n");
				memcpy(bp->bp_file, popt + 2, size);
				bp->bp_file[size] = '\0';
			}
			break;
805
		default:
806
#if defined(CONFIG_BOOTP_VENDOREX)
807
			if (dhcp_vendorex_proc (popt))
W
wdenk 已提交
808
				break;
W
wdenk 已提交
809
#endif
810 811
			printf ("*** Unhandled DHCP Option in OFFER/ACK: %d\n", *popt);
			break;
W
wdenk 已提交
812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830
		}
		popt += oplen + 2;	/* Process next option */
	}
}

static int DhcpMessageType(unsigned char *popt)
{
	if (NetReadLong((ulong*)popt) != htonl(BOOTP_VENDOR_MAGIC))
		return -1;

	popt += 4;
	while ( *popt != 0xff ) {
		if ( *popt == 53 )	/* DHCP Message Type */
			return *(popt + 2);
		popt += *(popt + 1) + 2;	/* Scan through all options */
	}
	return -1;
}

W
wdenk 已提交
831
static void DhcpSendRequestPkt(Bootp_t *bp_offer)
W
wdenk 已提交
832 833 834 835
{
	volatile uchar *pkt, *iphdr;
	Bootp_t *bp;
	int pktlen, iplen, extlen;
836
	IPaddr_t OfferedIP;
W
wdenk 已提交
837 838 839 840 841

	debug ("DhcpSendRequestPkt: Sending DHCPREQUEST\n");
	pkt = NetTxPacket;
	memset ((void*)pkt, 0, PKTSIZE);

842
	pkt += NetSetEther(pkt, NetBcastAddr, PROT_IP);
W
wdenk 已提交
843 844 845 846 847 848 849 850 851 852

	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_htype = HWT_ETHER;
	bp->bp_hlen = HWL_ETHER;
	bp->bp_hops = 0;
	bp->bp_secs = htons(get_timer(0) / CFG_HZ);
J
Justin Flammia 已提交
853 854 855
	/* Do not set the client IP, your IP, or server IP yet, since it hasn't been ACK'ed by
	 * the server yet */

W
Wolfgang Denk 已提交
856
	/*
857 858 859 860 861
	 * RFC3046 requires Relay Agents to discard packets with
	 * nonzero and offered giaddr
	 */
	NetWriteIP(&bp->bp_giaddr, 0);

W
wdenk 已提交
862 863 864 865 866 867 868 869 870 871 872
	memcpy (bp->bp_chaddr, NetOurEther, 6);

	/*
	 * ID is the id of the OFFER packet
	 */

	NetCopyLong(&bp->bp_id, &bp_offer->bp_id);

	/*
	 * Copy options from OFFER packet if present
	 */
J
Justin Flammia 已提交
873 874 875

	/* Copy offered IP into the parameters request list */
	NetCopyIP(&OfferedIP, &bp_offer->bp_yiaddr);
W
Wolfgang Denk 已提交
876
	extlen = DhcpExtended((u8 *)bp->bp_vend, DHCP_REQUEST, NetDHCPServerIP, OfferedIP);
W
wdenk 已提交
877 878 879 880 881

	pktlen = BOOTP_SIZE - sizeof(bp->bp_vend) + extlen;
	iplen = BOOTP_HDR_SIZE - sizeof(bp->bp_vend) + extlen;
	NetSetIP(iphdr, 0xFFFFFFFFL, PORT_BOOTPS, PORT_BOOTPC, iplen);

882
	debug ("Transmitting DHCPREQUEST packet: len = %d\n", pktlen);
883 884 885
#ifdef CONFIG_BOOTP_DHCP_REQUEST_DELAY
	udelay(CONFIG_BOOTP_DHCP_REQUEST_DELAY);
#endif	/* CONFIG_BOOTP_DHCP_REQUEST_DELAY */
W
wdenk 已提交
886 887 888 889 890 891 892 893 894 895 896 897 898 899
	NetSendPacket(NetTxPacket, pktlen);
}

/*
 *	Handle DHCP received packets.
 */
static void
DhcpHandler(uchar * pkt, unsigned dest, unsigned src, unsigned len)
{
	Bootp_t *bp = (Bootp_t *)pkt;

	debug ("DHCPHandler: got packet: (src=%d, dst=%d, len=%d) state: %d\n",
		src, dest, len, dhcp_state);

900
	if (BootpCheckPkt(pkt, dest, src, len)) /* Filter out pkts we don't want */
W
wdenk 已提交
901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922
		return;

	debug ("DHCPHandler: got DHCP packet: (src=%d, dst=%d, len=%d) state: %d\n",
		src, dest, len, dhcp_state);

	switch (dhcp_state) {
	case SELECTING:
		/*
		 * Wait an appropriate time for any potential DHCPOFFER packets
		 * to arrive.  Then select one, and generate DHCPREQUEST response.
		 * If filename is in format we recognize, assume it is a valid
		 * OFFER from a server we want.
		 */
		debug ("DHCP: state=SELECTING bp_file: \"%s\"\n", bp->bp_file);
#ifdef CFG_BOOTFILE_PREFIX
		if (strncmp(bp->bp_file,
			    CFG_BOOTFILE_PREFIX,
			    strlen(CFG_BOOTFILE_PREFIX)) == 0 ) {
#endif	/* CFG_BOOTFILE_PREFIX */

			debug ("TRANSITIONING TO REQUESTING STATE\n");
			dhcp_state = REQUESTING;
923

W
wdenk 已提交
924
			if (NetReadLong((ulong*)&bp->bp_vend[0]) == htonl(BOOTP_VENDOR_MAGIC))
925
				DhcpOptionsProcess((u8 *)&bp->bp_vend[4], bp);
W
wdenk 已提交
926 927 928 929 930 931 932 933 934 935 936 937

			NetSetTimeout(TIMEOUT * CFG_HZ, BootpTimeout);
			DhcpSendRequestPkt(bp);
#ifdef CFG_BOOTFILE_PREFIX
		}
#endif	/* CFG_BOOTFILE_PREFIX */

		return;
		break;
	case REQUESTING:
		debug ("DHCP State: REQUESTING\n");

W
Wolfgang Denk 已提交
938
		if ( DhcpMessageType((u8 *)bp->bp_vend) == DHCP_ACK ) {
W
wdenk 已提交
939 940 941
			char *s;

			if (NetReadLong((ulong*)&bp->bp_vend[0]) == htonl(BOOTP_VENDOR_MAGIC))
942
				DhcpOptionsProcess((u8 *)&bp->bp_vend[4], bp);
943
			BootpCopyNetParams(bp); /* Store net params from reply */
W
wdenk 已提交
944
			dhcp_state = BOUND;
945
			puts ("DHCP client bound to address ");
W
wdenk 已提交
946
			print_IPaddr(NetOurIP);
947
			putc ('\n');
W
wdenk 已提交
948 949

			/* Obey the 'autoload' setting */
W
wdenk 已提交
950 951 952 953 954 955 956 957
			if ((s = getenv("autoload")) != NULL) {
				if (*s == 'n') {
					/*
					 * Just use BOOTP to configure system;
					 * Do not use TFTP to load the bootfile.
					 */
					NetState = NETLOOP_SUCCESS;
					return;
958
#if defined(CONFIG_CMD_NFS)
W
wdenk 已提交
959 960 961 962 963 964
				} else if (strcmp(s, "NFS") == 0) {
					/*
					 * Use NFS to load the bootfile.
					 */
					NfsStart();
					return;
W
wdenk 已提交
965
#endif
W
wdenk 已提交
966
				}
W
wdenk 已提交
967
			}
W
wdenk 已提交
968
			TftpStart();
W
wdenk 已提交
969 970 971 972
			return;
		}
		break;
	default:
973
		puts ("DHCP: INVALID STATE\n");
W
wdenk 已提交
974 975 976 977 978 979 980 981 982
		break;
	}

}

void DhcpRequest(void)
{
	BootpRequest();
}
983
#endif	/* CONFIG_CMD_DHCP */
J
Justin Flammia 已提交
984

985
#endif	/* CONFIG_CMD_NET */