datapath: Allow jumbograms through IPv6 parsing.
[openvswitch] / lib / dhcp.c
1 /*
2  * Copyright (c) 2008, 2010 Nicira Networks.
3  *
4  * Licensed under the Apache License, Version 2.0 (the "License");
5  * you may not use this file except in compliance with the License.
6  * You may obtain a copy of the License at:
7  *
8  *     http://www.apache.org/licenses/LICENSE-2.0
9  *
10  * Unless required by applicable law or agreed to in writing, software
11  * distributed under the License is distributed on an "AS IS" BASIS,
12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13  * See the License for the specific language governing permissions and
14  * limitations under the License.
15  */
16
17 #include <config.h>
18 #include "dhcp.h"
19 #include <arpa/inet.h>
20 #include <assert.h>
21 #include <ctype.h>
22 #include <errno.h>
23 #include <inttypes.h>
24 #include <stdlib.h>
25 #include "dynamic-string.h"
26 #include "ofpbuf.h"
27 #include "vlog.h"
28
29 VLOG_DEFINE_THIS_MODULE(dhcp);
30
31 /* Information about a DHCP argument type. */
32 struct arg_type {
33     const char *name;           /* Name. */
34     size_t size;                /* Number of bytes per argument. */
35 };
36
37 static struct arg_type types[] = {
38 #define DHCP_ARG(NAME, SIZE) [DHCP_ARG_##NAME] = {#NAME, SIZE},
39     DHCP_ARGS
40 #undef DHCP_ARG
41 };
42
43 /* Information about a DHCP option. */
44 struct option_class {
45     const char *name;           /* Name. */
46     enum dhcp_arg_type type;    /* Argument type. */
47     size_t min_args;            /* Minimum number of arguments. */
48     size_t max_args;            /* Maximum number of arguments. */
49 };
50
51 static const struct option_class *
52 get_option_class(int code)
53 {
54     static struct option_class classes[DHCP_N_OPTIONS];
55     static bool init = false;
56     if (!init) {
57         int i;
58
59         init = true;
60 #define DHCP_OPT(NAME, CODE, TYPE, MIN, MAX)    \
61         classes[CODE].name = #NAME;             \
62         classes[CODE].type = DHCP_ARG_##TYPE;   \
63         classes[CODE].min_args = MIN;           \
64         classes[CODE].max_args = MAX;
65         DHCP_OPTS
66 #undef DHCP_OPT
67
68         for (i = 0; i < DHCP_N_OPTIONS; i++) {
69             if (!classes[i].name) {
70                 classes[i].name = xasprintf("option-%d", i);
71                 classes[i].type = DHCP_ARG_UINT8;
72                 classes[i].min_args = 0;
73                 classes[i].max_args = SIZE_MAX;
74             }
75         }
76     }
77     assert(code >= 0 && code < DHCP_N_OPTIONS);
78     return &classes[code];
79 }
80
81 /* A single (bad) DHCP message can in theory dump out many, many log messages,
82  * especially at high logging levels, so the burst size is set quite high
83  * here to avoid missing useful information. */
84 struct vlog_rate_limit rl = VLOG_RATE_LIMIT_INIT(60, 600);
85
86 static void copy_data(struct dhcp_msg *);
87
88 const char *
89 dhcp_type_name(enum dhcp_msg_type type)
90 {
91     switch (type) {
92 #define DHCP_MSG(NAME, VALUE) case NAME: return #NAME;
93         DHCP_MSGS
94 #undef DHCP_MSG
95     }
96     return "<<unknown DHCP message type>>";
97 }
98
99 /* Initializes 'msg' as a DHCP message.  The message should be freed with
100  * dhcp_msg_uninit() when it is no longer needed. */
101 void
102 dhcp_msg_init(struct dhcp_msg *msg)
103 {
104     memset(msg, 0, sizeof *msg);
105 }
106
107 /* Frees the contents of 'msg'.  The caller is responsible for freeing 'msg',
108  * if necessary. */
109 void
110 dhcp_msg_uninit(struct dhcp_msg *msg)
111 {
112     if (msg) {
113         free(msg->data);
114     }
115 }
116
117 /* Initializes 'dst' as a copy of 'src'.  'dst' (and 'src') should be freed
118  * with dhcp_msg_uninit() when it is no longer needed. */
119 void
120 dhcp_msg_copy(struct dhcp_msg *dst, const struct dhcp_msg *src)
121 {
122     *dst = *src;
123     dst->data_allocated = src->data_used;
124     dst->data_used = 0;
125     dst->data = xmalloc(dst->data_allocated);
126     copy_data(dst);
127 }
128
129 static void
130 prealloc_data(struct dhcp_msg *msg, size_t n)
131 {
132     size_t needed = msg->data_used + n;
133     if (needed > msg->data_allocated) {
134         uint8_t *old_data = msg->data;
135         msg->data_allocated = MAX(needed * 2, 64);
136         msg->data = xmalloc(msg->data_allocated);
137         if (old_data) {
138             copy_data(msg);
139             free(old_data);
140         }
141     }
142 }
143
144 static void *
145 append_data(struct dhcp_msg *msg, const void *data, size_t n)
146 {
147     uint8_t *p = &msg->data[msg->data_used];
148     memcpy(p, data, n);
149     msg->data_used += n;
150     return p;
151 }
152
153 static void
154 copy_data(struct dhcp_msg *msg)
155 {
156     int code;
157
158     msg->data_used = 0;
159     for (code = 0; code < DHCP_N_OPTIONS; code++) {
160         struct dhcp_option *opt = &msg->options[code];
161         if (opt->data) {
162             assert(msg->data_used + opt->n <= msg->data_allocated);
163             opt->data = append_data(msg, opt->data, opt->n);
164         }
165     }
166 }
167
168 /* Appends the 'n' bytes in 'data' to the DHCP option in 'msg' represented by
169  * 'code' (which must be in the range 0...DHCP_N_OPTIONS). */
170 void
171 dhcp_msg_put(struct dhcp_msg *msg, int code,
172              const void *data, size_t n)
173 {
174     struct dhcp_option *opt;
175     if (code == DHCP_CODE_PAD || code == DHCP_CODE_END) {
176         return;
177     }
178
179     opt = &msg->options[code];
180     prealloc_data(msg, n + opt->n);
181     if (opt->n) {
182         if (&msg->data[msg->data_used - opt->n] != opt->data) {
183             opt->data = append_data(msg, opt->data, opt->n);
184         }
185         append_data(msg, data, n);
186     } else {
187         opt->data = append_data(msg, data, n);
188     }
189     opt->n += n;
190 }
191
192 /* Appends the boolean value 'b', as a octet with value 0 (false) or 1 (true),
193  * to the DHCP option in 'msg' represented by 'code' (which must be in the
194  * range 0...DHCP_N_OPTIONS). */
195 void
196 dhcp_msg_put_bool(struct dhcp_msg *msg, int code, bool b_)
197 {
198     char b = !!b_;
199     dhcp_msg_put(msg, code, &b, 1);
200 }
201
202 /* Appends the number of seconds 'secs', as a 32-bit number in network byte
203  * order, to the DHCP option in 'msg' represented by 'code' (which must be in
204  * the range 0...DHCP_N_OPTIONS). */
205 void
206 dhcp_msg_put_secs(struct dhcp_msg *msg, int code, uint32_t secs_)
207 {
208     uint32_t secs = htonl(secs_);
209     dhcp_msg_put(msg, code, &secs, sizeof secs);
210 }
211
212 /* Appends the IP address 'ip', as a 32-bit number in network byte order, to
213  * the DHCP option in 'msg' represented by 'code' (which must be in the range
214  * 0...DHCP_N_OPTIONS). */
215 void
216 dhcp_msg_put_ip(struct dhcp_msg *msg, int code, uint32_t ip)
217 {
218     dhcp_msg_put(msg, code, &ip, sizeof ip);
219 }
220
221 /* Appends the ASCII string 'string', to the DHCP option in 'msg' represented
222  * by 'code' (which must be in the range 0...DHCP_N_OPTIONS). */
223 void
224 dhcp_msg_put_string(struct dhcp_msg *msg, int code, const char *string)
225 {
226     dhcp_msg_put(msg, code, string, strlen(string));
227 }
228
229 /* Appends octet 'x' to DHCP option in 'msg' represented by 'code' (which must
230  * be in the range 0...DHCP_N_OPTIONS). */
231 void
232 dhcp_msg_put_uint8(struct dhcp_msg *msg, int code, uint8_t x)
233 {
234     dhcp_msg_put(msg, code, &x, sizeof x);
235 }
236
237 /* Appends the 'n' octets in 'data' to DHCP option in 'msg' represented by
238  * 'code' (which must be in the range 0...DHCP_N_OPTIONS). */
239 void dhcp_msg_put_uint8_array(struct dhcp_msg *msg, int code,
240                               const uint8_t data[], size_t n)
241 {
242     dhcp_msg_put(msg, code, data, n);
243 }
244
245 /* Appends the 16-bit value in 'x', in network byte order, to DHCP option in
246  * 'msg' represented by 'code' (which must be in the range
247  * 0...DHCP_N_OPTIONS). */
248 void
249 dhcp_msg_put_uint16(struct dhcp_msg *msg, int code, uint16_t x_)
250 {
251     uint16_t x = htons(x_);
252     dhcp_msg_put(msg, code, &x, sizeof x);
253 }
254
255
256 /* Appends the 'n' 16-bit values in 'data', in network byte order, to DHCP
257  * option in 'msg' represented by 'code' (which must be in the range
258  * 0...DHCP_N_OPTIONS). */
259 void
260 dhcp_msg_put_uint16_array(struct dhcp_msg *msg, int code,
261                           const uint16_t data[], size_t n)
262 {
263     size_t i;
264
265     for (i = 0; i < n; i++) {
266         dhcp_msg_put_uint16(msg, code, data[i]);
267     }
268 }
269
270 /* Returns a pointer to the 'size' bytes starting at byte offset 'offset' in
271  * the DHCP option in 'msg' represented by 'code' (which must be in the range
272  * 0...DHCP_N_OPTIONS).  If the option has fewer than 'offset + size' bytes,
273  * returns a null pointer. */
274 const void *
275 dhcp_msg_get(const struct dhcp_msg *msg, int code,
276              size_t offset, size_t size)
277 {
278     const struct dhcp_option *opt = &msg->options[code];
279     return offset + size <= opt->n ? (const char *) opt->data + offset : NULL;
280 }
281
282 /* Stores in '*out' the boolean value at byte offset 'offset' in the DHCP
283  * option in 'msg' represented by 'code' (which must be in the range
284  * 0...DHCP_N_OPTIONS).  Returns true if successful, false if the option has
285  * fewer than 'offset + 1' bytes. */
286 bool
287 dhcp_msg_get_bool(const struct dhcp_msg *msg, int code, size_t offset,
288                   bool *out)
289 {
290     const uint8_t *uint8 = dhcp_msg_get(msg, code, offset, sizeof *uint8);
291     if (uint8) {
292         *out = *uint8 != 0;
293         return true;
294     } else {
295         return false;
296     }
297 }
298
299 /* Stores in '*out' the 32-bit count of seconds at offset 'offset' (in
300  * 4-byte increments) in the DHCP option in 'msg' represented by 'code'
301  * (which must be in the range 0...DHCP_N_OPTIONS).  The value is converted to
302  * native byte order.  Returns true if successful, false if the option has
303  * fewer than '4 * (offset + 1)' bytes. */
304 bool
305 dhcp_msg_get_secs(const struct dhcp_msg *msg, int code, size_t offset,
306                   uint32_t *out)
307 {
308     const uint32_t *uint32 = dhcp_msg_get(msg, code, offset * sizeof *uint32,
309                                           sizeof *uint32);
310     if (uint32) {
311         *out = ntohl(*uint32);
312         return true;
313     } else {
314         return false;
315     }
316 }
317
318 /* Stores in '*out' the IP address at offset 'offset' (in 4-byte increments) in
319  * the DHCP option in 'msg' represented by 'code' (which must be in the range
320  * 0...DHCP_N_OPTIONS).  The IP address is stored in network byte order.
321  * Returns true if successful, false if the option has fewer than '4 * (offset
322  * + 1)' bytes. */
323 bool
324 dhcp_msg_get_ip(const struct dhcp_msg *msg, int code,
325                 size_t offset, uint32_t *out)
326 {
327     const uint32_t *uint32 = dhcp_msg_get(msg, code, offset * sizeof *uint32,
328                                           sizeof *uint32);
329     if (uint32) {
330         *out = *uint32;
331         return true;
332     } else {
333         return false;
334     }
335 }
336
337 /* Returns the string in the DHCP option in 'msg' represented by 'code' (which
338  * must be in the range 0...DHCP_N_OPTIONS).  The caller is responsible for
339  * freeing the string with free().
340  *
341  * If 'msg' has no option represented by 'code', returns a null pointer.  (If
342  * the option was specified but had no content, then an empty string is
343  * returned, not a null pointer.) */
344 char *
345 dhcp_msg_get_string(const struct dhcp_msg *msg, int code)
346 {
347     const struct dhcp_option *opt = &msg->options[code];
348     return opt->data ? xmemdup0(opt->data, opt->n) : NULL;
349 }
350
351 /* Stores in '*out' the octet at byte offset 'offset' in the DHCP option in
352  * 'msg' represented by 'code' (which must be in the range 0...DHCP_N_OPTIONS).
353  * Returns true if successful, false if the option has fewer than 'offset + 1'
354  * bytes. */
355 bool
356 dhcp_msg_get_uint8(const struct dhcp_msg *msg, int code,
357                    size_t offset, uint8_t *out)
358 {
359     const uint8_t *uint8 = dhcp_msg_get(msg, code, offset, sizeof *uint8);
360     if (uint8) {
361         *out = *uint8;
362         return true;
363     } else {
364         return false;
365     }
366 }
367
368 /* Stores in '*out' the 16-bit value at offset 'offset' (in 2-byte units) in
369  * the DHCP option in 'msg' represented by 'code' (which must be in the range
370  * 0...DHCP_N_OPTIONS).  The value is converted to native byte order.  Returns
371  * true if successful, false if the option has fewer than '2 * (offset + 1)'
372  * bytes. */
373 bool
374 dhcp_msg_get_uint16(const struct dhcp_msg *msg, int code,
375                     size_t offset, uint16_t *out)
376 {
377     const uint16_t *uint16 = dhcp_msg_get(msg, code, offset * sizeof *uint16,
378                                           sizeof *uint16);
379     if (uint16) {
380         *out = ntohs(*uint16);
381         return true;
382     } else {
383         return false;
384     }
385 }
386
387 /* Appends a string representing 'duration' seconds to 'ds'. */
388 static void
389 put_duration(struct ds *ds, unsigned int duration)
390 {
391     if (duration) {
392         if (duration >= 86400) {
393             ds_put_format(ds, "%ud", duration / 86400);
394             duration %= 86400;
395         }
396         if (duration >= 3600) {
397             ds_put_format(ds, "%uh", duration / 3600);
398             duration %= 3600;
399         }
400         if (duration >= 60) {
401             ds_put_format(ds, "%umin", duration / 60);
402             duration %= 60;
403         }
404         if (duration > 0) {
405             ds_put_format(ds, "%us", duration);
406         }
407     } else {
408         ds_put_cstr(ds, "0s");
409     }
410 }
411
412 /* Appends a string representation of 'opt', which has the given 'code', to
413  * 'ds'. */
414 const char *
415 dhcp_option_to_string(const struct dhcp_option *opt, int code, struct ds *ds)
416 {
417     const struct option_class *class = get_option_class(code);
418     const struct arg_type *type = &types[class->type];
419     size_t offset;
420     const char *cp;
421
422     for (cp = class->name; *cp; cp++) {
423         unsigned char c = *cp;
424         ds_put_char(ds, c == '_' ? '-' : tolower(c));
425     }
426     ds_put_char(ds, '=');
427
428     if (!opt->data || !opt->n) {
429         ds_put_cstr(ds, opt->data ? "empty" : "null");
430         return ds_cstr(ds);
431     }
432
433     if (class->type == DHCP_ARG_STRING) {
434         ds_put_char(ds, '"');
435         ds_put_printable(ds, opt->data, opt->n);
436         ds_put_char(ds, '"');
437         return ds_cstr(ds);
438     }
439     for (offset = 0; offset + type->size <= opt->n; offset += type->size) {
440         const void *p = (const char *) opt->data + offset;
441         const uint8_t *uint8 = p;
442         const uint32_t *uint32 = p;
443         const uint16_t *uint16 = p;
444
445         if (offset && class->type != DHCP_ARG_STRING) {
446             ds_put_cstr(ds, class->type == DHCP_ARG_UINT8 ? ":" : ", ");
447         }
448         switch (class->type) {
449         case DHCP_ARG_FIXED:
450             NOT_REACHED();
451         case DHCP_ARG_IP:
452             ds_put_format(ds, IP_FMT, IP_ARGS(uint32));
453             break;
454         case DHCP_ARG_UINT8:
455             ds_put_format(ds, "%02"PRIx8, *uint8);
456             break;
457         case DHCP_ARG_UINT16:
458             ds_put_format(ds, "%"PRIu16, ntohs(*uint16));
459             break;
460         case DHCP_ARG_UINT32:
461             ds_put_format(ds, "%"PRIu32, ntohl(*uint32));
462             break;
463         case DHCP_ARG_SECS:
464             put_duration(ds, ntohl(*uint32));
465             break;
466         case DHCP_ARG_STRING:
467             NOT_REACHED();
468         case DHCP_ARG_BOOLEAN:
469             if (*uint8 == 0) {
470                 ds_put_cstr(ds, "false");
471             } else if (*uint8 == 1) {
472                 ds_put_cstr(ds, "true");
473             } else {
474                 ds_put_format(ds, "**%"PRIu8"**", *uint8);
475             }
476             break;
477         }
478     }
479     if (offset != opt->n) {
480         if (offset) {
481             ds_put_cstr(ds, ", ");
482         }
483         ds_put_cstr(ds, "**leftovers:");
484         for (; offset < opt->n; offset++) {
485             const void *p = (const char *) opt->data + offset;
486             const uint8_t *uint8 = p;
487             ds_put_format(ds, " %"PRIu8, *uint8);
488         }
489         ds_put_cstr(ds, "**");
490     }
491     return ds_cstr(ds);
492 }
493
494 /* Returns true if 'a' and 'b' have the same content, false otherwise. */
495 bool
496 dhcp_option_equals(const struct dhcp_option *a, const struct dhcp_option *b)
497 {
498     return ((a->data != NULL) == (b->data != NULL)
499             && a->n == b->n
500             && (!a->data || !memcmp(a->data, b->data, a->n)));
501 }
502
503 /* Replaces 'ds' by a string representation of 'msg'.  If 'multiline' is
504  * false, 'ds' receives a single-line representation of 'msg', otherwise a
505  * multiline representation. */
506 const char *
507 dhcp_msg_to_string(const struct dhcp_msg *msg, bool multiline, struct ds *ds)
508 {
509     char separator = multiline ? '\n' : ' ';
510     int code;
511
512     ds_clear(ds);
513     ds_put_format(ds, "op=%s",
514                   (msg->op == DHCP_BOOTREQUEST ? "request"
515                    : msg->op == DHCP_BOOTREPLY ? "reply"
516                    : "error"));
517     ds_put_format(ds, "%ctype=%s", separator, dhcp_type_name(msg->type));
518     ds_put_format(ds, "%cxid=0x%08"PRIx32, separator, msg->xid);
519     ds_put_format(ds, "%csecs=", separator);
520     put_duration(ds, msg->secs);
521     if (msg->flags) {
522         ds_put_format(ds, "%cflags=", separator);
523         if (msg->flags & DHCP_FLAGS_BROADCAST) {
524             ds_put_cstr(ds, "[BROADCAST]");
525         }
526         if (msg->flags & DHCP_FLAGS_MBZ) {
527             ds_put_format(ds, "[0x%04"PRIx16"]", msg->flags & DHCP_FLAGS_MBZ);
528         }
529     }
530     if (msg->ciaddr) {
531         ds_put_format(ds, "%cciaddr="IP_FMT, separator, IP_ARGS(&msg->ciaddr));
532     }
533     if (msg->yiaddr) {
534         ds_put_format(ds, "%cyiaddr="IP_FMT, separator, IP_ARGS(&msg->yiaddr));
535     }
536     if (msg->siaddr) {
537         ds_put_format(ds, "%csiaddr="IP_FMT, separator, IP_ARGS(&msg->siaddr));
538     }
539     if (msg->giaddr) {
540         ds_put_format(ds, "%cgiaddr="IP_FMT, separator, IP_ARGS(&msg->giaddr));
541     }
542     ds_put_format(ds, "%cchaddr="ETH_ADDR_FMT,
543                   separator, ETH_ADDR_ARGS(msg->chaddr));
544
545     for (code = 0; code < DHCP_N_OPTIONS; code++) {
546         const struct dhcp_option *opt = &msg->options[code];
547         if (opt->data) {
548             ds_put_char(ds, separator);
549             dhcp_option_to_string(opt, code, ds);
550         }
551     }
552     if (multiline) {
553         ds_put_char(ds, separator);
554     }
555     return ds_cstr(ds);
556 }
557
558 static void
559 parse_options(struct dhcp_msg *msg, const char *name, void *data, size_t size,
560               int option_offset)
561 {
562     struct ofpbuf b;
563
564     ofpbuf_use_const(&b, data, size);
565     for (;;) {
566         uint8_t *code, *len;
567         void *payload;
568
569         code = ofpbuf_try_pull(&b, 1);
570         if (!code || *code == DHCP_CODE_END) {
571             break;
572         } else if (*code == DHCP_CODE_PAD) {
573             continue;
574         }
575
576         len = ofpbuf_try_pull(&b, 1);
577         if (!len) {
578             VLOG_DBG_RL(&rl, "reached end of %s expecting length byte", name);
579             break;
580         }
581
582         payload = ofpbuf_try_pull(&b, *len);
583         if (!payload) {
584             VLOG_DBG_RL(&rl, "expected %"PRIu8" bytes of option-%"PRIu8" "
585                         "payload with only %zu bytes of %s left",
586                         *len, *code, b.size, name);
587             break;
588         }
589         dhcp_msg_put(msg, *code + option_offset, payload, *len);
590     }
591 }
592
593 static void
594 validate_options(struct dhcp_msg *msg)
595 {
596     int code;
597
598     for (code = 0; code < DHCP_N_OPTIONS; code++) {
599         struct dhcp_option *opt = &msg->options[code];
600         const struct option_class *class = get_option_class(code);
601         struct arg_type *type = &types[class->type];
602         if (opt->data) {
603             size_t n_elems = opt->n / type->size;
604             size_t remainder = opt->n % type->size;
605             bool ok = true;
606             if (remainder) {
607                 VLOG_DBG_RL(&rl, "%s option has %zu %zu-byte %s arguments "
608                             "with %zu bytes left over",
609                             class->name, n_elems, type->size,
610                             type->name, remainder);
611                 ok = false;
612             }
613             if (n_elems < class->min_args || n_elems > class->max_args) {
614                 VLOG_DBG_RL(&rl, "%s option has %zu %zu-byte %s arguments but "
615                             "between %zu and %zu are required",
616                             class->name, n_elems, type->size, type->name,
617                             class->min_args, class->max_args);
618                 ok = false;
619             }
620             if (!ok) {
621                 struct ds ds = DS_EMPTY_INITIALIZER;
622                 VLOG_DBG_RL(&rl, "%s option contains: %s", class->name,
623                             dhcp_option_to_string(opt, code, &ds));
624                 ds_destroy(&ds);
625
626                 opt->n = 0;
627                 opt->data = NULL;
628             }
629         }
630     }
631 }
632
633 /* Attempts to parse 'b' as a DHCP message.  If successful, initializes '*msg'
634  * to the parsed message and returns 0.  Otherwise, returns a positive errno
635  * value and '*msg' is indeterminate. */
636 int
637 dhcp_parse(struct dhcp_msg *msg, const struct ofpbuf *b_)
638 {
639     struct ofpbuf b = *b_;
640     struct dhcp_header *dhcp;
641     uint32_t *cookie;
642     uint8_t type;
643     char *vendor_class;
644
645     dhcp = ofpbuf_try_pull(&b, sizeof *dhcp);
646     if (!dhcp) {
647         VLOG_DBG_RL(&rl, "buffer too small for DHCP header (%zu bytes)",
648                     b.size);
649         goto error;
650     }
651
652     if (dhcp->op != DHCP_BOOTREPLY && dhcp->op != DHCP_BOOTREQUEST) {
653         VLOG_DBG_RL(&rl, "invalid DHCP op (%"PRIu8")", dhcp->op);
654         goto error;
655     }
656     if (dhcp->htype != ARP_HRD_ETHERNET) {
657         VLOG_DBG_RL(&rl, "invalid DHCP htype (%"PRIu8")", dhcp->htype);
658         goto error;
659     }
660     if (dhcp->hlen != ETH_ADDR_LEN) {
661         VLOG_DBG_RL(&rl, "invalid DHCP hlen (%"PRIu8")", dhcp->hlen);
662         goto error;
663     }
664
665     dhcp_msg_init(msg);
666     msg->op = dhcp->op;
667     msg->xid = ntohl(dhcp->xid);
668     msg->secs = ntohs(dhcp->secs);
669     msg->flags = ntohs(dhcp->flags);
670     msg->ciaddr = dhcp->ciaddr;
671     msg->yiaddr = dhcp->yiaddr;
672     msg->siaddr = dhcp->siaddr;
673     msg->giaddr = dhcp->giaddr;
674     memcpy(msg->chaddr, dhcp->chaddr, ETH_ADDR_LEN);
675
676     cookie = ofpbuf_try_pull(&b, sizeof *cookie);
677     if (cookie) {
678         if (ntohl(*cookie) == DHCP_OPTS_COOKIE) {
679             uint8_t overload;
680
681             parse_options(msg, "options", b.data, b.size, 0);
682             if (dhcp_msg_get_uint8(msg, DHCP_CODE_OPTION_OVERLOAD,
683                                    0, &overload)) {
684                 if (overload & 1) {
685                     parse_options(msg, "file", dhcp->file, sizeof dhcp->file,
686                                   0);
687                 }
688                 if (overload & 2) {
689                     parse_options(msg, "sname",
690                                   dhcp->sname, sizeof dhcp->sname, 0);
691                 }
692             }
693         } else {
694             VLOG_DBG_RL(&rl, "bad DHCP options cookie: %08"PRIx32,
695                         ntohl(*cookie));
696         }
697     } else {
698         VLOG_DBG_RL(&rl, "DHCP packet has no options");
699     }
700
701     vendor_class = dhcp_msg_get_string(msg, DHCP_CODE_VENDOR_CLASS);
702     if (vendor_class && !strcmp(vendor_class, "OpenFlow")) {
703         parse_options(msg, "vendor-specific",
704                       msg->options[DHCP_CODE_VENDOR_SPECIFIC].data,
705                       msg->options[DHCP_CODE_VENDOR_SPECIFIC].n,
706                       DHCP_VENDOR_OFS);
707     }
708     free(vendor_class);
709
710     validate_options(msg);
711     if (!dhcp_msg_get_uint8(msg, DHCP_CODE_DHCP_MSG_TYPE, 0, &type)) {
712         VLOG_DBG_RL(&rl, "missing DHCP message type");
713         dhcp_msg_uninit(msg);
714         goto error;
715     }
716     msg->type = type;
717     return 0;
718
719 error:
720     if (VLOG_IS_DBG_ENABLED()) {
721         struct ds ds;
722
723         ds_init(&ds);
724         ds_put_hex_dump(&ds, b_->data, b_->size, 0, true);
725         VLOG_DBG_RL(&rl, "invalid DHCP message dump:\n%s", ds_cstr(&ds));
726
727         ds_clear(&ds);
728         dhcp_msg_to_string(msg, false, &ds);
729         VLOG_DBG_RL(&rl, "partially dissected DHCP message: %s", ds_cstr(&ds));
730
731         ds_destroy(&ds);
732     }
733     return EPROTO;
734 }
735
736 static void
737 put_option_chunk(struct ofpbuf *b, uint8_t code, void *data, size_t n)
738 {
739     uint8_t header[2];
740
741     assert(n < 256);
742     header[0] = code;
743     header[1] = n;
744     ofpbuf_put(b, header, sizeof header);
745     ofpbuf_put(b, data, n);
746 }
747
748 static void
749 put_option(struct ofpbuf *b, uint8_t code, void *data, size_t n)
750 {
751     if (data) {
752         if (n) {
753             /* Divide the data into chunks of 255 bytes or less.  Make
754              * intermediate chunks multiples of 8 bytes in case the
755              * recipient validates a chunk at a time instead of the
756              * concatenated value. */
757             uint8_t *p = data;
758             while (n) {
759                 size_t chunk = n > 255 ? 248 : n;
760                 put_option_chunk(b, code, p, chunk);
761                 p += chunk;
762                 n -= chunk;
763             }
764         } else {
765             /* Option should be present but carry no data. */
766             put_option_chunk(b, code, NULL, 0);
767         }
768     }
769 }
770
771 /* Appends to 'b' the DHCP message represented by 'msg'. */
772 void
773 dhcp_assemble(const struct dhcp_msg *msg, struct ofpbuf *b)
774 {
775     const uint8_t end = DHCP_CODE_END;
776     uint32_t cookie = htonl(DHCP_OPTS_COOKIE);
777     struct ofpbuf vnd_data;
778     struct dhcp_header dhcp;
779     int i;
780
781     memset(&dhcp, 0, sizeof dhcp);
782     dhcp.op = msg->op;
783     dhcp.htype = ARP_HRD_ETHERNET;
784     dhcp.hlen = ETH_ADDR_LEN;
785     dhcp.hops = 0;
786     dhcp.xid = htonl(msg->xid);
787     dhcp.secs = htons(msg->secs);
788     dhcp.flags = htons(msg->flags);
789     dhcp.ciaddr = msg->ciaddr;
790     dhcp.yiaddr = msg->yiaddr;
791     dhcp.siaddr = msg->siaddr;
792     dhcp.giaddr = msg->giaddr;
793     memcpy(dhcp.chaddr, msg->chaddr, ETH_ADDR_LEN);
794     ofpbuf_put(b, &dhcp, sizeof dhcp);
795     ofpbuf_put(b, &cookie, sizeof cookie);
796
797     /* Put DHCP message type first.  (The ordering is not required but it
798      * seems polite.) */
799     if (msg->type) {
800         uint8_t type = msg->type;
801         put_option(b, DHCP_CODE_DHCP_MSG_TYPE, &type, 1);
802     }
803
804     /* Put the standard options. */
805     for (i = 0; i < DHCP_VENDOR_OFS; i++) {
806         const struct dhcp_option *option = &msg->options[i];
807         put_option(b, i, option->data, option->n);
808     }
809
810     /* Assemble vendor specific option and put it. */
811     ofpbuf_init(&vnd_data, 0);
812     for (i = DHCP_VENDOR_OFS; i < DHCP_N_OPTIONS; i++) {
813         const struct dhcp_option *option = &msg->options[i];
814         put_option(&vnd_data, i - DHCP_VENDOR_OFS, option->data, option->n);
815     }
816     if (vnd_data.size) {
817         put_option(b, DHCP_CODE_VENDOR_SPECIFIC, vnd_data.data, vnd_data.size);
818     }
819     ofpbuf_uninit(&vnd_data);
820
821     /* Put end-of-options option. */
822     ofpbuf_put(b, &end, sizeof end);
823 }
824