bootp.c 22.6 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		5000UL	/* Milliseconds 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");
M
Mike Frysinger 已提交
274 275
	if (NetOurSubnetMask)
		printf ("NetOurSubnetMask : %pI4\n", &NetOurSubnetMask);
276

M
Mike Frysinger 已提交
277 278
	if (NetOurGatewayIP)
		printf ("NetOurGatewayIP	: %pI4", &NetOurGatewayIP);
279 280 281 282

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

284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300
	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 已提交
301 302 303 304 305 306 307 308 309
/*
 *	Handle a BOOTP received packet.
 */
static void
BootpHandler(uchar * pkt, unsigned dest, unsigned src, unsigned len)
{
	Bootp_t *bp;
	char	*s;

310
	debug ("got BOOTP packet (src=%d, dst=%d, len=%d want_len=%zu)\n",
W
wdenk 已提交
311 312 313 314
		src, dest, len, sizeof (Bootp_t));

	bp = (Bootp_t *)pkt;

315
	if (BootpCheckPkt(pkt, dest, src, len)) /* Filter out pkts we don't want */
W
wdenk 已提交
316 317 318
		return;

	/*
319
	 *	Got a good BOOTP reply.	 Copy the data into our variables.
W
wdenk 已提交
320 321 322 323 324 325 326 327 328
	 */
#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 已提交
329
		BootpVendorProcess((uchar *)&bp->bp_vend[4], len);
W
wdenk 已提交
330 331 332 333 334

	NetSetTimeout(0, (thand_f *)0);

	debug ("Got good BOOTP\n");

W
wdenk 已提交
335 336 337 338 339 340 341 342
	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;
343
#if defined(CONFIG_CMD_NFS)
W
wdenk 已提交
344 345 346 347 348 349
		} else if (strcmp(s, "NFS") == 0) {
			/*
			 * Use NFS to load the bootfile.
			 */
			NfsStart();
			return;
W
wdenk 已提交
350
#endif
W
wdenk 已提交
351
		}
W
wdenk 已提交
352 353
	}

W
wdenk 已提交
354
	TftpStart();
W
wdenk 已提交
355
}
356
#endif
W
wdenk 已提交
357 358 359 360 361 362 363 364 365 366 367

/*
 *	Timeout on BOOTP/DHCP request.
 */
static void
BootpTimeout(void)
{
	if (BootpTry >= TIMEOUT_COUNT) {
		puts ("\nRetry count exceeded; starting again\n");
		NetStartAgain ();
	} else {
368
		NetSetTimeout (TIMEOUT, BootpTimeout);
W
wdenk 已提交
369 370 371 372 373 374 375
		BootpRequest ();
	}
}

/*
 *	Initialize BOOTP extension fields in the request.
 */
376
#if defined(CONFIG_CMD_DHCP)
377
static int DhcpExtended (u8 * e, int message_type, IPaddr_t ServerID, IPaddr_t RequestedIP)
W
wdenk 已提交
378
{
379 380 381
	u8 *start = e;
	u8 *cnt;

382
#if defined(CONFIG_BOOTP_VENDOREX)
383
	u8 *x;
W
wdenk 已提交
384
#endif
385
#if defined(CONFIG_BOOTP_SEND_HOSTNAME)
W
Wolfgang Denk 已提交
386
	char *hostname;
387
#endif
W
wdenk 已提交
388

389 390 391 392
	*e++ = 99;		/* RFC1048 Magic Cookie */
	*e++ = 130;
	*e++ = 83;
	*e++ = 99;
W
wdenk 已提交
393

394 395 396
	*e++ = 53;		/* DHCP Message Type */
	*e++ = 1;
	*e++ = message_type;
W
wdenk 已提交
397

398 399 400 401
	*e++ = 57;		/* Maximum DHCP Message Size */
	*e++ = 2;
	*e++ = (576 - 312 + OPT_SIZE) >> 8;
	*e++ = (576 - 312 + OPT_SIZE) & 0xff;
W
wdenk 已提交
402

403 404
	if (ServerID) {
		int tmp = ntohl (ServerID);
W
wdenk 已提交
405

406 407 408 409 410 411 412
		*e++ = 54;	/* ServerID */
		*e++ = 4;
		*e++ = tmp >> 24;
		*e++ = tmp >> 16;
		*e++ = tmp >> 8;
		*e++ = tmp & 0xff;
	}
W
wdenk 已提交
413

414 415
	if (RequestedIP) {
		int tmp = ntohl (RequestedIP);
W
wdenk 已提交
416

417 418 419 420 421 422 423
		*e++ = 50;	/* Requested IP */
		*e++ = 4;
		*e++ = tmp >> 24;
		*e++ = tmp >> 16;
		*e++ = tmp >> 8;
		*e++ = tmp & 0xff;
	}
424
#if defined(CONFIG_BOOTP_SEND_HOSTNAME)
425 426 427 428 429 430 431 432
	if ((hostname = getenv ("hostname"))) {
		int hostnamelen = strlen (hostname);

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

435
#if defined(CONFIG_BOOTP_VENDOREX)
436 437
	if ((x = dhcp_vendorex_prep (e)))
		return x - start;
W
wdenk 已提交
438 439
#endif

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

481
	/* Pad to minimal length */
W
wdenk 已提交
482
#ifdef	CONFIG_DHCP_MIN_EXT_LEN
483 484
	while ((e - start) <= CONFIG_DHCP_MIN_EXT_LEN)
		*e++ = 0;
W
wdenk 已提交
485 486
#endif

487
	return e - start;
W
wdenk 已提交
488 489
}

490
#else
W
wdenk 已提交
491
/*
492
 *	Warning: no field size check - change CONFIG_BOOTP_* at your own risk!
W
wdenk 已提交
493
 */
494
static int BootpExtended (u8 * e)
W
wdenk 已提交
495
{
496
	u8 *start = e;
W
wdenk 已提交
497

498 499 500 501
	*e++ = 99;		/* RFC1048 Magic Cookie */
	*e++ = 130;
	*e++ = 83;
	*e++ = 99;
W
wdenk 已提交
502

503
#if defined(CONFIG_CMD_DHCP)
504 505 506 507 508 509 510 511
	*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;
512
#endif
W
wdenk 已提交
513

514
#if defined(CONFIG_BOOTP_SUBNETMASK)
515 516 517
	*e++ = 1;		/* Subnet mask request */
	*e++ = 4;
	e   += 4;
W
wdenk 已提交
518 519
#endif

520
#if defined(CONFIG_BOOTP_GATEWAY)
521 522 523
	*e++ = 3;		/* Default gateway request */
	*e++ = 4;
	e   += 4;
W
wdenk 已提交
524 525
#endif

526
#if defined(CONFIG_BOOTP_DNS)
527 528 529
	*e++ = 6;		/* Domain Name Server */
	*e++ = 4;
	e   += 4;
W
wdenk 已提交
530 531
#endif

532
#if defined(CONFIG_BOOTP_HOSTNAME)
533 534 535
	*e++ = 12;		/* Host name request */
	*e++ = 32;
	e   += 32;
W
wdenk 已提交
536 537
#endif

538
#if defined(CONFIG_BOOTP_BOOTFILESIZE)
539 540 541
	*e++ = 13;		/* Boot file size */
	*e++ = 2;
	e   += 2;
W
wdenk 已提交
542 543
#endif

544
#if defined(CONFIG_BOOTP_BOOTPATH)
545 546 547
	*e++ = 17;		/* Boot path */
	*e++ = 32;
	e   += 32;
W
wdenk 已提交
548 549
#endif

550
#if defined(CONFIG_BOOTP_NISDOMAIN)
551 552 553
	*e++ = 40;		/* NIS Domain name request */
	*e++ = 32;
	e   += 32;
W
wdenk 已提交
554 555
#endif

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

558
	return e - start;
W
wdenk 已提交
559
}
560
#endif
W
wdenk 已提交
561 562 563 564 565 566 567 568

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

569
#if defined(CONFIG_CMD_DHCP)
W
wdenk 已提交
570 571 572 573 574 575 576 577 578 579
	dhcp_state = INIT;
#endif

#ifdef CONFIG_BOOTP_RANDOM_DELAY		/* Random BOOTP delay */
	unsigned char bi_enetaddr[6];
	int   reg;
	ulong tst1, tst2, sum, m_mask, m_value = 0;

	if (BootpTry ==0) {
		/* get our mac */
580 581
		eth_getenv_enetaddr("ethaddr", bi_enetaddr);

W
wdenk 已提交
582
#ifdef DEBUG
583
		puts ("BootpRequest => Our Mac: ");
W
wdenk 已提交
584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621
		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 已提交
622
		seed2 = seed1;
W
wdenk 已提交
623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641
		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);

642
	pkt += NetSetEther(pkt, NetBcastAddr, PROT_IP);
W
wdenk 已提交
643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658

	/*
	 * 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;
659
	bp->bp_secs = htons(get_timer(0) / 1000);
W
wdenk 已提交
660 661 662 663 664 665 666 667
	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 */
668
#if defined(CONFIG_CMD_DHCP)
W
Wolfgang Denk 已提交
669
	ext_len = DhcpExtended((u8 *)bp->bp_vend, DHCP_DISCOVER, 0, 0);
W
wdenk 已提交
670
#else
W
Wolfgang Denk 已提交
671
	ext_len = BootpExtended((u8 *)bp->bp_vend);
672
#endif
W
wdenk 已提交
673 674 675

	/*
	 *	Bootp ID is the lower 4 bytes of our ethernet address
676
	 *	plus the current time in ms.
W
wdenk 已提交
677 678 679 680 681 682
	 */
	BootpID = ((ulong)NetOurEther[2] << 24)
		| ((ulong)NetOurEther[3] << 16)
		| ((ulong)NetOurEther[4] << 8)
		| (ulong)NetOurEther[5];
	BootpID += get_timer(0);
683
	BootpID	 = htonl(BootpID);
W
wdenk 已提交
684 685 686 687 688 689
	NetCopyLong(&bp->bp_id, &BootpID);

	/*
	 * Calculate proper packet lengths taking into account the
	 * variable size of the options field
	 */
690
	pktlen = ((int)(pkt-NetTxPacket)) + BOOTP_HDR_SIZE - sizeof(bp->bp_vend) + ext_len;
W
wdenk 已提交
691 692
	iplen = BOOTP_HDR_SIZE - sizeof(bp->bp_vend) + ext_len;
	NetSetIP(iphdr, 0xFFFFFFFFL, PORT_BOOTPS, PORT_BOOTPC, iplen);
693
	NetSetTimeout(SELECT_TIMEOUT, BootpTimeout);
W
wdenk 已提交
694

695
#if defined(CONFIG_CMD_DHCP)
W
wdenk 已提交
696 697 698 699
	dhcp_state = SELECTING;
	NetSetHandler(DhcpHandler);
#else
	NetSetHandler(BootpHandler);
700
#endif
W
wdenk 已提交
701 702 703
	NetSendPacket(NetTxPacket, pktlen);
}

704
#if defined(CONFIG_CMD_DHCP)
705
static void DhcpOptionsProcess (uchar * popt, Bootp_t *bp)
W
wdenk 已提交
706
{
W
wdenk 已提交
707
	uchar *end = popt + BOOTP_HDR_SIZE;
W
wdenk 已提交
708 709
	int oplen, size;

710
	while (popt < end && *popt != 0xff) {
W
wdenk 已提交
711
		oplen = *(popt + 1);
712 713 714 715
		switch (*popt) {
		case 1:
			NetCopyIP (&NetOurSubnetMask, (popt + 2));
			break;
716
#if defined(CONFIG_CMD_SNTP) && defined(CONFIG_BOOTP_TIMEOFFSET)
W
wdenk 已提交
717
		case 2:		/* Time offset	*/
W
Wolfgang Denk 已提交
718
			NetCopyLong ((ulong *)&NetTimeOffset, (ulong *) (popt + 2));
W
wdenk 已提交
719 720 721
			NetTimeOffset = ntohl (NetTimeOffset);
			break;
#endif
722 723 724 725 726
		case 3:
			NetCopyIP (&NetOurGatewayIP, (popt + 2));
			break;
		case 6:
			NetCopyIP (&NetOurDNSIP, (popt + 2));
727
#if defined(CONFIG_BOOTP_DNS2)
728 729 730
			if (*(popt + 1) > 4) {
				NetCopyIP (&NetOurDNS2IP, (popt + 2 + 4));
			}
731
#endif
732 733 734 735 736 737 738 739 740 741 742 743 744
			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;
745
#if defined(CONFIG_CMD_SNTP) && defined(CONFIG_BOOTP_NTPSERVER)
W
wdenk 已提交
746 747 748 749
		case 42:	/* NTP server IP */
			NetCopyIP (&NetNtpServerIP, (popt + 2));
			break;
#endif
750 751 752 753 754 755 756 757 758 759 760 761
		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;
762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789
		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;
790
		default:
791
#if defined(CONFIG_BOOTP_VENDOREX)
792
			if (dhcp_vendorex_proc (popt))
W
wdenk 已提交
793
				break;
W
wdenk 已提交
794
#endif
795 796
			printf ("*** Unhandled DHCP Option in OFFER/ACK: %d\n", *popt);
			break;
W
wdenk 已提交
797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815
		}
		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 已提交
816
static void DhcpSendRequestPkt(Bootp_t *bp_offer)
W
wdenk 已提交
817 818 819 820
{
	volatile uchar *pkt, *iphdr;
	Bootp_t *bp;
	int pktlen, iplen, extlen;
821
	IPaddr_t OfferedIP;
W
wdenk 已提交
822 823 824 825 826

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

827
	pkt += NetSetEther(pkt, NetBcastAddr, PROT_IP);
W
wdenk 已提交
828 829 830 831 832 833 834 835 836

	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;
837
	bp->bp_secs = htons(get_timer(0) / 1000);
J
Justin Flammia 已提交
838 839 840
	/* 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 已提交
841
	/*
842 843 844 845 846
	 * RFC3046 requires Relay Agents to discard packets with
	 * nonzero and offered giaddr
	 */
	NetWriteIP(&bp->bp_giaddr, 0);

W
wdenk 已提交
847 848 849 850 851 852 853 854 855 856 857
	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 已提交
858 859 860

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

863
	pktlen = ((int)(pkt-NetTxPacket)) + BOOTP_HDR_SIZE - sizeof(bp->bp_vend) + extlen;
W
wdenk 已提交
864 865 866
	iplen = BOOTP_HDR_SIZE - sizeof(bp->bp_vend) + extlen;
	NetSetIP(iphdr, 0xFFFFFFFFL, PORT_BOOTPS, PORT_BOOTPC, iplen);

867
	debug ("Transmitting DHCPREQUEST packet: len = %d\n", pktlen);
868 869 870
#ifdef CONFIG_BOOTP_DHCP_REQUEST_DELAY
	udelay(CONFIG_BOOTP_DHCP_REQUEST_DELAY);
#endif	/* CONFIG_BOOTP_DHCP_REQUEST_DELAY */
W
wdenk 已提交
871 872 873 874 875 876 877 878 879 880 881 882 883 884
	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);

885
	if (BootpCheckPkt(pkt, dest, src, len)) /* Filter out pkts we don't want */
W
wdenk 已提交
886 887 888 889 890 891 892 893 894 895 896 897 898 899
		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);
900
#ifdef CONFIG_SYS_BOOTFILE_PREFIX
W
wdenk 已提交
901
		if (strncmp(bp->bp_file,
902 903 904
			    CONFIG_SYS_BOOTFILE_PREFIX,
			    strlen(CONFIG_SYS_BOOTFILE_PREFIX)) == 0 ) {
#endif	/* CONFIG_SYS_BOOTFILE_PREFIX */
W
wdenk 已提交
905 906 907

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

W
wdenk 已提交
909
			if (NetReadLong((ulong*)&bp->bp_vend[0]) == htonl(BOOTP_VENDOR_MAGIC))
910
				DhcpOptionsProcess((u8 *)&bp->bp_vend[4], bp);
W
wdenk 已提交
911

912
			NetSetTimeout(TIMEOUT, BootpTimeout);
W
wdenk 已提交
913
			DhcpSendRequestPkt(bp);
914
#ifdef CONFIG_SYS_BOOTFILE_PREFIX
W
wdenk 已提交
915
		}
916
#endif	/* CONFIG_SYS_BOOTFILE_PREFIX */
W
wdenk 已提交
917 918 919 920 921 922

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

W
Wolfgang Denk 已提交
923
		if ( DhcpMessageType((u8 *)bp->bp_vend) == DHCP_ACK ) {
W
wdenk 已提交
924 925 926
			char *s;

			if (NetReadLong((ulong*)&bp->bp_vend[0]) == htonl(BOOTP_VENDOR_MAGIC))
927
				DhcpOptionsProcess((u8 *)&bp->bp_vend[4], bp);
928
			BootpCopyNetParams(bp); /* Store net params from reply */
W
wdenk 已提交
929
			dhcp_state = BOUND;
M
Mike Frysinger 已提交
930
			printf ("DHCP client bound to address %pI4\n", &NetOurIP);
W
wdenk 已提交
931 932

			/* Obey the 'autoload' setting */
W
wdenk 已提交
933 934 935 936 937 938 939 940
			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;
941
#if defined(CONFIG_CMD_NFS)
W
wdenk 已提交
942 943 944 945 946 947
				} else if (strcmp(s, "NFS") == 0) {
					/*
					 * Use NFS to load the bootfile.
					 */
					NfsStart();
					return;
W
wdenk 已提交
948
#endif
W
wdenk 已提交
949
				}
W
wdenk 已提交
950
			}
W
wdenk 已提交
951
			TftpStart();
W
wdenk 已提交
952 953 954
			return;
		}
		break;
955 956 957
	case BOUND:
		/* DHCP client bound to address */
		break;
W
wdenk 已提交
958
	default:
959
		puts ("DHCP: INVALID STATE\n");
W
wdenk 已提交
960 961 962 963 964 965 966 967 968
		break;
	}

}

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

971
#endif	/* CONFIG_CMD_NET */