Add PXE-required DHCP options to DHCPDISCOVER and DHCPREQUEST packets.
[people/mdeck/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 #include <string.h>
20 #include <stdlib.h>
21 #include <stdio.h>
22 #include <errno.h>
23 #include <assert.h>
24 #include <byteswap.h>
25 #include <gpxe/if_ether.h>
26 #include <gpxe/netdevice.h>
27 #include <gpxe/device.h>
28 #include <gpxe/xfer.h>
29 #include <gpxe/open.h>
30 #include <gpxe/job.h>
31 #include <gpxe/retry.h>
32 #include <gpxe/tcpip.h>
33 #include <gpxe/ip.h>
34 #include <gpxe/uuid.h>
35 #include <gpxe/dhcp.h>
36
37 /** @file
38  *
39  * Dynamic Host Configuration Protocol
40  *
41  */
42
43 /** DHCP operation types
44  *
45  * This table maps from DHCP message types (i.e. values of the @c
46  * DHCP_MESSAGE_TYPE option) to values of the "op" field within a DHCP
47  * packet.
48  */
49 static const uint8_t dhcp_op[] = {
50         [DHCPDISCOVER]  = BOOTP_REQUEST,
51         [DHCPOFFER]     = BOOTP_REPLY,
52         [DHCPREQUEST]   = BOOTP_REQUEST,
53         [DHCPDECLINE]   = BOOTP_REQUEST,
54         [DHCPACK]       = BOOTP_REPLY,
55         [DHCPNAK]       = BOOTP_REPLY,
56         [DHCPRELEASE]   = BOOTP_REQUEST,
57         [DHCPINFORM]    = BOOTP_REQUEST,
58 };
59
60 /** Raw option data for options common to all DHCP requests */
61 static uint8_t dhcp_request_options_data[] = {
62         DHCP_MAX_MESSAGE_SIZE, DHCP_WORD ( ETH_MAX_MTU ),
63         DHCP_VENDOR_CLASS_ID,
64         DHCP_STRING (  'P', 'X', 'E', 'C', 'l', 'i', 'e', 'n', 't', ':',
65                        'A', 'r', 'c', 'h', ':', '0', '0', '0', '0', '0', ':',
66                        'U', 'N', 'D', 'I', ':', '0', '0', '2', '0', '0', '1' ),
67         DHCP_CLIENT_ARCHITECTURE, DHCP_WORD ( 0 ),
68         DHCP_CLIENT_NDI, DHCP_OPTION ( 1 /* UNDI */ , 2, 1 /* v2.1 */ ),
69         DHCP_PARAMETER_REQUEST_LIST,
70         DHCP_OPTION ( DHCP_SUBNET_MASK, DHCP_ROUTERS, DHCP_DNS_SERVERS,
71                       DHCP_LOG_SERVERS, DHCP_HOST_NAME, DHCP_DOMAIN_NAME,
72                       DHCP_ROOT_PATH, DHCP_VENDOR_ENCAP, DHCP_VENDOR_CLASS_ID,
73                       DHCP_TFTP_SERVER_NAME, DHCP_BOOTFILE_NAME,
74                       DHCP_EB_ENCAP, DHCP_ISCSI_INITIATOR_IQN ),
75         DHCP_END
76 };
77
78 /** DHCP feature codes */
79 static uint8_t dhcp_features[0] __table_start ( uint8_t, dhcp_features );
80 static uint8_t dhcp_features_end[0] __table_end ( uint8_t, dhcp_features );
81
82 /**
83  * Name a DHCP packet type
84  *
85  * @v msgtype           DHCP message type
86  * @ret string          DHCP mesasge type name
87  */
88 static inline const char * dhcp_msgtype_name ( unsigned int msgtype ) {
89         switch ( msgtype ) {
90         case 0:                 return "BOOTP"; /* Non-DHCP packet */
91         case DHCPDISCOVER:      return "DHCPDISCOVER";
92         case DHCPOFFER:         return "DHCPOFFER";
93         case DHCPREQUEST:       return "DHCPREQUEST";
94         case DHCPDECLINE:       return "DHCPDECLINE";
95         case DHCPACK:           return "DHCPACK";
96         case DHCPNAK:           return "DHCPNAK";
97         case DHCPRELEASE:       return "DHCPRELEASE";
98         case DHCPINFORM:        return "DHCPINFORM";
99         default:                return "DHCP<invalid>";
100         }
101 }
102
103 /**
104  * Calculate DHCP transaction ID for a network device
105  *
106  * @v netdev            Network device
107  * @ret xid             DHCP XID
108  *
109  * Extract the least significant bits of the hardware address for use
110  * as the transaction ID.
111  */
112 static uint32_t dhcp_xid ( struct net_device *netdev ) {
113         uint32_t xid;
114
115         memcpy ( &xid, ( netdev->ll_addr + netdev->ll_protocol->ll_addr_len
116                          - sizeof ( xid ) ), sizeof ( xid ) );
117         return xid;
118 }
119
120 /** Options common to all DHCP requests */
121 static struct dhcp_option_block dhcp_request_options = {
122         .data = dhcp_request_options_data,
123         .max_len = sizeof ( dhcp_request_options_data ),
124         .len = sizeof ( dhcp_request_options_data ),
125 };
126
127 /**
128  * Set option within DHCP packet
129  *
130  * @v dhcppkt           DHCP packet
131  * @v tag               DHCP option tag
132  * @v data              New value for DHCP option
133  * @v len               Length of value, in bytes
134  * @ret rc              Return status code
135  *
136  * Sets the option within the first available options block within the
137  * DHCP packet.  Option blocks are tried in the order specified by @c
138  * dhcp_option_block_fill_order.
139  *
140  * The magic options @c DHCP_EB_YIADDR and @c DHCP_EB_SIADDR are
141  * intercepted and inserted into the appropriate fixed fields within
142  * the DHCP packet.  The option @c DHCP_OPTION_OVERLOAD is silently
143  * ignored, since our DHCP packet assembly method relies on always
144  * having option overloading in use.
145  */
146 static int set_dhcp_packet_option ( struct dhcp_packet *dhcppkt,
147                                     unsigned int tag, const void *data,
148                                     size_t len ) {
149         struct dhcphdr *dhcphdr = dhcppkt->dhcphdr;
150         struct dhcp_option_block *options = &dhcppkt->options;
151         struct dhcp_option *option = NULL;
152
153         /* Special-case the magic options */
154         switch ( tag ) {
155         case DHCP_OPTION_OVERLOAD:
156                 /* Hard-coded in packets we create; always ignore */
157                 return 0;
158         case DHCP_EB_YIADDR:
159                 memcpy ( &dhcphdr->yiaddr, data, sizeof ( dhcphdr->yiaddr ) );
160                 return 0;
161         case DHCP_EB_SIADDR:
162                 memcpy ( &dhcphdr->siaddr, data, sizeof ( dhcphdr->siaddr ) );
163                 return 0;
164         case DHCP_TFTP_SERVER_NAME:
165                 memset ( dhcphdr->sname, 0, sizeof ( dhcphdr->sname ) );
166                 if ( len > sizeof ( dhcphdr->sname ) )
167                         len = sizeof ( dhcphdr->sname );
168                 memcpy ( dhcphdr->sname, data, len );
169                 return 0;
170         case DHCP_BOOTFILE_NAME:
171                 memset ( dhcphdr->file, 0, sizeof ( dhcphdr->file ) );
172                 if ( len > sizeof ( dhcphdr->file ) )
173                         len = sizeof ( dhcphdr->file );
174                 memcpy ( dhcphdr->file, data, len );
175                 return 0;
176         default:
177                 /* Continue processing as normal */
178                 break;
179         }
180                 
181         /* Set option */
182         option = set_dhcp_option ( options, tag, data, len );
183
184         /* Update DHCP packet length */
185         dhcppkt->len = ( offsetof ( typeof ( *dhcppkt->dhcphdr ), options )
186                          + dhcppkt->options.len );
187
188         return ( option ? 0 : -ENOSPC );
189 }
190
191 /**
192  * Copy option into DHCP packet
193  *
194  * @v dhcppkt           DHCP packet
195  * @v options           DHCP option block, or NULL
196  * @v tag               DHCP option tag to search for
197  * @v new_tag           DHCP option tag to use for copied option
198  * @ret rc              Return status code
199  *
200  * Copies a single option, if present, from the DHCP options block
201  * into a DHCP packet.  The tag for the option may be changed if
202  * desired; this is required by other parts of the DHCP code.
203  *
204  * @c options may specify a single options block, or be left as NULL
205  * in order to search for the option within all registered options
206  * blocks.
207  */
208 static int copy_dhcp_packet_option ( struct dhcp_packet *dhcppkt,
209                                      struct dhcp_option_block *options,
210                                      unsigned int tag, unsigned int new_tag ) {
211         struct dhcp_option *option;
212         int rc;
213
214         option = find_dhcp_option ( options, tag );
215         if ( option ) {
216                 if ( ( rc = set_dhcp_packet_option ( dhcppkt, new_tag,
217                                                      &option->data,
218                                                      option->len ) ) != 0 )
219                         return rc;
220         }
221         return 0;
222 }
223
224 /**
225  * Copy options into DHCP packet
226  *
227  * @v dhcppkt           DHCP packet
228  * @v options           DHCP option block, or NULL
229  * @v encapsulator      Encapsulating option, or zero
230  * @ret rc              Return status code
231  * 
232  * Copies options with the specified encapsulator from DHCP options
233  * blocks into a DHCP packet.  Most options are copied verbatim.
234  * Recognised encapsulated options fields are handled as such.
235  *
236  * @c options may specify a single options block, or be left as NULL
237  * in order to copy options from all registered options blocks.
238  */
239 static int copy_dhcp_packet_encap_options ( struct dhcp_packet *dhcppkt,
240                                             struct dhcp_option_block *options,
241                                             unsigned int encapsulator ) {
242         unsigned int subtag;
243         unsigned int tag;
244         int rc;
245
246         for ( subtag = DHCP_MIN_OPTION; subtag <= DHCP_MAX_OPTION; subtag++ ) {
247                 tag = DHCP_ENCAP_OPT ( encapsulator, subtag );
248                 switch ( tag ) {
249                 case DHCP_EB_ENCAP:
250                 case DHCP_VENDOR_ENCAP:
251                         /* Process encapsulated options field */
252                         if ( ( rc = copy_dhcp_packet_encap_options ( dhcppkt,
253                                                                      options,
254                                                                      tag)) !=0)
255                                 return rc;
256                         break;
257                 default:
258                         /* Copy option to reassembled packet */
259                         if ( ( rc = copy_dhcp_packet_option ( dhcppkt, options,
260                                                               tag, tag ) ) !=0)
261                                 return rc;
262                         break;
263                 };
264         }
265
266         return 0;
267 }
268
269 /**
270  * Copy options into DHCP packet
271  *
272  * @v dhcppkt           DHCP packet
273  * @v options           DHCP option block, or NULL
274  * @ret rc              Return status code
275  * 
276  * Copies options from DHCP options blocks into a DHCP packet.  Most
277  * options are copied verbatim.  Recognised encapsulated options
278  * fields are handled as such.
279  *
280  * @c options may specify a single options block, or be left as NULL
281  * in order to copy options from all registered options blocks.
282  */
283 static int copy_dhcp_packet_options ( struct dhcp_packet *dhcppkt,
284                                       struct dhcp_option_block *options ) {
285         return copy_dhcp_packet_encap_options ( dhcppkt, options, 0 );
286 }
287
288 /**
289  * Create a DHCP packet
290  *
291  * @v netdev            Network device
292  * @v msgtype           DHCP message type
293  * @v data              Buffer for DHCP packet
294  * @v max_len           Size of DHCP packet buffer
295  * @v dhcppkt           DHCP packet structure to fill in
296  * @ret rc              Return status code
297  *
298  * Creates a DHCP packet in the specified buffer, and fills out a @c
299  * dhcp_packet structure that can be passed to
300  * set_dhcp_packet_option() or copy_dhcp_packet_options().
301  */
302 static int create_dhcp_packet ( struct net_device *netdev, uint8_t msgtype,
303                                 void *data, size_t max_len,
304                                 struct dhcp_packet *dhcppkt ) {
305         struct dhcphdr *dhcphdr = data;
306         unsigned int hlen;
307         int rc;
308
309         /* Sanity check */
310         if ( max_len < sizeof ( *dhcphdr ) )
311                 return -ENOSPC;
312
313         /* Initialise DHCP packet content */
314         memset ( dhcphdr, 0, max_len );
315         dhcphdr->xid = dhcp_xid ( netdev );
316         dhcphdr->magic = htonl ( DHCP_MAGIC_COOKIE );
317         dhcphdr->htype = ntohs ( netdev->ll_protocol->ll_proto );
318         dhcphdr->op = dhcp_op[msgtype];
319         /* If hardware length exceeds the chaddr field length, don't
320          * use the chaddr field.  This is as per RFC4390.
321          */
322         hlen = netdev->ll_protocol->ll_addr_len;
323         if ( hlen > sizeof ( dhcphdr->chaddr ) ) {
324                 hlen = 0;
325                 dhcphdr->flags = htons ( BOOTP_FL_BROADCAST );
326         }
327         dhcphdr->hlen = hlen;
328         memcpy ( dhcphdr->chaddr, netdev->ll_addr, hlen );
329
330         /* Initialise DHCP packet structure */
331         dhcppkt->dhcphdr = dhcphdr;
332         dhcppkt->max_len = max_len;
333         init_dhcp_options ( &dhcppkt->options, dhcphdr->options,
334                             ( max_len -
335                               offsetof ( typeof ( *dhcphdr ), options ) ) );
336         
337         /* Set DHCP_MESSAGE_TYPE option */
338         if ( ( rc = set_dhcp_packet_option ( dhcppkt, DHCP_MESSAGE_TYPE,
339                                              &msgtype,
340                                              sizeof ( msgtype ) ) ) != 0 )
341                 return rc;
342
343         return 0;
344 }
345
346 /**
347  * Calculate used length of a field containing DHCP options
348  *
349  * @v data              Field containing DHCP options
350  * @v max_len           Field length
351  * @ret len             Used length (excluding the @c DHCP_END tag)
352  */
353 static size_t dhcp_field_len ( const void *data, size_t max_len ) {
354         struct dhcp_option_block options;
355         struct dhcp_option *end;
356
357         options.data = ( ( void * ) data );
358         options.len = max_len;
359         end = find_dhcp_option ( &options, DHCP_END );
360         return ( end ? ( ( ( void * ) end ) - data ) : 0 );
361 }
362
363 /**
364  * Merge field containing DHCP options or string into DHCP options block
365  *
366  * @v options           DHCP option block
367  * @v data              Field containing DHCP options
368  * @v max_len           Field length
369  * @v tag               DHCP option tag, or 0
370  *
371  * If @c tag is non-zero, the field will be treated as a
372  * NUL-terminated string representing the value of the specified DHCP
373  * option.  If @c tag is zero, the field will be treated as a block of
374  * DHCP options, and simply appended to the existing options in the
375  * option block.
376  *
377  * The caller must ensure that there is enough space in the options
378  * block to perform the merge.
379  */
380 static void merge_dhcp_field ( struct dhcp_option_block *options,
381                                const void *data, size_t max_len,
382                                unsigned int tag ) {
383         size_t len;
384         void *dest;
385         struct dhcp_option *end;
386
387         if ( tag ) {
388                 set_dhcp_option ( options, tag, data, strlen ( data ) );
389         } else {
390                 len = dhcp_field_len ( data, max_len );
391                 dest = ( options->data + options->len - 1 );
392                 memcpy ( dest, data, len );
393                 options->len += len;
394                 end = ( dest + len );
395                 end->tag = DHCP_END;
396         }
397 }
398
399 /**
400  * Parse DHCP packet and construct DHCP options block
401  *
402  * @v dhcphdr           DHCP packet
403  * @v len               Length of DHCP packet
404  * @ret options         DHCP options block, or NULL
405  *
406  * Parses a received DHCP packet and canonicalises its contents into a
407  * single DHCP options block.  The "file" and "sname" fields are
408  * converted into the corresponding DHCP options (@c
409  * DHCP_BOOTFILE_NAME and @c DHCP_TFTP_SERVER_NAME respectively).  If
410  * these fields are used for option overloading, their options are
411  * merged in to the options block.
412  *
413  * The values of the "yiaddr" and "siaddr" fields will be stored
414  * within the options block as the magic options @c DHCP_EB_YIADDR and
415  * @c DHCP_EB_SIADDR.
416  * 
417  * Note that this call allocates new memory for the constructed DHCP
418  * options block; it is the responsibility of the caller to eventually
419  * free this memory.
420  */
421 static struct dhcp_option_block * dhcp_parse ( const struct dhcphdr *dhcphdr,
422                                                size_t len ) {
423         struct dhcp_option_block *options;
424         size_t options_len;
425         unsigned int overloading;
426
427         /* Sanity check */
428         if ( len < sizeof ( *dhcphdr ) )
429                 return NULL;
430
431         /* Calculate size of resulting concatenated option block:
432          *
433          *   The "options" field : length of the field minus the DHCP_END tag.
434          *
435          *   The "file" field : maximum length of the field minus the
436          *   NUL terminator, plus a 2-byte DHCP header or, if used for
437          *   option overloading, the length of the field minus the
438          *   DHCP_END tag.
439          *
440          *   The "sname" field : as for the "file" field.
441          *
442          *   15 bytes for an encapsulated options field to contain the
443          *   value of the "yiaddr" and "siaddr" fields
444          *
445          *   1 byte for a final terminating DHCP_END tag.
446          */
447         options_len = ( ( len - offsetof ( typeof ( *dhcphdr ), options ) ) - 1
448                         + ( sizeof ( dhcphdr->file ) + 1 )
449                         + ( sizeof ( dhcphdr->sname ) + 1 )
450                         + 15 /* yiaddr and siaddr */
451                         + 1 /* DHCP_END tag */ );
452         
453         /* Allocate empty options block of required size */
454         options = alloc_dhcp_options ( options_len );
455         if ( ! options ) {
456                 DBG ( "DHCP could not allocate %d-byte option block\n",
457                       options_len );
458                 return NULL;
459         }
460         
461         /* Merge in "options" field, if this is a DHCP packet */
462         if ( dhcphdr->magic == htonl ( DHCP_MAGIC_COOKIE ) ) {
463                 merge_dhcp_field ( options, dhcphdr->options,
464                                    ( len -
465                                      offsetof ( typeof (*dhcphdr), options ) ),
466                                    0 /* Always contains options */ );
467         }
468
469         /* Identify overloaded fields */
470         overloading = find_dhcp_num_option ( options, DHCP_OPTION_OVERLOAD );
471         
472         /* Merge in "file" and "sname" fields */
473         merge_dhcp_field ( options, dhcphdr->file, sizeof ( dhcphdr->file ),
474                            ( ( overloading & DHCP_OPTION_OVERLOAD_FILE ) ?
475                              0 : DHCP_BOOTFILE_NAME ) );
476         merge_dhcp_field ( options, dhcphdr->sname, sizeof ( dhcphdr->sname ),
477                            ( ( overloading & DHCP_OPTION_OVERLOAD_SNAME ) ?
478                              0 : DHCP_TFTP_SERVER_NAME ) );
479
480         /* Set magic options for "yiaddr" and "siaddr", if present */
481         if ( dhcphdr->yiaddr.s_addr ) {
482                 set_dhcp_option ( options, DHCP_EB_YIADDR,
483                                   &dhcphdr->yiaddr, sizeof (dhcphdr->yiaddr) );
484         }
485         if ( dhcphdr->siaddr.s_addr ) {
486                 set_dhcp_option ( options, DHCP_EB_SIADDR,
487                                   &dhcphdr->siaddr, sizeof (dhcphdr->siaddr) );
488         }
489         
490         assert ( options->len <= options->max_len );
491
492         return options;
493 }
494
495 /****************************************************************************
496  *
497  * Whole-packet construction
498  *
499  */
500
501 /** DHCP network device descriptor */
502 struct dhcp_netdev_desc {
503         /** Bus type ID */
504         uint8_t type;
505         /** Vendor ID */
506         uint16_t vendor;
507         /** Device ID */
508         uint16_t device;
509 } __attribute__ (( packed ));
510
511 /** DHCP client identifier */
512 struct dhcp_client_id {
513         /** Link-layer protocol */
514         uint8_t ll_proto;
515         /** Link-layer address */
516         uint8_t ll_addr[MAX_LL_ADDR_LEN];
517 } __attribute__ (( packed ));
518
519 /** DHCP client UUID */
520 struct dhcp_client_uuid {
521         /** Identifier type */
522         uint8_t type;
523         /** UUID */
524         union uuid uuid;
525 } __attribute__ (( packed ));
526
527 #define DHCP_CLIENT_UUID_TYPE 0
528
529 /**
530  * Create DHCP request
531  *
532  * @v netdev            Network device
533  * @v msgtype           DHCP message type
534  * @v options           DHCP server response options, or NULL
535  * @v data              Buffer for DHCP packet
536  * @v max_len           Size of DHCP packet buffer
537  * @v dhcppkt           DHCP packet structure to fill in
538  * @ret rc              Return status code
539  */
540 int create_dhcp_request ( struct net_device *netdev, int msgtype,
541                           struct dhcp_option_block *options,
542                           void *data, size_t max_len,
543                           struct dhcp_packet *dhcppkt ) {
544         struct device_description *desc = &netdev->dev->desc;
545         struct dhcp_netdev_desc dhcp_desc;
546         struct dhcp_client_id client_id;
547         struct dhcp_client_uuid client_uuid;
548         size_t dhcp_features_len;
549         size_t ll_addr_len;
550         int rc;
551
552         /* Create DHCP packet */
553         if ( ( rc = create_dhcp_packet ( netdev, msgtype, data, max_len,
554                                          dhcppkt ) ) != 0 ) {
555                 DBG ( "DHCP could not create DHCP packet: %s\n",
556                       strerror ( rc ) );
557                 return rc;
558         }
559
560         /* Copy in options common to all requests */
561         if ( ( rc = copy_dhcp_packet_options ( dhcppkt,
562                                                &dhcp_request_options )) !=0 ){
563                 DBG ( "DHCP could not set common DHCP options: %s\n",
564                       strerror ( rc ) );
565                 return rc;
566         }
567
568         /* Copy any required options from previous server repsonse */
569         if ( options ) {
570                 if ( ( rc = copy_dhcp_packet_option ( dhcppkt, options,
571                                           DHCP_SERVER_IDENTIFIER,
572                                           DHCP_SERVER_IDENTIFIER ) ) != 0 ) {
573                         DBG ( "DHCP could not set server identifier "
574                               "option: %s\n", strerror ( rc ) );
575                         return rc;
576                 }
577                 if ( ( rc = copy_dhcp_packet_option ( dhcppkt, options,
578                                           DHCP_EB_YIADDR,
579                                           DHCP_REQUESTED_ADDRESS ) ) != 0 ) {
580                         DBG ( "DHCP could not set requested address "
581                               "option: %s\n", strerror ( rc ) );
582                         return rc;
583                 }
584         }
585
586         /* Add options to identify the feature list */
587         dhcp_features_len = ( dhcp_features_end - dhcp_features );
588         if ( ( rc = set_dhcp_packet_option ( dhcppkt, DHCP_EB_ENCAP,
589                                              dhcp_features,
590                                              dhcp_features_len ) ) != 0 ) {
591                 DBG ( "DHCP could not set features list option: %s\n",
592                       strerror ( rc ) );
593                 return rc;
594         }
595
596         /* Add options to identify the network device */
597         dhcp_desc.type = desc->bus_type;
598         dhcp_desc.vendor = htons ( desc->vendor );
599         dhcp_desc.device = htons ( desc->device );
600         if ( ( rc = set_dhcp_packet_option ( dhcppkt, DHCP_EB_BUS_ID,
601                                              &dhcp_desc,
602                                              sizeof ( dhcp_desc ) ) ) != 0 ) {
603                 DBG ( "DHCP could not set bus ID option: %s\n",
604                       strerror ( rc ) );
605                 return rc;
606         }
607
608         /* Add DHCP client identifier.  Required for Infiniband, and
609          * doesn't hurt other link layers.
610          */
611         client_id.ll_proto = netdev->ll_protocol->ll_proto;
612         ll_addr_len = netdev->ll_protocol->ll_addr_len;
613         assert ( ll_addr_len <= sizeof ( client_id.ll_addr ) );
614         memcpy ( client_id.ll_addr, netdev->ll_addr, ll_addr_len );
615         if ( ( rc = set_dhcp_packet_option ( dhcppkt, DHCP_CLIENT_ID,
616                                              &client_id,
617                                              ( ll_addr_len + 1 ) ) ) != 0 ) {
618                 DBG ( "DHCP could not set client ID: %s\n",
619                       strerror ( rc ) );
620                 return rc;
621         }
622
623         /* Add client UUID, if we have one.  Required for PXE. */
624         client_uuid.type = DHCP_CLIENT_UUID_TYPE;
625         if ( ( rc = get_uuid ( &client_uuid.uuid ) ) == 0 ) {
626                 if ( ( rc = set_dhcp_packet_option ( dhcppkt,
627                                            DHCP_CLIENT_UUID, &client_uuid,
628                                            sizeof ( client_uuid ) ) ) != 0 ) {
629                         DBG ( "DHCP could not set client UUID: %s\n",
630                               strerror ( rc ) );
631                         return rc;
632                 }
633         }
634
635         return 0;
636 }
637
638 /**
639  * Create DHCP response
640  *
641  * @v netdev            Network device
642  * @v msgtype           DHCP message type
643  * @v options           DHCP options, or NULL
644  * @v data              Buffer for DHCP packet
645  * @v max_len           Size of DHCP packet buffer
646  * @v dhcppkt           DHCP packet structure to fill in
647  * @ret rc              Return status code
648  */
649 int create_dhcp_response ( struct net_device *netdev, int msgtype,
650                            struct dhcp_option_block *options,
651                            void *data, size_t max_len,
652                            struct dhcp_packet *dhcppkt ) {
653         int rc;
654
655         /* Create packet and copy in options */
656         if ( ( rc = create_dhcp_packet ( netdev, msgtype, data, max_len,
657                                          dhcppkt ) ) != 0 ) {
658                 DBG ( " failed to build packet" );
659                 return rc;
660         }
661         if ( ( rc = copy_dhcp_packet_options ( dhcppkt, options ) ) != 0 ) {
662                 DBG ( " failed to copy options" );
663                 return rc;
664         }
665
666         return 0;
667 }
668
669 /****************************************************************************
670  *
671  * DHCP to UDP interface
672  *
673  */
674
675 /** A DHCP session */
676 struct dhcp_session {
677         /** Reference counter */
678         struct refcnt refcnt;
679         /** Job control interface */
680         struct job_interface job;
681         /** Data transfer interface */
682         struct xfer_interface xfer;
683
684         /** Network device being configured */
685         struct net_device *netdev;
686         /** Option block registration routine */
687         int ( * register_options ) ( struct net_device *netdev,
688                                      struct dhcp_option_block *options );
689
690         /** State of the session
691          *
692          * This is a value for the @c DHCP_MESSAGE_TYPE option
693          * (e.g. @c DHCPDISCOVER).
694          */
695         int state;
696         /** Options obtained from server */
697         struct dhcp_option_block *options;
698         /** Retransmission timer */
699         struct retry_timer timer;
700 };
701
702 /**
703  * Free DHCP session
704  *
705  * @v refcnt            Reference counter
706  */
707 static void dhcp_free ( struct refcnt *refcnt ) {
708         struct dhcp_session *dhcp =
709                 container_of ( refcnt, struct dhcp_session, refcnt );
710
711         netdev_put ( dhcp->netdev );
712         dhcpopt_put ( dhcp->options );
713         free ( dhcp );
714 }
715
716 /**
717  * Mark DHCP session as complete
718  *
719  * @v dhcp              DHCP session
720  * @v rc                Return status code
721  */
722 static void dhcp_finished ( struct dhcp_session *dhcp, int rc ) {
723
724         /* Block futher incoming messages */
725         job_nullify ( &dhcp->job );
726         xfer_nullify ( &dhcp->xfer );
727
728         /* Stop retry timer */
729         stop_timer ( &dhcp->timer );
730
731         /* Free resources and close interfaces */
732         xfer_close ( &dhcp->xfer, rc );
733         job_done ( &dhcp->job, rc );
734 }
735
736 /****************************************************************************
737  *
738  * Data transfer interface
739  *
740  */
741
742 /**
743  * Transmit DHCP request
744  *
745  * @v dhcp              DHCP session
746  * @ret rc              Return status code
747  */
748 static int dhcp_send_request ( struct dhcp_session *dhcp ) {
749         struct xfer_metadata meta = {
750                 .netdev = dhcp->netdev,
751         };
752         struct io_buffer *iobuf;
753         struct dhcp_packet dhcppkt;
754         int rc;
755         
756         DBGC ( dhcp, "DHCP %p transmitting %s\n",
757                dhcp, dhcp_msgtype_name ( dhcp->state ) );
758
759         assert ( ( dhcp->state == DHCPDISCOVER ) ||
760                  ( dhcp->state == DHCPREQUEST ) );
761
762         /* Start retry timer.  Do this first so that failures to
763          * transmit will be retried.
764          */
765         start_timer ( &dhcp->timer );
766
767         /* Allocate buffer for packet */
768         iobuf = xfer_alloc_iob ( &dhcp->xfer, DHCP_MIN_LEN );
769         if ( ! iobuf )
770                 return -ENOMEM;
771
772         /* Create DHCP packet in temporary buffer */
773         if ( ( rc = create_dhcp_request ( dhcp->netdev, dhcp->state,
774                                           dhcp->options, iobuf->data,
775                                           iob_tailroom ( iobuf ),
776                                           &dhcppkt ) ) != 0 ) {
777                 DBGC ( dhcp, "DHCP %p could not construct DHCP request: %s\n",
778                        dhcp, strerror ( rc ) );
779                 goto done;
780         }
781
782         /* Transmit the packet */
783         iob_put ( iobuf, dhcppkt.len );
784         rc = xfer_deliver_iob_meta ( &dhcp->xfer, iobuf, &meta );
785         iobuf = NULL;
786         if ( rc != 0 ) {
787                 DBGC ( dhcp, "DHCP %p could not transmit UDP packet: %s\n",
788                        dhcp, strerror ( rc ) );
789                 goto done;
790         }
791
792  done:
793         free_iob ( iobuf );
794         return rc;
795 }
796
797 /**
798  * Handle DHCP retry timer expiry
799  *
800  * @v timer             DHCP retry timer
801  * @v fail              Failure indicator
802  */
803 static void dhcp_timer_expired ( struct retry_timer *timer, int fail ) {
804         struct dhcp_session *dhcp =
805                 container_of ( timer, struct dhcp_session, timer );
806
807         if ( fail ) {
808                 dhcp_finished ( dhcp, -ETIMEDOUT );
809         } else {
810                 dhcp_send_request ( dhcp );
811         }
812 }
813
814 /**
815  * Receive new data
816  *
817  * @v xfer              Data transfer interface
818  * @v iobuf             I/O buffer
819  * @v data              Received data
820  * @v len               Length of received data
821  * @ret rc              Return status code
822  */
823 static int dhcp_deliver_raw ( struct xfer_interface *xfer,
824                               const void *data, size_t len ) {
825         struct dhcp_session *dhcp =
826                 container_of ( xfer, struct dhcp_session, xfer );
827         const struct dhcphdr *dhcphdr = data;
828         struct dhcp_option_block *options;
829         unsigned int msgtype;
830
831         /* Check for matching transaction ID */
832         if ( dhcphdr->xid != dhcp_xid ( dhcp->netdev ) ) {
833                 DBGC ( dhcp, "DHCP %p wrong transaction ID (wanted %08lx, "
834                         "got %08lx)\n", dhcp, ntohl ( dhcphdr->xid ),
835                         ntohl ( dhcp_xid ( dhcp->netdev ) ) );
836                 return 0;
837         };
838
839         /* Parse packet and create options structure */
840         options = dhcp_parse ( dhcphdr, len );
841         if ( ! options ) {
842                 DBGC ( dhcp, "DHCP %p could not parse DHCP packet\n", dhcp );
843                 return -EINVAL;
844         }
845
846         /* Determine message type */
847         msgtype = find_dhcp_num_option ( options, DHCP_MESSAGE_TYPE );
848         DBGC ( dhcp, "DHCP %p received %s\n",
849                dhcp, dhcp_msgtype_name ( msgtype ) );
850
851         /* Handle DHCP reply */
852         switch ( dhcp->state ) {
853         case DHCPDISCOVER:
854                 if ( msgtype != DHCPOFFER )
855                         goto out_discard;
856                 dhcp->state = DHCPREQUEST;
857                 break;
858         case DHCPREQUEST:
859                 if ( msgtype != DHCPACK )
860                         goto out_discard;
861                 dhcp->state = DHCPACK;
862                 break;
863         default:
864                 assert ( 0 );
865                 goto out_discard;
866         }
867
868         /* Stop timer and update stored options */
869         stop_timer ( &dhcp->timer );
870         if ( dhcp->options )
871                 dhcpopt_put ( dhcp->options );
872         dhcp->options = options;
873
874         /* Transmit next packet, or terminate session */
875         if ( dhcp->state < DHCPACK ) {
876                 dhcp_send_request ( dhcp );
877         } else {
878                 dhcp->register_options ( dhcp->netdev, dhcp->options );
879                 dhcp_finished ( dhcp, 0 );
880         }
881         return 0;
882
883  out_discard:
884         dhcpopt_put ( options );
885         return 0;
886 }
887
888 /** DHCP data transfer interface operations */
889 static struct xfer_interface_operations dhcp_xfer_operations = {
890         .close          = ignore_xfer_close,
891         .vredirect      = xfer_vopen,
892         .seek           = ignore_xfer_seek,
893         .window         = unlimited_xfer_window,
894         .deliver_iob    = xfer_deliver_as_raw,
895         .deliver_raw    = dhcp_deliver_raw,
896 };
897
898 /****************************************************************************
899  *
900  * Job control interface
901  *
902  */
903
904 /**
905  * Handle kill() event received via job control interface
906  *
907  * @v job               DHCP job control interface
908  */
909 static void dhcp_job_kill ( struct job_interface *job ) {
910         struct dhcp_session *dhcp =
911                 container_of ( job, struct dhcp_session, job );
912
913         /* Terminate DHCP session */
914         dhcp_finished ( dhcp, -ECANCELED );
915 }
916
917 /** DHCP job control interface operations */
918 static struct job_interface_operations dhcp_job_operations = {
919         .done           = ignore_job_done,
920         .kill           = dhcp_job_kill,
921         .progress       = ignore_job_progress,
922 };
923
924 /****************************************************************************
925  *
926  * Instantiator
927  *
928  */
929
930 /**
931  * Start DHCP on a network device
932  *
933  * @v job               Job control interface
934  * @v netdev            Network device
935  * @v register_options  DHCP option block registration routine
936  * @ret rc              Return status code
937  *
938  * Starts DHCP on the specified network device.  If successful, the @c
939  * register_options() routine will be called with the acquired
940  * options.
941  */
942 int start_dhcp ( struct job_interface *job, struct net_device *netdev,
943                  int ( * register_options ) ( struct net_device *netdev,
944                                               struct dhcp_option_block * ) ) {
945         static struct sockaddr_in server = {
946                 .sin_family = AF_INET,
947                 .sin_addr.s_addr = INADDR_BROADCAST,
948                 .sin_port = htons ( BOOTPS_PORT ),
949         };
950         static struct sockaddr_in client = {
951                 .sin_family = AF_INET,
952                 .sin_port = htons ( BOOTPC_PORT ),
953         };
954         struct dhcp_session *dhcp;
955         int rc;
956
957         /* Allocate and initialise structure */
958         dhcp = zalloc ( sizeof ( *dhcp ) );
959         if ( ! dhcp )
960                 return -ENOMEM;
961         dhcp->refcnt.free = dhcp_free;
962         job_init ( &dhcp->job, &dhcp_job_operations, &dhcp->refcnt );
963         xfer_init ( &dhcp->xfer, &dhcp_xfer_operations, &dhcp->refcnt );
964         dhcp->netdev = netdev_get ( netdev );
965         dhcp->register_options = register_options;
966         dhcp->timer.expired = dhcp_timer_expired;
967         dhcp->state = DHCPDISCOVER;
968
969         /* Instantiate child objects and attach to our interfaces */
970         if ( ( rc = xfer_open_socket ( &dhcp->xfer, SOCK_DGRAM,
971                                        ( struct sockaddr * ) &server,
972                                        ( struct sockaddr * ) &client ) ) != 0 )
973                 goto err;
974
975         /* Start timer to initiate initial DHCPREQUEST */
976         start_timer_nodelay ( &dhcp->timer );
977
978         /* Attach parent interface, mortalise self, and return */
979         job_plug_plug ( &dhcp->job, job );
980         ref_put ( &dhcp->refcnt );
981         return 0;
982
983  err:
984         dhcp_finished ( dhcp, rc );
985         ref_put ( &dhcp->refcnt );
986         return rc;
987 }
988
989 /****************************************************************************
990  *
991  * Network device configurator
992  *
993  */
994
995 /**
996  * Configure network device from DHCP options
997  *
998  * @v netdev            Network device
999  * @v options           DHCP options block
1000  * @ret rc              Return status code
1001  */
1002 int dhcp_configure_netdev ( struct net_device *netdev,
1003                             struct dhcp_option_block *options ) {
1004         struct in_addr address = { 0 };
1005         struct in_addr netmask = { 0 };
1006         struct in_addr gateway = { INADDR_NONE };
1007         int rc;
1008
1009         /* Clear any existing routing table entry */
1010         del_ipv4_address ( netdev );
1011
1012         /* Retrieve IP address configuration */
1013         find_dhcp_ipv4_option ( options, DHCP_EB_YIADDR, &address );
1014         find_dhcp_ipv4_option ( options, DHCP_SUBNET_MASK, &netmask );
1015         find_dhcp_ipv4_option ( options, DHCP_ROUTERS, &gateway );
1016
1017         /* Set up new IP address configuration */
1018         if ( ( rc = add_ipv4_address ( netdev, address, netmask,
1019                                        gateway ) ) != 0 ) {
1020                 DBG ( "Could not configure %s with DHCP results: %s\n",
1021                       netdev->name, strerror ( rc ) );
1022                 return rc;
1023         }
1024
1025         return 0;
1026 }