net/bootp.c

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