1 /* 2 * Based on LiMon - BOOTP. 3 * 4 * Copyright 1994, 1995, 2000 Neil Russell. 5 * (See License) 6 * Copyright 2000 Roland Borde 7 * Copyright 2000 Paolo Scaffardi 8 * Copyright 2000-2004 Wolfgang Denk, wd@denx.de 9 */ 10 11 #include <common.h> 12 #include <command.h> 13 #include <net.h> 14 #include "bootp.h" 15 #include "tftp.h" 16 #include "nfs.h" 17 #ifdef CONFIG_STATUS_LED 18 #include <status_led.h> 19 #endif 20 #ifdef CONFIG_BOOTP_RANDOM_DELAY 21 #include "net_rand.h" 22 #endif 23 24 #define BOOTP_VENDOR_MAGIC 0x63825363 /* RFC1048 Magic Cookie */ 25 26 /* 27 * The timeout for the initial BOOTP/DHCP request used to be described by a 28 * counter of fixed-length timeout periods. TIMEOUT_COUNT represents 29 * that counter 30 * 31 * Now that the timeout periods are variable (exponential backoff and retry) 32 * we convert the timeout count to the absolute time it would have take to 33 * execute that many retries, and keep sending retry packets until that time 34 * is reached. 35 */ 36 #ifndef CONFIG_NET_RETRY_COUNT 37 # define TIMEOUT_COUNT 5 /* # of timeouts before giving up */ 38 #else 39 # define TIMEOUT_COUNT (CONFIG_NET_RETRY_COUNT) 40 #endif 41 #define TIMEOUT_MS ((3 + (TIMEOUT_COUNT * 5)) * 1000) 42 43 #define PORT_BOOTPS 67 /* BOOTP server UDP port */ 44 #define PORT_BOOTPC 68 /* BOOTP client UDP port */ 45 46 #ifndef CONFIG_DHCP_MIN_EXT_LEN /* minimal length of extension list */ 47 #define CONFIG_DHCP_MIN_EXT_LEN 64 48 #endif 49 50 #ifndef CONFIG_BOOTP_ID_CACHE_SIZE 51 #define CONFIG_BOOTP_ID_CACHE_SIZE 4 52 #endif 53 54 ulong bootp_ids[CONFIG_BOOTP_ID_CACHE_SIZE]; 55 unsigned int bootp_num_ids; 56 int BootpTry; 57 ulong bootp_start; 58 ulong bootp_timeout; 59 60 #if defined(CONFIG_CMD_DHCP) 61 static dhcp_state_t dhcp_state = INIT; 62 static unsigned long dhcp_leasetime; 63 static IPaddr_t NetDHCPServerIP; 64 static void DhcpHandler(uchar *pkt, unsigned dest, IPaddr_t sip, unsigned src, 65 unsigned len); 66 67 /* For Debug */ 68 #if 0 69 static char *dhcpmsg2str(int type) 70 { 71 switch (type) { 72 case 1: return "DHCPDISCOVER"; break; 73 case 2: return "DHCPOFFER"; break; 74 case 3: return "DHCPREQUEST"; break; 75 case 4: return "DHCPDECLINE"; break; 76 case 5: return "DHCPACK"; break; 77 case 6: return "DHCPNACK"; break; 78 case 7: return "DHCPRELEASE"; break; 79 default: return "UNKNOWN/INVALID MSG TYPE"; break; 80 } 81 } 82 #endif 83 #endif 84 85 static void bootp_add_id(ulong id) 86 { 87 if (bootp_num_ids >= ARRAY_SIZE(bootp_ids)) { 88 size_t size = sizeof(bootp_ids) - sizeof(id); 89 90 memmove(bootp_ids, &bootp_ids[1], size); 91 bootp_ids[bootp_num_ids - 1] = id; 92 } else { 93 bootp_ids[bootp_num_ids] = id; 94 bootp_num_ids++; 95 } 96 } 97 98 static bool bootp_match_id(ulong id) 99 { 100 unsigned int i; 101 102 for (i = 0; i < bootp_num_ids; i++) 103 if (bootp_ids[i] == id) 104 return true; 105 106 return false; 107 } 108 109 static int BootpCheckPkt(uchar *pkt, unsigned dest, unsigned src, unsigned len) 110 { 111 struct Bootp_t *bp = (struct Bootp_t *) pkt; 112 int retval = 0; 113 114 if (dest != PORT_BOOTPC || src != PORT_BOOTPS) 115 retval = -1; 116 else if (len < sizeof(struct Bootp_t) - OPT_FIELD_SIZE) 117 retval = -2; 118 else if (bp->bp_op != OP_BOOTREQUEST && 119 bp->bp_op != OP_BOOTREPLY && 120 bp->bp_op != DHCP_OFFER && 121 bp->bp_op != DHCP_ACK && 122 bp->bp_op != DHCP_NAK) 123 retval = -3; 124 else if (bp->bp_htype != HWT_ETHER) 125 retval = -4; 126 else if (bp->bp_hlen != HWL_ETHER) 127 retval = -5; 128 else if (!bootp_match_id(NetReadLong((ulong *)&bp->bp_id))) 129 retval = -6; 130 131 debug("Filtering pkt = %d\n", retval); 132 133 return retval; 134 } 135 136 /* 137 * Copy parameters of interest from BOOTP_REPLY/DHCP_OFFER packet 138 */ 139 static void BootpCopyNetParams(struct Bootp_t *bp) 140 { 141 #if !defined(CONFIG_BOOTP_SERVERIP) 142 IPaddr_t tmp_ip; 143 144 NetCopyIP(&tmp_ip, &bp->bp_siaddr); 145 if (tmp_ip != 0) 146 NetCopyIP(&NetServerIP, &bp->bp_siaddr); 147 memcpy(NetServerEther, ((struct ethernet_hdr *)NetRxPacket)->et_src, 6); 148 #endif 149 NetCopyIP(&NetOurIP, &bp->bp_yiaddr); 150 if (strlen(bp->bp_file) > 0) 151 copy_filename(BootFile, bp->bp_file, sizeof(BootFile)); 152 153 debug("Bootfile: %s\n", BootFile); 154 155 /* Propagate to environment: 156 * don't delete exising entry when BOOTP / DHCP reply does 157 * not contain a new value 158 */ 159 if (*BootFile) 160 setenv("bootfile", BootFile); 161 } 162 163 static int truncate_sz(const char *name, int maxlen, int curlen) 164 { 165 if (curlen >= maxlen) { 166 printf("*** WARNING: %s is too long (%d - max: %d)" 167 " - truncated\n", name, curlen, maxlen); 168 curlen = maxlen - 1; 169 } 170 return curlen; 171 } 172 173 #if !defined(CONFIG_CMD_DHCP) 174 175 static void BootpVendorFieldProcess(u8 *ext) 176 { 177 int size = *(ext + 1); 178 179 debug("[BOOTP] Processing extension %d... (%d bytes)\n", *ext, 180 *(ext + 1)); 181 182 NetBootFileSize = 0; 183 184 switch (*ext) { 185 /* Fixed length fields */ 186 case 1: /* Subnet mask */ 187 if (NetOurSubnetMask == 0) 188 NetCopyIP(&NetOurSubnetMask, (IPaddr_t *) (ext + 2)); 189 break; 190 case 2: /* Time offset - Not yet supported */ 191 break; 192 /* Variable length fields */ 193 case 3: /* Gateways list */ 194 if (NetOurGatewayIP == 0) 195 NetCopyIP(&NetOurGatewayIP, (IPaddr_t *) (ext + 2)); 196 break; 197 case 4: /* Time server - Not yet supported */ 198 break; 199 case 5: /* IEN-116 name server - Not yet supported */ 200 break; 201 case 6: 202 if (NetOurDNSIP == 0) 203 NetCopyIP(&NetOurDNSIP, (IPaddr_t *) (ext + 2)); 204 #if defined(CONFIG_BOOTP_DNS2) 205 if ((NetOurDNS2IP == 0) && (size > 4)) 206 NetCopyIP(&NetOurDNS2IP, (IPaddr_t *) (ext + 2 + 4)); 207 #endif 208 break; 209 case 7: /* Log server - Not yet supported */ 210 break; 211 case 8: /* Cookie/Quote server - Not yet supported */ 212 break; 213 case 9: /* LPR server - Not yet supported */ 214 break; 215 case 10: /* Impress server - Not yet supported */ 216 break; 217 case 11: /* RPL server - Not yet supported */ 218 break; 219 case 12: /* Host name */ 220 if (NetOurHostName[0] == 0) { 221 size = truncate_sz("Host Name", 222 sizeof(NetOurHostName), size); 223 memcpy(&NetOurHostName, ext + 2, size); 224 NetOurHostName[size] = 0; 225 } 226 break; 227 case 13: /* Boot file size */ 228 if (size == 2) 229 NetBootFileSize = ntohs(*(ushort *) (ext + 2)); 230 else if (size == 4) 231 NetBootFileSize = ntohl(*(ulong *) (ext + 2)); 232 break; 233 case 14: /* Merit dump file - Not yet supported */ 234 break; 235 case 15: /* Domain name - Not yet supported */ 236 break; 237 case 16: /* Swap server - Not yet supported */ 238 break; 239 case 17: /* Root path */ 240 if (NetOurRootPath[0] == 0) { 241 size = truncate_sz("Root Path", 242 sizeof(NetOurRootPath), size); 243 memcpy(&NetOurRootPath, ext + 2, size); 244 NetOurRootPath[size] = 0; 245 } 246 break; 247 case 18: /* Extension path - Not yet supported */ 248 /* 249 * This can be used to send the information of the 250 * vendor area in another file that the client can 251 * access via TFTP. 252 */ 253 break; 254 /* IP host layer fields */ 255 case 40: /* NIS Domain name */ 256 if (NetOurNISDomain[0] == 0) { 257 size = truncate_sz("NIS Domain Name", 258 sizeof(NetOurNISDomain), size); 259 memcpy(&NetOurNISDomain, ext + 2, size); 260 NetOurNISDomain[size] = 0; 261 } 262 break; 263 #if defined(CONFIG_CMD_SNTP) && defined(CONFIG_BOOTP_NTPSERVER) 264 case 42: /* NTP server IP */ 265 NetCopyIP(&NetNtpServerIP, (IPaddr_t *) (ext + 2)); 266 break; 267 #endif 268 /* Application layer fields */ 269 case 43: /* Vendor specific info - Not yet supported */ 270 /* 271 * Binary information to exchange specific 272 * product information. 273 */ 274 break; 275 /* Reserved (custom) fields (128..254) */ 276 } 277 } 278 279 static void BootpVendorProcess(u8 *ext, int size) 280 { 281 u8 *end = ext + size; 282 283 debug("[BOOTP] Checking extension (%d bytes)...\n", size); 284 285 while ((ext < end) && (*ext != 0xff)) { 286 if (*ext == 0) { 287 ext++; 288 } else { 289 u8 *opt = ext; 290 291 ext += ext[1] + 2; 292 if (ext <= end) 293 BootpVendorFieldProcess(opt); 294 } 295 } 296 297 debug("[BOOTP] Received fields:\n"); 298 if (NetOurSubnetMask) 299 debug("NetOurSubnetMask : %pI4\n", &NetOurSubnetMask); 300 301 if (NetOurGatewayIP) 302 debug("NetOurGatewayIP : %pI4", &NetOurGatewayIP); 303 304 if (NetBootFileSize) 305 debug("NetBootFileSize : %d\n", NetBootFileSize); 306 307 if (NetOurHostName[0]) 308 debug("NetOurHostName : %s\n", NetOurHostName); 309 310 if (NetOurRootPath[0]) 311 debug("NetOurRootPath : %s\n", NetOurRootPath); 312 313 if (NetOurNISDomain[0]) 314 debug("NetOurNISDomain : %s\n", NetOurNISDomain); 315 316 if (NetBootFileSize) 317 debug("NetBootFileSize: %d\n", NetBootFileSize); 318 319 #if defined(CONFIG_CMD_SNTP) && defined(CONFIG_BOOTP_NTPSERVER) 320 if (NetNtpServerIP) 321 debug("NetNtpServerIP : %pI4\n", &NetNtpServerIP); 322 #endif 323 } 324 325 /* 326 * Handle a BOOTP received packet. 327 */ 328 static void 329 BootpHandler(uchar *pkt, unsigned dest, IPaddr_t sip, unsigned src, 330 unsigned len) 331 { 332 struct Bootp_t *bp; 333 334 debug("got BOOTP packet (src=%d, dst=%d, len=%d want_len=%zu)\n", 335 src, dest, len, sizeof(struct Bootp_t)); 336 337 bp = (struct Bootp_t *)pkt; 338 339 /* Filter out pkts we don't want */ 340 if (BootpCheckPkt(pkt, dest, src, len)) 341 return; 342 343 /* 344 * Got a good BOOTP reply. Copy the data into our variables. 345 */ 346 #ifdef CONFIG_STATUS_LED 347 status_led_set(STATUS_LED_BOOT, STATUS_LED_OFF); 348 #endif 349 350 BootpCopyNetParams(bp); /* Store net parameters from reply */ 351 352 /* Retrieve extended information (we must parse the vendor area) */ 353 if (NetReadLong((ulong *)&bp->bp_vend[0]) == htonl(BOOTP_VENDOR_MAGIC)) 354 BootpVendorProcess((uchar *)&bp->bp_vend[4], len); 355 356 NetSetTimeout(0, (thand_f *)0); 357 bootstage_mark_name(BOOTSTAGE_ID_BOOTP_STOP, "bootp_stop"); 358 359 debug("Got good BOOTP\n"); 360 361 net_auto_load(); 362 } 363 #endif 364 365 /* 366 * Timeout on BOOTP/DHCP request. 367 */ 368 static void 369 BootpTimeout(void) 370 { 371 ulong time_taken = get_timer(bootp_start); 372 373 if (time_taken >= TIMEOUT_MS) { 374 #ifdef CONFIG_BOOTP_MAY_FAIL 375 puts("\nRetry time exceeded\n"); 376 net_set_state(NETLOOP_FAIL); 377 #else 378 puts("\nRetry time exceeded; starting again\n"); 379 NetStartAgain(); 380 #endif 381 } else { 382 bootp_timeout *= 2; 383 if (bootp_timeout > 2000) 384 bootp_timeout = 2000; 385 NetSetTimeout(bootp_timeout, BootpTimeout); 386 BootpRequest(); 387 } 388 } 389 390 #define put_vci(e, str) \ 391 do { \ 392 size_t vci_strlen = strlen(str); \ 393 *e++ = 60; /* Vendor Class Identifier */ \ 394 *e++ = vci_strlen; \ 395 memcpy(e, str, vci_strlen); \ 396 e += vci_strlen; \ 397 } while (0) 398 399 /* 400 * Initialize BOOTP extension fields in the request. 401 */ 402 #if defined(CONFIG_CMD_DHCP) 403 static int DhcpExtended(u8 *e, int message_type, IPaddr_t ServerID, 404 IPaddr_t RequestedIP) 405 { 406 u8 *start = e; 407 u8 *cnt; 408 #if defined(CONFIG_BOOTP_PXE) 409 char *uuid; 410 u16 clientarch; 411 #endif 412 413 #if defined(CONFIG_BOOTP_VENDOREX) 414 u8 *x; 415 #endif 416 #if defined(CONFIG_BOOTP_SEND_HOSTNAME) 417 char *hostname; 418 #endif 419 420 *e++ = 99; /* RFC1048 Magic Cookie */ 421 *e++ = 130; 422 *e++ = 83; 423 *e++ = 99; 424 425 *e++ = 53; /* DHCP Message Type */ 426 *e++ = 1; 427 *e++ = message_type; 428 429 *e++ = 57; /* Maximum DHCP Message Size */ 430 *e++ = 2; 431 *e++ = (576 - 312 + OPT_FIELD_SIZE) >> 8; 432 *e++ = (576 - 312 + OPT_FIELD_SIZE) & 0xff; 433 434 if (ServerID) { 435 int tmp = ntohl(ServerID); 436 437 *e++ = 54; /* ServerID */ 438 *e++ = 4; 439 *e++ = tmp >> 24; 440 *e++ = tmp >> 16; 441 *e++ = tmp >> 8; 442 *e++ = tmp & 0xff; 443 } 444 445 if (RequestedIP) { 446 int tmp = ntohl(RequestedIP); 447 448 *e++ = 50; /* Requested IP */ 449 *e++ = 4; 450 *e++ = tmp >> 24; 451 *e++ = tmp >> 16; 452 *e++ = tmp >> 8; 453 *e++ = tmp & 0xff; 454 } 455 #if defined(CONFIG_BOOTP_SEND_HOSTNAME) 456 hostname = getenv("hostname"); 457 if (hostname) { 458 int hostnamelen = strlen(hostname); 459 460 *e++ = 12; /* Hostname */ 461 *e++ = hostnamelen; 462 memcpy(e, hostname, hostnamelen); 463 e += hostnamelen; 464 } 465 #endif 466 467 #if defined(CONFIG_BOOTP_PXE) 468 clientarch = CONFIG_BOOTP_PXE_CLIENTARCH; 469 *e++ = 93; /* Client System Architecture */ 470 *e++ = 2; 471 *e++ = (clientarch >> 8) & 0xff; 472 *e++ = clientarch & 0xff; 473 474 *e++ = 94; /* Client Network Interface Identifier */ 475 *e++ = 3; 476 *e++ = 1; /* type field for UNDI */ 477 *e++ = 0; /* major revision */ 478 *e++ = 0; /* minor revision */ 479 480 uuid = getenv("pxeuuid"); 481 482 if (uuid) { 483 if (uuid_str_valid(uuid)) { 484 *e++ = 97; /* Client Machine Identifier */ 485 *e++ = 17; 486 *e++ = 0; /* type 0 - UUID */ 487 488 uuid_str_to_bin(uuid, e, UUID_STR_FORMAT_STD); 489 e += 16; 490 } else { 491 printf("Invalid pxeuuid: %s\n", uuid); 492 } 493 } 494 #endif 495 496 #ifdef CONFIG_BOOTP_VCI_STRING 497 put_vci(e, CONFIG_BOOTP_VCI_STRING); 498 #endif 499 500 #if defined(CONFIG_BOOTP_VENDOREX) 501 x = dhcp_vendorex_prep(e); 502 if (x) 503 return x - start; 504 #endif 505 506 *e++ = 55; /* Parameter Request List */ 507 cnt = e++; /* Pointer to count of requested items */ 508 *cnt = 0; 509 #if defined(CONFIG_BOOTP_SUBNETMASK) 510 *e++ = 1; /* Subnet Mask */ 511 *cnt += 1; 512 #endif 513 #if defined(CONFIG_BOOTP_TIMEOFFSET) 514 *e++ = 2; 515 *cnt += 1; 516 #endif 517 #if defined(CONFIG_BOOTP_GATEWAY) 518 *e++ = 3; /* Router Option */ 519 *cnt += 1; 520 #endif 521 #if defined(CONFIG_BOOTP_DNS) 522 *e++ = 6; /* DNS Server(s) */ 523 *cnt += 1; 524 #endif 525 #if defined(CONFIG_BOOTP_HOSTNAME) 526 *e++ = 12; /* Hostname */ 527 *cnt += 1; 528 #endif 529 #if defined(CONFIG_BOOTP_BOOTFILESIZE) 530 *e++ = 13; /* Boot File Size */ 531 *cnt += 1; 532 #endif 533 #if defined(CONFIG_BOOTP_BOOTPATH) 534 *e++ = 17; /* Boot path */ 535 *cnt += 1; 536 #endif 537 #if defined(CONFIG_BOOTP_NISDOMAIN) 538 *e++ = 40; /* NIS Domain name request */ 539 *cnt += 1; 540 #endif 541 #if defined(CONFIG_BOOTP_NTPSERVER) 542 *e++ = 42; 543 *cnt += 1; 544 #endif 545 /* no options, so back up to avoid sending an empty request list */ 546 if (*cnt == 0) 547 e -= 2; 548 549 *e++ = 255; /* End of the list */ 550 551 /* Pad to minimal length */ 552 #ifdef CONFIG_DHCP_MIN_EXT_LEN 553 while ((e - start) < CONFIG_DHCP_MIN_EXT_LEN) 554 *e++ = 0; 555 #endif 556 557 return e - start; 558 } 559 560 #else 561 /* 562 * Warning: no field size check - change CONFIG_BOOTP_* at your own risk! 563 */ 564 static int BootpExtended(u8 *e) 565 { 566 u8 *start = e; 567 568 *e++ = 99; /* RFC1048 Magic Cookie */ 569 *e++ = 130; 570 *e++ = 83; 571 *e++ = 99; 572 573 #if defined(CONFIG_CMD_DHCP) 574 *e++ = 53; /* DHCP Message Type */ 575 *e++ = 1; 576 *e++ = DHCP_DISCOVER; 577 578 *e++ = 57; /* Maximum DHCP Message Size */ 579 *e++ = 2; 580 *e++ = (576 - 312 + OPT_FIELD_SIZE) >> 16; 581 *e++ = (576 - 312 + OPT_FIELD_SIZE) & 0xff; 582 #endif 583 584 #if defined(CONFIG_BOOTP_VCI_STRING) || \ 585 (defined(CONFIG_SPL_BUILD) && defined(CONFIG_SPL_NET_VCI_STRING)) 586 #ifdef CONFIG_SPL_BUILD 587 put_vci(e, CONFIG_SPL_NET_VCI_STRING); 588 #else 589 put_vci(e, CONFIG_BOOTP_VCI_STRING); 590 #endif 591 #endif 592 593 #if defined(CONFIG_BOOTP_SUBNETMASK) 594 *e++ = 1; /* Subnet mask request */ 595 *e++ = 4; 596 e += 4; 597 #endif 598 599 #if defined(CONFIG_BOOTP_GATEWAY) 600 *e++ = 3; /* Default gateway request */ 601 *e++ = 4; 602 e += 4; 603 #endif 604 605 #if defined(CONFIG_BOOTP_DNS) 606 *e++ = 6; /* Domain Name Server */ 607 *e++ = 4; 608 e += 4; 609 #endif 610 611 #if defined(CONFIG_BOOTP_HOSTNAME) 612 *e++ = 12; /* Host name request */ 613 *e++ = 32; 614 e += 32; 615 #endif 616 617 #if defined(CONFIG_BOOTP_BOOTFILESIZE) 618 *e++ = 13; /* Boot file size */ 619 *e++ = 2; 620 e += 2; 621 #endif 622 623 #if defined(CONFIG_BOOTP_BOOTPATH) 624 *e++ = 17; /* Boot path */ 625 *e++ = 32; 626 e += 32; 627 #endif 628 629 #if defined(CONFIG_BOOTP_NISDOMAIN) 630 *e++ = 40; /* NIS Domain name request */ 631 *e++ = 32; 632 e += 32; 633 #endif 634 #if defined(CONFIG_BOOTP_NTPSERVER) 635 *e++ = 42; 636 *e++ = 4; 637 e += 4; 638 #endif 639 640 *e++ = 255; /* End of the list */ 641 642 return e - start; 643 } 644 #endif 645 646 void BootpReset(void) 647 { 648 bootp_num_ids = 0; 649 BootpTry = 0; 650 bootp_start = get_timer(0); 651 bootp_timeout = 250; 652 } 653 654 void 655 BootpRequest(void) 656 { 657 uchar *pkt, *iphdr; 658 struct Bootp_t *bp; 659 int extlen, pktlen, iplen; 660 int eth_hdr_size; 661 #ifdef CONFIG_BOOTP_RANDOM_DELAY 662 ulong rand_ms; 663 #endif 664 ulong BootpID; 665 666 bootstage_mark_name(BOOTSTAGE_ID_BOOTP_START, "bootp_start"); 667 #if defined(CONFIG_CMD_DHCP) 668 dhcp_state = INIT; 669 #endif 670 671 #ifdef CONFIG_BOOTP_RANDOM_DELAY /* Random BOOTP delay */ 672 if (BootpTry == 0) 673 srand_mac(); 674 675 if (BootpTry <= 2) /* Start with max 1024 * 1ms */ 676 rand_ms = rand() >> (22 - BootpTry); 677 else /* After 3rd BOOTP request max 8192 * 1ms */ 678 rand_ms = rand() >> 19; 679 680 printf("Random delay: %ld ms...\n", rand_ms); 681 mdelay(rand_ms); 682 683 #endif /* CONFIG_BOOTP_RANDOM_DELAY */ 684 685 printf("BOOTP broadcast %d\n", ++BootpTry); 686 pkt = NetTxPacket; 687 memset((void *)pkt, 0, PKTSIZE); 688 689 eth_hdr_size = NetSetEther(pkt, NetBcastAddr, PROT_IP); 690 pkt += eth_hdr_size; 691 692 /* 693 * Next line results in incorrect packet size being transmitted, 694 * resulting in errors in some DHCP servers, reporting missing bytes. 695 * Size must be set in packet header after extension length has been 696 * determined. 697 * C. Hallinan, DS4.COM, Inc. 698 */ 699 /* net_set_udp_header(pkt, 0xFFFFFFFFL, PORT_BOOTPS, PORT_BOOTPC, 700 sizeof (struct Bootp_t)); */ 701 iphdr = pkt; /* We need this later for net_set_udp_header() */ 702 pkt += IP_UDP_HDR_SIZE; 703 704 bp = (struct Bootp_t *)pkt; 705 bp->bp_op = OP_BOOTREQUEST; 706 bp->bp_htype = HWT_ETHER; 707 bp->bp_hlen = HWL_ETHER; 708 bp->bp_hops = 0; 709 bp->bp_secs = htons(get_timer(0) / 1000); 710 NetWriteIP(&bp->bp_ciaddr, 0); 711 NetWriteIP(&bp->bp_yiaddr, 0); 712 NetWriteIP(&bp->bp_siaddr, 0); 713 NetWriteIP(&bp->bp_giaddr, 0); 714 memcpy(bp->bp_chaddr, NetOurEther, 6); 715 copy_filename(bp->bp_file, BootFile, sizeof(bp->bp_file)); 716 717 /* Request additional information from the BOOTP/DHCP server */ 718 #if defined(CONFIG_CMD_DHCP) 719 extlen = DhcpExtended((u8 *)bp->bp_vend, DHCP_DISCOVER, 0, 0); 720 #else 721 extlen = BootpExtended((u8 *)bp->bp_vend); 722 #endif 723 724 /* 725 * Bootp ID is the lower 4 bytes of our ethernet address 726 * plus the current time in ms. 727 */ 728 BootpID = ((ulong)NetOurEther[2] << 24) 729 | ((ulong)NetOurEther[3] << 16) 730 | ((ulong)NetOurEther[4] << 8) 731 | (ulong)NetOurEther[5]; 732 BootpID += get_timer(0); 733 BootpID = htonl(BootpID); 734 bootp_add_id(BootpID); 735 NetCopyLong(&bp->bp_id, &BootpID); 736 737 /* 738 * Calculate proper packet lengths taking into account the 739 * variable size of the options field 740 */ 741 iplen = BOOTP_HDR_SIZE - OPT_FIELD_SIZE + extlen; 742 pktlen = eth_hdr_size + IP_UDP_HDR_SIZE + iplen; 743 net_set_udp_header(iphdr, 0xFFFFFFFFL, PORT_BOOTPS, PORT_BOOTPC, iplen); 744 NetSetTimeout(bootp_timeout, BootpTimeout); 745 746 #if defined(CONFIG_CMD_DHCP) 747 dhcp_state = SELECTING; 748 net_set_udp_handler(DhcpHandler); 749 #else 750 net_set_udp_handler(BootpHandler); 751 #endif 752 NetSendPacket(NetTxPacket, pktlen); 753 } 754 755 #if defined(CONFIG_CMD_DHCP) 756 static void DhcpOptionsProcess(uchar *popt, struct Bootp_t *bp) 757 { 758 uchar *end = popt + BOOTP_HDR_SIZE; 759 int oplen, size; 760 #if defined(CONFIG_CMD_SNTP) && defined(CONFIG_BOOTP_TIMEOFFSET) 761 int *to_ptr; 762 #endif 763 764 while (popt < end && *popt != 0xff) { 765 oplen = *(popt + 1); 766 switch (*popt) { 767 case 1: 768 NetCopyIP(&NetOurSubnetMask, (popt + 2)); 769 break; 770 #if defined(CONFIG_CMD_SNTP) && defined(CONFIG_BOOTP_TIMEOFFSET) 771 case 2: /* Time offset */ 772 to_ptr = &NetTimeOffset; 773 NetCopyLong((ulong *)to_ptr, (ulong *)(popt + 2)); 774 NetTimeOffset = ntohl(NetTimeOffset); 775 break; 776 #endif 777 case 3: 778 NetCopyIP(&NetOurGatewayIP, (popt + 2)); 779 break; 780 case 6: 781 NetCopyIP(&NetOurDNSIP, (popt + 2)); 782 #if defined(CONFIG_BOOTP_DNS2) 783 if (*(popt + 1) > 4) 784 NetCopyIP(&NetOurDNS2IP, (popt + 2 + 4)); 785 #endif 786 break; 787 case 12: 788 size = truncate_sz("Host Name", 789 sizeof(NetOurHostName), oplen); 790 memcpy(&NetOurHostName, popt + 2, size); 791 NetOurHostName[size] = 0; 792 break; 793 case 15: /* Ignore Domain Name Option */ 794 break; 795 case 17: 796 size = truncate_sz("Root Path", 797 sizeof(NetOurRootPath), oplen); 798 memcpy(&NetOurRootPath, popt + 2, size); 799 NetOurRootPath[size] = 0; 800 break; 801 case 28: /* Ignore Broadcast Address Option */ 802 break; 803 #if defined(CONFIG_CMD_SNTP) && defined(CONFIG_BOOTP_NTPSERVER) 804 case 42: /* NTP server IP */ 805 NetCopyIP(&NetNtpServerIP, (popt + 2)); 806 break; 807 #endif 808 case 51: 809 NetCopyLong(&dhcp_leasetime, (ulong *) (popt + 2)); 810 break; 811 case 53: /* Ignore Message Type Option */ 812 break; 813 case 54: 814 NetCopyIP(&NetDHCPServerIP, (popt + 2)); 815 break; 816 case 58: /* Ignore Renewal Time Option */ 817 break; 818 case 59: /* Ignore Rebinding Time Option */ 819 break; 820 case 66: /* Ignore TFTP server name */ 821 break; 822 case 67: /* vendor opt bootfile */ 823 /* 824 * I can't use dhcp_vendorex_proc here because I need 825 * to write into the bootp packet - even then I had to 826 * pass the bootp packet pointer into here as the 827 * second arg 828 */ 829 size = truncate_sz("Opt Boot File", 830 sizeof(bp->bp_file), 831 oplen); 832 if (bp->bp_file[0] == '\0' && size > 0) { 833 /* 834 * only use vendor boot file if we didn't 835 * receive a boot file in the main non-vendor 836 * part of the packet - god only knows why 837 * some vendors chose not to use this perfectly 838 * good spot to store the boot file (join on 839 * Tru64 Unix) it seems mind bogglingly crazy 840 * to me 841 */ 842 printf("*** WARNING: using vendor " 843 "optional boot file\n"); 844 memcpy(bp->bp_file, popt + 2, size); 845 bp->bp_file[size] = '\0'; 846 } 847 break; 848 default: 849 #if defined(CONFIG_BOOTP_VENDOREX) 850 if (dhcp_vendorex_proc(popt)) 851 break; 852 #endif 853 printf("*** Unhandled DHCP Option in OFFER/ACK:" 854 " %d\n", *popt); 855 break; 856 } 857 popt += oplen + 2; /* Process next option */ 858 } 859 } 860 861 static int DhcpMessageType(unsigned char *popt) 862 { 863 if (NetReadLong((ulong *)popt) != htonl(BOOTP_VENDOR_MAGIC)) 864 return -1; 865 866 popt += 4; 867 while (*popt != 0xff) { 868 if (*popt == 53) /* DHCP Message Type */ 869 return *(popt + 2); 870 popt += *(popt + 1) + 2; /* Scan through all options */ 871 } 872 return -1; 873 } 874 875 static void DhcpSendRequestPkt(struct Bootp_t *bp_offer) 876 { 877 uchar *pkt, *iphdr; 878 struct Bootp_t *bp; 879 int pktlen, iplen, extlen; 880 int eth_hdr_size; 881 IPaddr_t OfferedIP; 882 883 debug("DhcpSendRequestPkt: Sending DHCPREQUEST\n"); 884 pkt = NetTxPacket; 885 memset((void *)pkt, 0, PKTSIZE); 886 887 eth_hdr_size = NetSetEther(pkt, NetBcastAddr, PROT_IP); 888 pkt += eth_hdr_size; 889 890 iphdr = pkt; /* We'll need this later to set proper pkt size */ 891 pkt += IP_UDP_HDR_SIZE; 892 893 bp = (struct Bootp_t *)pkt; 894 bp->bp_op = OP_BOOTREQUEST; 895 bp->bp_htype = HWT_ETHER; 896 bp->bp_hlen = HWL_ETHER; 897 bp->bp_hops = 0; 898 bp->bp_secs = htons(get_timer(0) / 1000); 899 /* Do not set the client IP, your IP, or server IP yet, since it 900 * hasn't been ACK'ed by the server yet */ 901 902 /* 903 * RFC3046 requires Relay Agents to discard packets with 904 * nonzero and offered giaddr 905 */ 906 NetWriteIP(&bp->bp_giaddr, 0); 907 908 memcpy(bp->bp_chaddr, NetOurEther, 6); 909 910 /* 911 * ID is the id of the OFFER packet 912 */ 913 914 NetCopyLong(&bp->bp_id, &bp_offer->bp_id); 915 916 /* 917 * Copy options from OFFER packet if present 918 */ 919 920 /* Copy offered IP into the parameters request list */ 921 NetCopyIP(&OfferedIP, &bp_offer->bp_yiaddr); 922 extlen = DhcpExtended((u8 *)bp->bp_vend, DHCP_REQUEST, 923 NetDHCPServerIP, OfferedIP); 924 925 iplen = BOOTP_HDR_SIZE - OPT_FIELD_SIZE + extlen; 926 pktlen = eth_hdr_size + IP_UDP_HDR_SIZE + iplen; 927 net_set_udp_header(iphdr, 0xFFFFFFFFL, PORT_BOOTPS, PORT_BOOTPC, iplen); 928 929 #ifdef CONFIG_BOOTP_DHCP_REQUEST_DELAY 930 udelay(CONFIG_BOOTP_DHCP_REQUEST_DELAY); 931 #endif /* CONFIG_BOOTP_DHCP_REQUEST_DELAY */ 932 debug("Transmitting DHCPREQUEST packet: len = %d\n", pktlen); 933 NetSendPacket(NetTxPacket, pktlen); 934 } 935 936 /* 937 * Handle DHCP received packets. 938 */ 939 static void 940 DhcpHandler(uchar *pkt, unsigned dest, IPaddr_t sip, unsigned src, 941 unsigned len) 942 { 943 struct Bootp_t *bp = (struct Bootp_t *)pkt; 944 945 debug("DHCPHandler: got packet: (src=%d, dst=%d, len=%d) state: %d\n", 946 src, dest, len, dhcp_state); 947 948 /* Filter out pkts we don't want */ 949 if (BootpCheckPkt(pkt, dest, src, len)) 950 return; 951 952 debug("DHCPHandler: got DHCP packet: (src=%d, dst=%d, len=%d) state:" 953 " %d\n", src, dest, len, dhcp_state); 954 955 switch (dhcp_state) { 956 case SELECTING: 957 /* 958 * Wait an appropriate time for any potential DHCPOFFER packets 959 * to arrive. Then select one, and generate DHCPREQUEST 960 * response. If filename is in format we recognize, assume it 961 * is a valid OFFER from a server we want. 962 */ 963 debug("DHCP: state=SELECTING bp_file: \"%s\"\n", bp->bp_file); 964 #ifdef CONFIG_SYS_BOOTFILE_PREFIX 965 if (strncmp(bp->bp_file, 966 CONFIG_SYS_BOOTFILE_PREFIX, 967 strlen(CONFIG_SYS_BOOTFILE_PREFIX)) == 0) { 968 #endif /* CONFIG_SYS_BOOTFILE_PREFIX */ 969 970 debug("TRANSITIONING TO REQUESTING STATE\n"); 971 dhcp_state = REQUESTING; 972 973 if (NetReadLong((ulong *)&bp->bp_vend[0]) == 974 htonl(BOOTP_VENDOR_MAGIC)) 975 DhcpOptionsProcess((u8 *)&bp->bp_vend[4], bp); 976 977 NetSetTimeout(5000, BootpTimeout); 978 DhcpSendRequestPkt(bp); 979 #ifdef CONFIG_SYS_BOOTFILE_PREFIX 980 } 981 #endif /* CONFIG_SYS_BOOTFILE_PREFIX */ 982 983 return; 984 break; 985 case REQUESTING: 986 debug("DHCP State: REQUESTING\n"); 987 988 if (DhcpMessageType((u8 *)bp->bp_vend) == DHCP_ACK) { 989 if (NetReadLong((ulong *)&bp->bp_vend[0]) == 990 htonl(BOOTP_VENDOR_MAGIC)) 991 DhcpOptionsProcess((u8 *)&bp->bp_vend[4], bp); 992 /* Store net params from reply */ 993 BootpCopyNetParams(bp); 994 dhcp_state = BOUND; 995 printf("DHCP client bound to address %pI4 (%lu ms)\n", 996 &NetOurIP, get_timer(bootp_start)); 997 bootstage_mark_name(BOOTSTAGE_ID_BOOTP_STOP, 998 "bootp_stop"); 999 1000 net_auto_load(); 1001 return; 1002 } 1003 break; 1004 case BOUND: 1005 /* DHCP client bound to address */ 1006 break; 1007 default: 1008 puts("DHCP: INVALID STATE\n"); 1009 break; 1010 } 1011 1012 } 1013 1014 void DhcpRequest(void) 1015 { 1016 BootpRequest(); 1017 } 1018 #endif /* CONFIG_CMD_DHCP */ 1019