[dhcp] Perform ProxyDHCP only if we do not already have PXE options
[people/lynusvaz/gpxe.git] / src / net / udp / dhcp.c
1 /*
2  * Copyright (C) 2006 Michael Brown <mbrown@fensystems.co.uk>.
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public License as
6  * published by the Free Software Foundation; either version 2 of the
7  * License, or any later version.
8  *
9  * This program is distributed in the hope that it will be useful, but
10  * WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License
15  * along with this program; if not, write to the Free Software
16  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
17  */
18
19 FILE_LICENCE ( GPL2_OR_LATER );
20
21 #include <string.h>
22 #include <stdlib.h>
23 #include <stdio.h>
24 #include <ctype.h>
25 #include <errno.h>
26 #include <assert.h>
27 #include <byteswap.h>
28 #include <gpxe/if_ether.h>
29 #include <gpxe/netdevice.h>
30 #include <gpxe/device.h>
31 #include <gpxe/xfer.h>
32 #include <gpxe/open.h>
33 #include <gpxe/job.h>
34 #include <gpxe/retry.h>
35 #include <gpxe/tcpip.h>
36 #include <gpxe/ip.h>
37 #include <gpxe/uuid.h>
38 #include <gpxe/timer.h>
39 #include <gpxe/settings.h>
40 #include <gpxe/dhcp.h>
41 #include <gpxe/dhcpopts.h>
42 #include <gpxe/dhcppkt.h>
43 #include <gpxe/features.h>
44
45 /** @file
46  *
47  * Dynamic Host Configuration Protocol
48  *
49  */
50
51 struct dhcp_session;
52 static int dhcp_tx ( struct dhcp_session *dhcp );
53
54 /**
55  * DHCP operation types
56  *
57  * This table maps from DHCP message types (i.e. values of the @c
58  * DHCP_MESSAGE_TYPE option) to values of the "op" field within a DHCP
59  * packet.
60  */
61 static const uint8_t dhcp_op[] = {
62         [DHCPDISCOVER]  = BOOTP_REQUEST,
63         [DHCPOFFER]     = BOOTP_REPLY,
64         [DHCPREQUEST]   = BOOTP_REQUEST,
65         [DHCPDECLINE]   = BOOTP_REQUEST,
66         [DHCPACK]       = BOOTP_REPLY,
67         [DHCPNAK]       = BOOTP_REPLY,
68         [DHCPRELEASE]   = BOOTP_REQUEST,
69         [DHCPINFORM]    = BOOTP_REQUEST,
70 };
71
72 /** Raw option data for options common to all DHCP requests */
73 static uint8_t dhcp_request_options_data[] = {
74         DHCP_MAX_MESSAGE_SIZE,
75         DHCP_WORD ( ETH_MAX_MTU - 20 /* IP header */ - 8 /* UDP header */ ),
76         DHCP_CLIENT_ARCHITECTURE, DHCP_WORD ( 0 ),
77         DHCP_CLIENT_NDI, DHCP_OPTION ( 1 /* UNDI */ , 2, 1 /* v2.1 */ ),
78         DHCP_VENDOR_CLASS_ID,
79         DHCP_STRING (  'P', 'X', 'E', 'C', 'l', 'i', 'e', 'n', 't', ':',
80                        'A', 'r', 'c', 'h', ':', '0', '0', '0', '0', '0', ':',
81                        'U', 'N', 'D', 'I', ':', '0', '0', '2', '0', '0', '1' ),
82         DHCP_USER_CLASS_ID,
83         DHCP_STRING ( 'g', 'P', 'X', 'E' ),
84         DHCP_PARAMETER_REQUEST_LIST,
85         DHCP_OPTION ( DHCP_SUBNET_MASK, DHCP_ROUTERS, DHCP_DNS_SERVERS,
86                       DHCP_LOG_SERVERS, DHCP_HOST_NAME, DHCP_DOMAIN_NAME,
87                       DHCP_ROOT_PATH, DHCP_VENDOR_ENCAP, DHCP_VENDOR_CLASS_ID,
88                       DHCP_TFTP_SERVER_NAME, DHCP_BOOTFILE_NAME,
89                       DHCP_EB_ENCAP, DHCP_ISCSI_INITIATOR_IQN ),
90         DHCP_END
91 };
92
93 /** Version number feature */
94 FEATURE_VERSION ( VERSION_MAJOR, VERSION_MINOR, VERSION_PATCH );
95
96 /** DHCP server address setting */
97 struct setting dhcp_server_setting __setting = {
98         .name = "dhcp-server",
99         .description = "DHCP server address",
100         .tag = DHCP_SERVER_IDENTIFIER,
101         .type = &setting_type_ipv4,
102 };
103
104 /** DHCP user class setting */
105 struct setting user_class_setting __setting = {
106         .name = "user-class",
107         .description = "User class identifier",
108         .tag = DHCP_USER_CLASS_ID,
109         .type = &setting_type_string,
110 };
111
112 /**
113  * Name a DHCP packet type
114  *
115  * @v msgtype           DHCP message type
116  * @ret string          DHCP mesasge type name
117  */
118 static inline const char * dhcp_msgtype_name ( unsigned int msgtype ) {
119         switch ( msgtype ) {
120         case DHCPNONE:          return "BOOTP"; /* Non-DHCP packet */
121         case DHCPDISCOVER:      return "DHCPDISCOVER";
122         case DHCPOFFER:         return "DHCPOFFER";
123         case DHCPREQUEST:       return "DHCPREQUEST";
124         case DHCPDECLINE:       return "DHCPDECLINE";
125         case DHCPACK:           return "DHCPACK";
126         case DHCPNAK:           return "DHCPNAK";
127         case DHCPRELEASE:       return "DHCPRELEASE";
128         case DHCPINFORM:        return "DHCPINFORM";
129         default:                return "DHCP<invalid>";
130         }
131 }
132
133 /**
134  * Calculate DHCP transaction ID for a network device
135  *
136  * @v netdev            Network device
137  * @ret xid             DHCP XID
138  *
139  * Extract the least significant bits of the hardware address for use
140  * as the transaction ID.
141  */
142 static uint32_t dhcp_xid ( struct net_device *netdev ) {
143         uint32_t xid;
144
145         memcpy ( &xid, ( netdev->ll_addr + netdev->ll_protocol->ll_addr_len
146                          - sizeof ( xid ) ), sizeof ( xid ) );
147         return xid;
148 }
149
150 /****************************************************************************
151  *
152  * DHCP session
153  *
154  */
155
156 struct dhcp_session;
157
158 /** DHCP session state operations */
159 struct dhcp_session_state {
160         /** State name */
161         const char *name;
162         /**
163          * Construct transmitted packet
164          *
165          * @v dhcp              DHCP session
166          * @v dhcppkt           DHCP packet
167          * @v peer              Destination address
168          */
169         int ( * tx ) ( struct dhcp_session *dhcp,
170                        struct dhcp_packet *dhcppkt,
171                        struct sockaddr_in *peer );
172         /** Handle received packet
173          *
174          * @v dhcp              DHCP session
175          * @v dhcppkt           DHCP packet
176          * @v peer              DHCP server address
177          * @v msgtype           DHCP message type
178          * @v server_id         DHCP server ID
179          */
180         void ( * rx ) ( struct dhcp_session *dhcp,
181                         struct dhcp_packet *dhcppkt,
182                         struct sockaddr_in *peer,
183                         uint8_t msgtype, struct in_addr server_id );
184         /** Handle timer expiry
185          *
186          * @v dhcp              DHCP session
187          */
188         void ( * expired ) ( struct dhcp_session *dhcp );
189         /** Transmitted message type */
190         uint8_t tx_msgtype;
191         /** Apply minimum timeout */
192         uint8_t apply_min_timeout;
193 };
194
195 static struct dhcp_session_state dhcp_state_discover;
196 static struct dhcp_session_state dhcp_state_request;
197 static struct dhcp_session_state dhcp_state_proxy;
198 static struct dhcp_session_state dhcp_state_pxebs;
199
200 /** A DHCP session */
201 struct dhcp_session {
202         /** Reference counter */
203         struct refcnt refcnt;
204         /** Job control interface */
205         struct job_interface job;
206         /** Data transfer interface */
207         struct xfer_interface xfer;
208
209         /** Network device being configured */
210         struct net_device *netdev;
211         /** Local socket address */
212         struct sockaddr_in local;
213         /** State of the session */
214         struct dhcp_session_state *state;
215
216         /** Offered IP address */
217         struct in_addr offer;
218         /** DHCP server */
219         struct in_addr server;
220         /** DHCP offer priority */
221         int priority;
222
223         /** ProxyDHCP protocol extensions should be ignored */
224         int no_pxedhcp;
225         /** ProxyDHCP server */
226         struct in_addr proxy_server;
227         /** ProxyDHCP server priority */
228         int proxy_priority;
229
230         /** PXE Boot Server type */
231         uint16_t pxe_type;
232         /** List of PXE Boot Servers to attempt */
233         struct in_addr *pxe_attempt;
234         /** List of PXE Boot Servers to accept */
235         struct in_addr *pxe_accept;
236
237         /** Retransmission timer */
238         struct retry_timer timer;
239         /** Start time of the current state (in ticks) */
240         unsigned long start;
241 };
242
243 /**
244  * Free DHCP session
245  *
246  * @v refcnt            Reference counter
247  */
248 static void dhcp_free ( struct refcnt *refcnt ) {
249         struct dhcp_session *dhcp =
250                 container_of ( refcnt, struct dhcp_session, refcnt );
251
252         netdev_put ( dhcp->netdev );
253         free ( dhcp );
254 }
255
256 /**
257  * Mark DHCP session as complete
258  *
259  * @v dhcp              DHCP session
260  * @v rc                Return status code
261  */
262 static void dhcp_finished ( struct dhcp_session *dhcp, int rc ) {
263
264         /* Block futher incoming messages */
265         job_nullify ( &dhcp->job );
266         xfer_nullify ( &dhcp->xfer );
267
268         /* Stop retry timer */
269         stop_timer ( &dhcp->timer );
270
271         /* Free resources and close interfaces */
272         xfer_close ( &dhcp->xfer, rc );
273         job_done ( &dhcp->job, rc );
274 }
275
276 /**
277  * Transition to new DHCP session state
278  *
279  * @v dhcp              DHCP session
280  * @v state             New session state
281  */
282 static void dhcp_set_state ( struct dhcp_session *dhcp,
283                              struct dhcp_session_state *state ) {
284
285         DBGC ( dhcp, "DHCP %p entering %s state\n", dhcp, state->name );
286         dhcp->state = state;
287         dhcp->start = currticks();
288         stop_timer ( &dhcp->timer );
289         dhcp->timer.min_timeout =
290                 ( state->apply_min_timeout ? DHCP_MIN_TIMEOUT : 0 );
291         dhcp->timer.max_timeout = DHCP_MAX_TIMEOUT;
292         start_timer_nodelay ( &dhcp->timer );
293 }
294
295 /****************************************************************************
296  *
297  * DHCP state machine
298  *
299  */
300
301 /**
302  * Construct transmitted packet for DHCP discovery
303  *
304  * @v dhcp              DHCP session
305  * @v dhcppkt           DHCP packet
306  * @v peer              Destination address
307  */
308 static int dhcp_discovery_tx ( struct dhcp_session *dhcp,
309                                struct dhcp_packet *dhcppkt __unused,
310                                struct sockaddr_in *peer ) {
311
312         DBGC ( dhcp, "DHCP %p DHCPDISCOVER\n", dhcp );
313
314         /* Set server address */
315         peer->sin_addr.s_addr = INADDR_BROADCAST;
316         peer->sin_port = htons ( BOOTPS_PORT );
317
318         return 0;
319 }
320
321 /**
322  * Handle received packet during DHCP discovery
323  *
324  * @v dhcp              DHCP session
325  * @v dhcppkt           DHCP packet
326  * @v peer              DHCP server address
327  * @v msgtype           DHCP message type
328  * @v server_id         DHCP server ID
329  */
330 static void dhcp_discovery_rx ( struct dhcp_session *dhcp,
331                                 struct dhcp_packet *dhcppkt,
332                                 struct sockaddr_in *peer, uint8_t msgtype,
333                                 struct in_addr server_id ) {
334         struct in_addr ip;
335         char vci[9]; /* "PXEClient" */
336         int vci_len;
337         int has_pxeclient;
338         int pxeopts_len;
339         int has_pxeopts;
340         int8_t priority = 0;
341         uint8_t no_pxedhcp = 0;
342         unsigned long elapsed;
343
344         DBGC ( dhcp, "DHCP %p %s from %s:%d", dhcp,
345                dhcp_msgtype_name ( msgtype ), inet_ntoa ( peer->sin_addr ),
346                ntohs ( peer->sin_port ) );
347         if ( server_id.s_addr != peer->sin_addr.s_addr )
348                 DBGC ( dhcp, " (%s)", inet_ntoa ( server_id ) );
349
350         /* Identify offered IP address */
351         ip = dhcppkt->dhcphdr->yiaddr;
352         if ( ip.s_addr )
353                 DBGC ( dhcp, " for %s", inet_ntoa ( ip ) );
354
355         /* Identify "PXEClient" vendor class */
356         vci_len = dhcppkt_fetch ( dhcppkt, DHCP_VENDOR_CLASS_ID,
357                                   vci, sizeof ( vci ) );
358         has_pxeclient = ( ( vci_len >= ( int ) sizeof ( vci ) ) &&
359                           ( strncmp ( "PXEClient", vci, sizeof (vci) ) == 0 ));
360         pxeopts_len = dhcppkt_fetch ( dhcppkt, DHCP_VENDOR_ENCAP, NULL, 0 );
361         has_pxeopts = ( pxeopts_len >= 0 );
362         if ( has_pxeclient )
363                 DBGC ( dhcp, "%s", ( has_pxeopts ? " pxe" : " proxy" ) );
364
365         /* Identify priority */
366         dhcppkt_fetch ( dhcppkt, DHCP_EB_PRIORITY, &priority,
367                         sizeof ( priority ) );
368         if ( priority )
369                 DBGC ( dhcp, " pri %d", priority );
370
371         /* Identify ignore-PXE flag */
372         dhcppkt_fetch ( dhcppkt, DHCP_EB_NO_PXEDHCP, &no_pxedhcp,
373                         sizeof ( no_pxedhcp ) );
374         if ( no_pxedhcp )
375                 DBGC ( dhcp, " nopxe" );
376         DBGC ( dhcp, "\n" );
377
378         /* Select as DHCP offer, if applicable */
379         if ( ip.s_addr && ( peer->sin_port == htons ( BOOTPS_PORT ) ) &&
380              ( ( msgtype == DHCPOFFER ) || ( ! msgtype /* BOOTP */ ) ) &&
381              ( priority >= dhcp->priority ) ) {
382                 dhcp->offer = ip;
383                 dhcp->server = server_id;
384                 dhcp->priority = priority;
385                 dhcp->no_pxedhcp = no_pxedhcp;
386         }
387
388         /* Select as ProxyDHCP offer, if applicable */
389         if ( has_pxeclient && ( ! has_pxeopts ) && ( msgtype == DHCPOFFER ) &&
390              ( priority >= dhcp->proxy_priority ) ) {
391                 dhcp->proxy_server = server_id;
392                 dhcp->proxy_priority = priority;
393         }
394
395         /* We can exit the discovery state when we have a valid
396          * DHCPOFFER, and either:
397          *
398          *  o  The DHCPOFFER instructs us to ignore ProxyDHCPOFFERs, or
399          *  o  We have a valid ProxyDHCPOFFER, or
400          *  o  We have allowed sufficient time for ProxyDHCPOFFERs.
401          */
402
403         /* If we don't yet have a DHCPOFFER, do nothing */
404         if ( ! dhcp->offer.s_addr )
405                 return;
406
407         /* If we can't yet transition to DHCPREQUEST, do nothing */
408         elapsed = ( currticks() - dhcp->start );
409         if ( ! ( dhcp->no_pxedhcp || dhcp->proxy_server.s_addr ||
410                  ( elapsed > PROXYDHCP_MAX_TIMEOUT ) ) )
411                 return;
412
413         /* Transition to DHCPREQUEST */
414         dhcp_set_state ( dhcp, &dhcp_state_request );
415 }
416
417 /**
418  * Handle timer expiry during DHCP discovery
419  *
420  * @v dhcp              DHCP session
421  */
422 static void dhcp_discovery_expired ( struct dhcp_session *dhcp ) {
423         unsigned long elapsed = ( currticks() - dhcp->start );
424
425         /* Give up waiting for ProxyDHCP before we reach the failure point */
426         if ( dhcp->offer.s_addr && ( elapsed > PROXYDHCP_MAX_TIMEOUT ) ) {
427                 dhcp_set_state ( dhcp, &dhcp_state_request );
428                 return;
429         }
430
431         /* Otherwise, retransmit current packet */
432         dhcp_tx ( dhcp );
433 }
434
435 /** DHCP discovery state operations */
436 static struct dhcp_session_state dhcp_state_discover = {
437         .name                   = "discovery",
438         .tx                     = dhcp_discovery_tx,
439         .rx                     = dhcp_discovery_rx,
440         .expired                = dhcp_discovery_expired,
441         .tx_msgtype             = DHCPDISCOVER,
442         .apply_min_timeout      = 1,
443 };
444
445 /**
446  * Construct transmitted packet for DHCP request
447  *
448  * @v dhcp              DHCP session
449  * @v dhcppkt           DHCP packet
450  * @v peer              Destination address
451  */
452 static int dhcp_request_tx ( struct dhcp_session *dhcp,
453                              struct dhcp_packet *dhcppkt,
454                              struct sockaddr_in *peer ) {
455         int rc;
456
457         DBGC ( dhcp, "DHCP %p DHCPREQUEST to %s:%d",
458                dhcp, inet_ntoa ( dhcp->server ), BOOTPS_PORT );
459         DBGC ( dhcp, " for %s\n", inet_ntoa ( dhcp->offer ) );
460
461         /* Set server ID */
462         if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_SERVER_IDENTIFIER,
463                                     &dhcp->server,
464                                     sizeof ( dhcp->server ) ) ) != 0 )
465                 return rc;
466
467         /* Set requested IP address */
468         if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_REQUESTED_ADDRESS,
469                                     &dhcp->offer,
470                                     sizeof ( dhcp->offer ) ) ) != 0 )
471                 return rc;
472
473         /* Set server address */
474         peer->sin_addr.s_addr = INADDR_BROADCAST;
475         peer->sin_port = htons ( BOOTPS_PORT );
476
477         return 0;
478 }
479
480 /**
481  * Handle received packet during DHCP request
482  *
483  * @v dhcp              DHCP session
484  * @v dhcppkt           DHCP packet
485  * @v peer              DHCP server address
486  * @v msgtype           DHCP message type
487  * @v server_id         DHCP server ID
488  */
489 static void dhcp_request_rx ( struct dhcp_session *dhcp,
490                               struct dhcp_packet *dhcppkt,
491                               struct sockaddr_in *peer, uint8_t msgtype,
492                               struct in_addr server_id ) {
493         struct in_addr ip;
494         struct settings *parent;
495         int rc;
496
497         DBGC ( dhcp, "DHCP %p %s from %s:%d", dhcp,
498                dhcp_msgtype_name ( msgtype ), inet_ntoa ( peer->sin_addr ),
499                ntohs ( peer->sin_port ) );
500         if ( server_id.s_addr != peer->sin_addr.s_addr )
501                 DBGC ( dhcp, " (%s)", inet_ntoa ( server_id ) );
502
503         /* Identify leased IP address */
504         ip = dhcppkt->dhcphdr->yiaddr;
505         if ( ip.s_addr )
506                 DBGC ( dhcp, " for %s", inet_ntoa ( ip ) );
507         DBGC ( dhcp, "\n" );
508
509         /* Filter out unacceptable responses */
510         if ( peer->sin_port != htons ( BOOTPS_PORT ) )
511                 return;
512         if ( msgtype /* BOOTP */ && ( msgtype != DHCPACK ) )
513                 return;
514         if ( server_id.s_addr != dhcp->server.s_addr )
515                 return;
516
517         /* Record assigned address */
518         dhcp->local.sin_addr = ip;
519
520         /* Register settings */
521         parent = netdev_settings ( dhcp->netdev );
522         if ( ( rc = register_settings ( &dhcppkt->settings, parent ) ) != 0 ){
523                 DBGC ( dhcp, "DHCP %p could not register settings: %s\n",
524                        dhcp, strerror ( rc ) );
525                 dhcp_finished ( dhcp, rc );
526                 return;
527         }
528
529         /* Start ProxyDHCPREQUEST if applicable */
530         if ( dhcp->proxy_server.s_addr && ( ! dhcp->no_pxedhcp ) ) {
531                 dhcp_set_state ( dhcp, &dhcp_state_proxy );
532                 return;
533         }
534
535         /* Terminate DHCP */
536         dhcp_finished ( dhcp, 0 );
537 }
538
539 /**
540  * Handle timer expiry during DHCP discovery
541  *
542  * @v dhcp              DHCP session
543  */
544 static void dhcp_request_expired ( struct dhcp_session *dhcp ) {
545
546         /* Retransmit current packet */
547         dhcp_tx ( dhcp );
548 }
549
550 /** DHCP request state operations */
551 static struct dhcp_session_state dhcp_state_request = {
552         .name                   = "request",
553         .tx                     = dhcp_request_tx,
554         .rx                     = dhcp_request_rx,
555         .expired                = dhcp_request_expired,
556         .tx_msgtype             = DHCPREQUEST,
557         .apply_min_timeout      = 0,
558 };
559
560 /**
561  * Construct transmitted packet for ProxyDHCP request
562  *
563  * @v dhcp              DHCP session
564  * @v dhcppkt           DHCP packet
565  * @v peer              Destination address
566  */
567 static int dhcp_proxy_tx ( struct dhcp_session *dhcp,
568                            struct dhcp_packet *dhcppkt,
569                            struct sockaddr_in *peer ) {
570         int rc;
571
572         DBGC ( dhcp, "DHCP %p ProxyDHCP REQUEST to %s:%d\n",
573                dhcp, inet_ntoa ( dhcp->proxy_server ), PXE_PORT );
574
575         /* Set server ID */
576         if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_SERVER_IDENTIFIER,
577                                     &dhcp->proxy_server,
578                                     sizeof ( dhcp->proxy_server ) ) ) != 0 )
579                 return rc;
580
581         /* Set server address */
582         peer->sin_addr = dhcp->proxy_server;
583         peer->sin_port = htons ( PXE_PORT );
584
585         return 0;
586 }
587
588 /**
589  * Handle received packet during ProxyDHCP request
590  *
591  * @v dhcp              DHCP session
592  * @v dhcppkt           DHCP packet
593  * @v peer              DHCP server address
594  * @v msgtype           DHCP message type
595  * @v server_id         DHCP server ID
596  */
597 static void dhcp_proxy_rx ( struct dhcp_session *dhcp,
598                             struct dhcp_packet *dhcppkt,
599                             struct sockaddr_in *peer, uint8_t msgtype,
600                             struct in_addr server_id ) {
601         int rc;
602
603         DBGC ( dhcp, "DHCP %p %s from %s:%d", dhcp,
604                dhcp_msgtype_name ( msgtype ), inet_ntoa ( peer->sin_addr ),
605                ntohs ( peer->sin_port ) );
606         if ( server_id.s_addr != peer->sin_addr.s_addr )
607                 DBGC ( dhcp, " (%s)", inet_ntoa ( server_id ) );
608         DBGC ( dhcp, "\n" );
609
610         /* Filter out unacceptable responses */
611         if ( peer->sin_port != htons ( PXE_PORT ) )
612                 return;
613         if ( msgtype != DHCPACK )
614                 return;
615         if ( server_id.s_addr /* Linux PXE server omits server ID */ &&
616              ( server_id.s_addr != dhcp->proxy_server.s_addr ) )
617                 return;
618
619         /* Register settings */
620         dhcppkt->settings.name = PROXYDHCP_SETTINGS_NAME;
621         if ( ( rc = register_settings ( &dhcppkt->settings, NULL ) ) != 0 ) {
622                 DBGC ( dhcp, "DHCP %p could not register settings: %s\n",
623                        dhcp, strerror ( rc ) );
624                 dhcp_finished ( dhcp, rc );
625                 return;
626         }
627
628         /* Terminate DHCP */
629         dhcp_finished ( dhcp, 0 );
630 }
631
632 /**
633  * Handle timer expiry during ProxyDHCP request
634  *
635  * @v dhcp              DHCP session
636  */
637 static void dhcp_proxy_expired ( struct dhcp_session *dhcp ) {
638         unsigned long elapsed = ( currticks() - dhcp->start );
639
640         /* Give up waiting for ProxyDHCP before we reach the failure point */
641         if ( elapsed > PROXYDHCP_MAX_TIMEOUT ) {
642                 dhcp_finished ( dhcp, 0 );
643                 return;
644         }
645
646         /* Retransmit current packet */
647         dhcp_tx ( dhcp );
648 }
649
650 /** ProxyDHCP request state operations */
651 static struct dhcp_session_state dhcp_state_proxy = {
652         .name                   = "ProxyDHCP",
653         .tx                     = dhcp_proxy_tx,
654         .rx                     = dhcp_proxy_rx,
655         .expired                = dhcp_proxy_expired,
656         .tx_msgtype             = DHCPREQUEST,
657         .apply_min_timeout      = 0,
658 };
659
660 /**
661  * Construct transmitted packet for PXE Boot Server Discovery
662  *
663  * @v dhcp              DHCP session
664  * @v dhcppkt           DHCP packet
665  * @v peer              Destination address
666  */
667 static int dhcp_pxebs_tx ( struct dhcp_session *dhcp,
668                            struct dhcp_packet *dhcppkt,
669                            struct sockaddr_in *peer ) {
670         struct dhcp_pxe_boot_menu_item menu_item = { 0, 0 };
671         int rc;
672
673         DBGC ( dhcp, "DHCP %p PXEBS REQUEST to %s:%d for type %d\n",
674                dhcp, inet_ntoa ( *(dhcp->pxe_attempt) ), PXE_PORT,
675                ntohs ( dhcp->pxe_type ) );
676
677         /* Set boot menu item */
678         menu_item.type = dhcp->pxe_type;
679         if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_PXE_BOOT_MENU_ITEM,
680                                     &menu_item, sizeof ( menu_item ) ) ) != 0 )
681                 return rc;
682
683         /* Set server address */
684         peer->sin_addr = *(dhcp->pxe_attempt);
685         peer->sin_port = htons ( PXE_PORT );
686
687         return 0;
688 }
689
690 /**
691  * Check to see if PXE Boot Server address is acceptable
692  *
693  * @v dhcp              DHCP session
694  * @v bs                Boot Server address
695  * @ret accept          Boot Server is acceptable
696  */
697 static int dhcp_pxebs_accept ( struct dhcp_session *dhcp,
698                                struct in_addr bs ) {
699         struct in_addr *accept;
700
701         /* Accept if we have no acceptance filter */
702         if ( ! dhcp->pxe_accept )
703                 return 1;
704
705         /* Scan through acceptance list */
706         for ( accept = dhcp->pxe_accept ; accept->s_addr ; accept++ ) {
707                 if ( accept->s_addr == bs.s_addr )
708                         return 1;
709         }
710
711         DBGC ( dhcp, "DHCP %p rejecting server %s\n",
712                dhcp, inet_ntoa ( bs ) );
713         return 0;
714 }
715
716 /**
717  * Handle received packet during PXE Boot Server Discovery
718  *
719  * @v dhcp              DHCP session
720  * @v dhcppkt           DHCP packet
721  * @v peer              DHCP server address
722  * @v msgtype           DHCP message type
723  * @v server_id         DHCP server ID
724  */
725 static void dhcp_pxebs_rx ( struct dhcp_session *dhcp,
726                             struct dhcp_packet *dhcppkt,
727                             struct sockaddr_in *peer, uint8_t msgtype,
728                             struct in_addr server_id ) {
729         struct dhcp_pxe_boot_menu_item menu_item = { 0, 0 };
730         int rc;
731
732         DBGC ( dhcp, "DHCP %p %s from %s:%d", dhcp,
733                dhcp_msgtype_name ( msgtype ), inet_ntoa ( peer->sin_addr ),
734                ntohs ( peer->sin_port ) );
735         if ( server_id.s_addr != peer->sin_addr.s_addr )
736                 DBGC ( dhcp, " (%s)", inet_ntoa ( server_id ) );
737
738         /* Identify boot menu item */
739         dhcppkt_fetch ( dhcppkt, DHCP_PXE_BOOT_MENU_ITEM,
740                         &menu_item, sizeof ( menu_item ) );
741         if ( menu_item.type )
742                 DBGC ( dhcp, " for type %d", ntohs ( menu_item.type ) );
743         DBGC ( dhcp, "\n" );
744
745         /* Filter out unacceptable responses */
746         if ( peer->sin_port != htons ( PXE_PORT ) )
747                 return;
748         if ( msgtype != DHCPACK )
749                 return;
750         if ( menu_item.type != dhcp->pxe_type )
751                 return;
752         if ( ! dhcp_pxebs_accept ( dhcp, ( server_id.s_addr ?
753                                            server_id : peer->sin_addr ) ) )
754                 return;
755
756         /* Register settings */
757         dhcppkt->settings.name = PXEBS_SETTINGS_NAME;
758         if ( ( rc = register_settings ( &dhcppkt->settings, NULL ) ) != 0 ) {
759                 DBGC ( dhcp, "DHCP %p could not register settings: %s\n",
760                        dhcp, strerror ( rc ) );
761                 dhcp_finished ( dhcp, rc );
762                 return;
763         }
764
765         /* Terminate DHCP */
766         dhcp_finished ( dhcp, 0 );
767 }
768
769 /**
770  * Handle timer expiry during PXE Boot Server Discovery
771  *
772  * @v dhcp              DHCP session
773  */
774 static void dhcp_pxebs_expired ( struct dhcp_session *dhcp ) {
775         unsigned long elapsed = ( currticks() - dhcp->start );
776
777         /* Give up waiting before we reach the failure point, and fail
778          * over to the next server in the attempt list
779          */
780         if ( elapsed > PXEBS_MAX_TIMEOUT ) {
781                 dhcp->pxe_attempt++;
782                 if ( dhcp->pxe_attempt->s_addr ) {
783                         dhcp_set_state ( dhcp, &dhcp_state_pxebs );
784                         return;
785                 } else {
786                         dhcp_finished ( dhcp, -ETIMEDOUT );
787                         return;
788                 }
789         }
790
791         /* Retransmit current packet */
792         dhcp_tx ( dhcp );
793 }
794
795 /** PXE Boot Server Discovery state operations */
796 static struct dhcp_session_state dhcp_state_pxebs = {
797         .name                   = "PXEBS",
798         .tx                     = dhcp_pxebs_tx,
799         .rx                     = dhcp_pxebs_rx,
800         .expired                = dhcp_pxebs_expired,
801         .tx_msgtype             = DHCPREQUEST,
802         .apply_min_timeout      = 1,
803 };
804
805 /****************************************************************************
806  *
807  * Packet construction
808  *
809  */
810
811 /**
812  * Create a DHCP packet
813  *
814  * @v dhcppkt           DHCP packet structure to fill in
815  * @v netdev            Network device
816  * @v msgtype           DHCP message type
817  * @v options           Initial options to include (or NULL)
818  * @v options_len       Length of initial options
819  * @v data              Buffer for DHCP packet
820  * @v max_len           Size of DHCP packet buffer
821  * @ret rc              Return status code
822  *
823  * Creates a DHCP packet in the specified buffer, and initialise a
824  * DHCP packet structure.
825  */
826 int dhcp_create_packet ( struct dhcp_packet *dhcppkt,
827                          struct net_device *netdev, uint8_t msgtype,
828                          const void *options, size_t options_len,
829                          void *data, size_t max_len ) {
830         struct dhcphdr *dhcphdr = data;
831         unsigned int hlen;
832         int rc;
833
834         /* Sanity check */
835         if ( max_len < ( sizeof ( *dhcphdr ) + options_len ) )
836                 return -ENOSPC;
837
838         /* Initialise DHCP packet content */
839         memset ( dhcphdr, 0, max_len );
840         dhcphdr->xid = dhcp_xid ( netdev );
841         dhcphdr->magic = htonl ( DHCP_MAGIC_COOKIE );
842         dhcphdr->htype = ntohs ( netdev->ll_protocol->ll_proto );
843         dhcphdr->op = dhcp_op[msgtype];
844         /* If hardware length exceeds the chaddr field length, don't
845          * use the chaddr field.  This is as per RFC4390.
846          */
847         hlen = netdev->ll_protocol->ll_addr_len;
848         if ( hlen > sizeof ( dhcphdr->chaddr ) ) {
849                 hlen = 0;
850                 dhcphdr->flags = htons ( BOOTP_FL_BROADCAST );
851         }
852         dhcphdr->hlen = hlen;
853         memcpy ( dhcphdr->chaddr, netdev->ll_addr, hlen );
854         memcpy ( dhcphdr->options, options, options_len );
855
856         /* Initialise DHCP packet structure */
857         memset ( dhcppkt, 0, sizeof ( *dhcppkt ) );
858         dhcppkt_init ( dhcppkt, data, max_len );
859         
860         /* Set DHCP_MESSAGE_TYPE option */
861         if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_MESSAGE_TYPE,
862                                     &msgtype, sizeof ( msgtype ) ) ) != 0 )
863                 return rc;
864
865         return 0;
866 }
867
868 /**
869  * Create DHCP request packet
870  *
871  * @v dhcppkt           DHCP packet structure to fill in
872  * @v netdev            Network device
873  * @v msgtype           DHCP message type
874  * @v ciaddr            Client IP address
875  * @v data              Buffer for DHCP packet
876  * @v max_len           Size of DHCP packet buffer
877  * @ret rc              Return status code
878  *
879  * Creates a DHCP request packet in the specified buffer, and
880  * initialise a DHCP packet structure.
881  */
882 int dhcp_create_request ( struct dhcp_packet *dhcppkt,
883                           struct net_device *netdev, unsigned int msgtype,
884                           struct in_addr ciaddr, void *data, size_t max_len ) {
885         struct device_description *desc = &netdev->dev->desc;
886         struct dhcp_netdev_desc dhcp_desc;
887         struct dhcp_client_id client_id;
888         struct dhcp_client_uuid client_uuid;
889         uint8_t *dhcp_features;
890         size_t dhcp_features_len;
891         size_t ll_addr_len;
892         ssize_t len;
893         int rc;
894
895         /* Create DHCP packet */
896         if ( ( rc = dhcp_create_packet ( dhcppkt, netdev, msgtype,
897                                          dhcp_request_options_data,
898                                          sizeof ( dhcp_request_options_data ),
899                                          data, max_len ) ) != 0 ) {
900                 DBG ( "DHCP could not create DHCP packet: %s\n",
901                       strerror ( rc ) );
902                 return rc;
903         }
904
905         /* Set client IP address */
906         dhcppkt->dhcphdr->ciaddr = ciaddr;
907
908         /* Add options to identify the feature list */
909         dhcp_features = table_start ( DHCP_FEATURES );
910         dhcp_features_len = table_num_entries ( DHCP_FEATURES );
911         if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_EB_ENCAP, dhcp_features,
912                                     dhcp_features_len ) ) != 0 ) {
913                 DBG ( "DHCP could not set features list option: %s\n",
914                       strerror ( rc ) );
915                 return rc;
916         }
917
918         /* Add options to identify the network device */
919         dhcp_desc.type = desc->bus_type;
920         dhcp_desc.vendor = htons ( desc->vendor );
921         dhcp_desc.device = htons ( desc->device );
922         if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_EB_BUS_ID, &dhcp_desc,
923                                     sizeof ( dhcp_desc ) ) ) != 0 ) {
924                 DBG ( "DHCP could not set bus ID option: %s\n",
925                       strerror ( rc ) );
926                 return rc;
927         }
928
929         /* Add DHCP client identifier.  Required for Infiniband, and
930          * doesn't hurt other link layers.
931          */
932         client_id.ll_proto = ntohs ( netdev->ll_protocol->ll_proto );
933         ll_addr_len = netdev->ll_protocol->ll_addr_len;
934         assert ( ll_addr_len <= sizeof ( client_id.ll_addr ) );
935         memcpy ( client_id.ll_addr, netdev->ll_addr, ll_addr_len );
936         if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_CLIENT_ID, &client_id,
937                                     ( ll_addr_len + 1 ) ) ) != 0 ) {
938                 DBG ( "DHCP could not set client ID: %s\n",
939                       strerror ( rc ) );
940                 return rc;
941         }
942
943         /* Add client UUID, if we have one.  Required for PXE. */
944         client_uuid.type = DHCP_CLIENT_UUID_TYPE;
945         if ( ( len = fetch_uuid_setting ( NULL, &uuid_setting,
946                                           &client_uuid.uuid ) ) >= 0 ) {
947                 if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_CLIENT_UUID,
948                                             &client_uuid,
949                                             sizeof ( client_uuid ) ) ) != 0 ) {
950                         DBG ( "DHCP could not set client UUID: %s\n",
951                               strerror ( rc ) );
952                         return rc;
953                 }
954         }
955
956         /* Add user class, if we have one. */
957         if ( ( len = fetch_setting_len ( NULL, &user_class_setting ) ) >= 0 ) {
958                 char user_class[len];
959                 fetch_setting ( NULL, &user_class_setting, user_class,
960                                 sizeof ( user_class ) );
961                 if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_USER_CLASS_ID,
962                                             &user_class,
963                                             sizeof ( user_class ) ) ) != 0 ) {
964                         DBG ( "DHCP could not set user class: %s\n",
965                               strerror ( rc ) );
966                         return rc;
967                 }
968         }
969
970         return 0;
971 }
972
973 /****************************************************************************
974  *
975  * Data transfer interface
976  *
977  */
978
979 /**
980  * Transmit DHCP request
981  *
982  * @v dhcp              DHCP session
983  * @ret rc              Return status code
984  */
985 static int dhcp_tx ( struct dhcp_session *dhcp ) {
986         static struct sockaddr_in peer = {
987                 .sin_family = AF_INET,
988         };
989         struct xfer_metadata meta = {
990                 .netdev = dhcp->netdev,
991                 .src = ( struct sockaddr * ) &dhcp->local,
992                 .dest = ( struct sockaddr * ) &peer,
993         };
994         struct io_buffer *iobuf;
995         uint8_t msgtype = dhcp->state->tx_msgtype;
996         struct dhcp_packet dhcppkt;
997         int rc;
998
999         /* Start retry timer.  Do this first so that failures to
1000          * transmit will be retried.
1001          */
1002         start_timer ( &dhcp->timer );
1003
1004         /* Allocate buffer for packet */
1005         iobuf = xfer_alloc_iob ( &dhcp->xfer, DHCP_MIN_LEN );
1006         if ( ! iobuf )
1007                 return -ENOMEM;
1008
1009         /* Create basic DHCP packet in temporary buffer */
1010         if ( ( rc = dhcp_create_request ( &dhcppkt, dhcp->netdev, msgtype,
1011                                           dhcp->local.sin_addr, iobuf->data,
1012                                           iob_tailroom ( iobuf ) ) ) != 0 ) {
1013                 DBGC ( dhcp, "DHCP %p could not construct DHCP request: %s\n",
1014                        dhcp, strerror ( rc ) );
1015                 goto done;
1016         }
1017
1018         /* Fill in packet based on current state */
1019         if ( ( rc = dhcp->state->tx ( dhcp, &dhcppkt, &peer ) ) != 0 ) {
1020                 DBGC ( dhcp, "DHCP %p could not fill DHCP request: %s\n",
1021                        dhcp, strerror ( rc ) );
1022                 goto done;
1023         }
1024
1025         /* Transmit the packet */
1026         iob_put ( iobuf, dhcppkt.len );
1027         if ( ( rc = xfer_deliver_iob_meta ( &dhcp->xfer, iob_disown ( iobuf ),
1028                                             &meta ) ) != 0 ) {
1029                 DBGC ( dhcp, "DHCP %p could not transmit UDP packet: %s\n",
1030                        dhcp, strerror ( rc ) );
1031                 goto done;
1032         }
1033
1034  done:
1035         free_iob ( iobuf );
1036         return rc;
1037 }
1038
1039 /**
1040  * Receive new data
1041  *
1042  * @v xfer              Data transfer interface
1043  * @v iobuf             I/O buffer
1044  * @v meta              Transfer metadata
1045  * @ret rc              Return status code
1046  */
1047 static int dhcp_deliver_iob ( struct xfer_interface *xfer,
1048                               struct io_buffer *iobuf,
1049                               struct xfer_metadata *meta ) {
1050         struct dhcp_session *dhcp =
1051                 container_of ( xfer, struct dhcp_session, xfer );
1052         struct sockaddr_in *peer;
1053         size_t data_len;
1054         struct dhcp_packet *dhcppkt;
1055         struct dhcphdr *dhcphdr;
1056         uint8_t msgtype = 0;
1057         struct in_addr server_id = { 0 };
1058         int rc = 0;
1059
1060         /* Sanity checks */
1061         if ( ! meta->src ) {
1062                 DBGC ( dhcp, "DHCP %p received packet without source port\n",
1063                        dhcp );
1064                 rc = -EINVAL;
1065                 goto err_no_src;
1066         }
1067         peer = ( struct sockaddr_in * ) meta->src;
1068
1069         /* Create a DHCP packet containing the I/O buffer contents.
1070          * Whilst we could just use the original buffer in situ, that
1071          * would waste the unused space in the packet buffer, and also
1072          * waste a relatively scarce fully-aligned I/O buffer.
1073          */
1074         data_len = iob_len ( iobuf );
1075         dhcppkt = zalloc ( sizeof ( *dhcppkt ) + data_len );
1076         if ( ! dhcppkt ) {
1077                 rc = -ENOMEM;
1078                 goto err_alloc_dhcppkt;
1079         }
1080         dhcphdr = ( ( ( void * ) dhcppkt ) + sizeof ( *dhcppkt ) );
1081         memcpy ( dhcphdr, iobuf->data, data_len );
1082         dhcppkt_init ( dhcppkt, dhcphdr, data_len );
1083
1084         /* Identify message type */
1085         dhcppkt_fetch ( dhcppkt, DHCP_MESSAGE_TYPE, &msgtype,
1086                         sizeof ( msgtype ) );
1087
1088         /* Identify server ID */
1089         dhcppkt_fetch ( dhcppkt, DHCP_SERVER_IDENTIFIER,
1090                         &server_id, sizeof ( server_id ) );
1091
1092         /* Check for matching transaction ID */
1093         if ( dhcphdr->xid != dhcp_xid ( dhcp->netdev ) ) {
1094                 DBGC ( dhcp, "DHCP %p %s from %s:%d has bad transaction "
1095                        "ID\n", dhcp, dhcp_msgtype_name ( msgtype ),
1096                        inet_ntoa ( peer->sin_addr ),
1097                        ntohs ( peer->sin_port ) );
1098                 rc = -EINVAL;
1099                 goto err_xid;
1100         };
1101
1102         /* Handle packet based on current state */
1103         dhcp->state->rx ( dhcp, dhcppkt, peer, msgtype, server_id );
1104
1105  err_xid:
1106         dhcppkt_put ( dhcppkt );
1107  err_alloc_dhcppkt:
1108  err_no_src:
1109         free_iob ( iobuf );
1110         return rc;
1111 }
1112
1113 /** DHCP data transfer interface operations */
1114 static struct xfer_interface_operations dhcp_xfer_operations = {
1115         .close          = ignore_xfer_close,
1116         .vredirect      = xfer_vreopen,
1117         .window         = unlimited_xfer_window,
1118         .alloc_iob      = default_xfer_alloc_iob,
1119         .deliver_iob    = dhcp_deliver_iob,
1120         .deliver_raw    = xfer_deliver_as_iob,
1121 };
1122
1123 /**
1124  * Handle DHCP retry timer expiry
1125  *
1126  * @v timer             DHCP retry timer
1127  * @v fail              Failure indicator
1128  */
1129 static void dhcp_timer_expired ( struct retry_timer *timer, int fail ) {
1130         struct dhcp_session *dhcp =
1131                 container_of ( timer, struct dhcp_session, timer );
1132
1133         /* If we have failed, terminate DHCP */
1134         if ( fail ) {
1135                 dhcp_finished ( dhcp, -ETIMEDOUT );
1136                 return;
1137         }
1138
1139         /* Handle timer expiry based on current state */
1140         dhcp->state->expired ( dhcp );
1141 }
1142
1143 /****************************************************************************
1144  *
1145  * Job control interface
1146  *
1147  */
1148
1149 /**
1150  * Handle kill() event received via job control interface
1151  *
1152  * @v job               DHCP job control interface
1153  */
1154 static void dhcp_job_kill ( struct job_interface *job ) {
1155         struct dhcp_session *dhcp =
1156                 container_of ( job, struct dhcp_session, job );
1157
1158         /* Terminate DHCP session */
1159         dhcp_finished ( dhcp, -ECANCELED );
1160 }
1161
1162 /** DHCP job control interface operations */
1163 static struct job_interface_operations dhcp_job_operations = {
1164         .done           = ignore_job_done,
1165         .kill           = dhcp_job_kill,
1166         .progress       = ignore_job_progress,
1167 };
1168
1169 /****************************************************************************
1170  *
1171  * Instantiators
1172  *
1173  */
1174
1175 /**
1176  * DHCP peer address for socket opening
1177  *
1178  * This is a dummy address; the only useful portion is the socket
1179  * family (so that we get a UDP connection).  The DHCP client will set
1180  * the IP address and source port explicitly on each transmission.
1181  */
1182 static struct sockaddr dhcp_peer = {
1183         .sa_family = AF_INET,
1184 };
1185
1186 /**
1187  * Start DHCP state machine on a network device
1188  *
1189  * @v job               Job control interface
1190  * @v netdev            Network device
1191  * @ret rc              Return status code
1192  *
1193  * Starts DHCP on the specified network device.  If successful, the
1194  * DHCPACK (and ProxyDHCPACK, if applicable) will be registered as
1195  * option sources.
1196  */
1197 int start_dhcp ( struct job_interface *job, struct net_device *netdev ) {
1198         struct dhcp_session *dhcp;
1199         int rc;
1200
1201         /* Allocate and initialise structure */
1202         dhcp = zalloc ( sizeof ( *dhcp ) );
1203         if ( ! dhcp )
1204                 return -ENOMEM;
1205         dhcp->refcnt.free = dhcp_free;
1206         job_init ( &dhcp->job, &dhcp_job_operations, &dhcp->refcnt );
1207         xfer_init ( &dhcp->xfer, &dhcp_xfer_operations, &dhcp->refcnt );
1208         dhcp->netdev = netdev_get ( netdev );
1209         dhcp->local.sin_family = AF_INET;
1210         dhcp->local.sin_port = htons ( BOOTPC_PORT );
1211         dhcp->timer.expired = dhcp_timer_expired;
1212
1213         /* Instantiate child objects and attach to our interfaces */
1214         if ( ( rc = xfer_open_socket ( &dhcp->xfer, SOCK_DGRAM, &dhcp_peer,
1215                                   ( struct sockaddr * ) &dhcp->local ) ) != 0 )
1216                 goto err;
1217
1218         /* Enter DHCPDISCOVER state */
1219         dhcp_set_state ( dhcp, &dhcp_state_discover );
1220
1221         /* Attach parent interface, mortalise self, and return */
1222         job_plug_plug ( &dhcp->job, job );
1223         ref_put ( &dhcp->refcnt );
1224         return 0;
1225
1226  err:
1227         dhcp_finished ( dhcp, rc );
1228         ref_put ( &dhcp->refcnt );
1229         return rc;
1230 }
1231
1232 /**
1233  * Retrieve list of PXE boot servers for a given server type
1234  *
1235  * @v dhcp              DHCP session
1236  * @v raw               DHCP PXE boot server list
1237  * @v raw_len           Length of DHCP PXE boot server list
1238  * @v ip                IP address list to fill in
1239  *
1240  * The caller must ensure that the IP address list has sufficient
1241  * space.
1242  */
1243 static void pxebs_list ( struct dhcp_session *dhcp, void *raw,
1244                          size_t raw_len, struct in_addr *ip ) {
1245         struct dhcp_pxe_boot_server *server = raw;
1246         size_t server_len;
1247         unsigned int i;
1248
1249         while ( raw_len ) {
1250                 if ( raw_len < sizeof ( *server ) ) {
1251                         DBGC ( dhcp, "DHCP %p malformed PXE server list\n",
1252                                dhcp );
1253                         break;
1254                 }
1255                 server_len = offsetof ( typeof ( *server ),
1256                                         ip[ server->num_ip ] );
1257                 if ( raw_len < server_len ) {
1258                         DBGC ( dhcp, "DHCP %p malformed PXE server list\n",
1259                                dhcp );
1260                         break;
1261                 }
1262                 if ( server->type == dhcp->pxe_type ) {
1263                         for ( i = 0 ; i < server->num_ip ; i++ )
1264                                 *(ip++) = server->ip[i];
1265                 }
1266                 server = ( ( ( void * ) server ) + server_len );
1267                 raw_len -= server_len;
1268         }
1269 }
1270
1271 /**
1272  * Start PXE Boot Server Discovery on a network device
1273  *
1274  * @v job               Job control interface
1275  * @v netdev            Network device
1276  * @v pxe_type          PXE server type
1277  * @ret rc              Return status code
1278  *
1279  * Starts PXE Boot Server Discovery on the specified network device.
1280  * If successful, the Boot Server ACK will be registered as an option
1281  * source.
1282  */
1283 int start_pxebs ( struct job_interface *job, struct net_device *netdev,
1284                   unsigned int pxe_type ) {
1285         struct setting pxe_discovery_control_setting =
1286                 { .tag = DHCP_PXE_DISCOVERY_CONTROL };
1287         struct setting pxe_boot_servers_setting =
1288                 { .tag = DHCP_PXE_BOOT_SERVERS };
1289         struct setting pxe_boot_server_mcast_setting =
1290                 { .tag = DHCP_PXE_BOOT_SERVER_MCAST };
1291         ssize_t pxebs_list_len;
1292         struct dhcp_session *dhcp;
1293         struct in_addr *ip;
1294         unsigned int pxe_discovery_control;
1295         int rc;
1296
1297         /* Get upper bound for PXE boot server IP address list */
1298         pxebs_list_len = fetch_setting_len ( NULL, &pxe_boot_servers_setting );
1299         if ( pxebs_list_len < 0 )
1300                 pxebs_list_len = 0;
1301
1302         /* Allocate and initialise structure */
1303         dhcp = zalloc ( sizeof ( *dhcp ) + sizeof ( *ip ) /* mcast */ +
1304                         sizeof ( *ip ) /* bcast */ + pxebs_list_len +
1305                         sizeof ( *ip ) /* terminator */ );
1306         if ( ! dhcp )
1307                 return -ENOMEM;
1308         dhcp->refcnt.free = dhcp_free;
1309         job_init ( &dhcp->job, &dhcp_job_operations, &dhcp->refcnt );
1310         xfer_init ( &dhcp->xfer, &dhcp_xfer_operations, &dhcp->refcnt );
1311         dhcp->netdev = netdev_get ( netdev );
1312         dhcp->local.sin_family = AF_INET;
1313         fetch_ipv4_setting ( netdev_settings ( netdev ), &ip_setting,
1314                              &dhcp->local.sin_addr );
1315         dhcp->local.sin_port = htons ( BOOTPC_PORT );
1316         dhcp->pxe_type = htons ( pxe_type );
1317         dhcp->timer.expired = dhcp_timer_expired;
1318
1319         /* Construct PXE boot server IP address lists */
1320         pxe_discovery_control =
1321                 fetch_uintz_setting ( NULL, &pxe_discovery_control_setting );
1322         ip = ( ( ( void * ) dhcp ) + sizeof ( *dhcp ) );
1323         dhcp->pxe_attempt = ip;
1324         if ( ! ( pxe_discovery_control & PXEBS_NO_MULTICAST ) ) {
1325                 fetch_ipv4_setting ( NULL, &pxe_boot_server_mcast_setting, ip);
1326                 if ( ip->s_addr )
1327                         ip++;
1328         }
1329         if ( ! ( pxe_discovery_control & PXEBS_NO_BROADCAST ) )
1330                 (ip++)->s_addr = INADDR_BROADCAST;
1331         if ( pxe_discovery_control & PXEBS_NO_UNKNOWN_SERVERS )
1332                 dhcp->pxe_accept = ip;
1333         if ( pxebs_list_len ) {
1334                 uint8_t buf[pxebs_list_len];
1335
1336                 fetch_setting ( NULL, &pxe_boot_servers_setting,
1337                                 buf, sizeof ( buf ) );
1338                 pxebs_list ( dhcp, buf, sizeof ( buf ), ip );
1339         }
1340         if ( ! dhcp->pxe_attempt->s_addr ) {
1341                 DBGC ( dhcp, "DHCP %p has no PXE boot servers for type %04x\n",
1342                        dhcp, pxe_type );
1343                 rc = -EINVAL;
1344                 goto err;
1345         }
1346
1347         /* Dump out PXE server lists */
1348         DBGC ( dhcp, "DHCP %p attempting", dhcp );
1349         for ( ip = dhcp->pxe_attempt ; ip->s_addr ; ip++ )
1350                 DBGC ( dhcp, " %s", inet_ntoa ( *ip ) );
1351         DBGC ( dhcp, "\n" );
1352         if ( dhcp->pxe_accept ) {
1353                 DBGC ( dhcp, "DHCP %p accepting", dhcp );
1354                 for ( ip = dhcp->pxe_accept ; ip->s_addr ; ip++ )
1355                         DBGC ( dhcp, " %s", inet_ntoa ( *ip ) );
1356                 DBGC ( dhcp, "\n" );
1357         }
1358
1359         /* Instantiate child objects and attach to our interfaces */
1360         if ( ( rc = xfer_open_socket ( &dhcp->xfer, SOCK_DGRAM, &dhcp_peer,
1361                                   ( struct sockaddr * ) &dhcp->local ) ) != 0 )
1362                 goto err;
1363
1364         /* Enter PXEBS state */
1365         dhcp_set_state ( dhcp, &dhcp_state_pxebs );
1366
1367         /* Attach parent interface, mortalise self, and return */
1368         job_plug_plug ( &dhcp->job, job );
1369         ref_put ( &dhcp->refcnt );
1370         return 0;
1371
1372  err:
1373         dhcp_finished ( dhcp, rc );
1374         ref_put ( &dhcp->refcnt );
1375         return rc;
1376 }