]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/nfs/bootp_subr.c
Merge llvm, clang, compiler-rt, libc++, libunwind, lld, lldb and openmp
[FreeBSD/FreeBSD.git] / sys / nfs / bootp_subr.c
1 /*-
2  * SPDX-License-Identifier: BSD-4-Clause
3  *
4  * Copyright (c) 1995 Gordon Ross, Adam Glass
5  * Copyright (c) 1992 Regents of the University of California.
6  * All rights reserved.
7  *
8  * This software was developed by the Computer Systems Engineering group
9  * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
10  * contributed to Berkeley.
11  *
12  * Redistribution and use in source and binary forms, with or without
13  * modification, are permitted provided that the following conditions
14  * are met:
15  * 1. Redistributions of source code must retain the above copyright
16  *    notice, this list of conditions and the following disclaimer.
17  * 2. Redistributions in binary form must reproduce the above copyright
18  *    notice, this list of conditions and the following disclaimer in the
19  *    documentation and/or other materials provided with the distribution.
20  * 3. All advertising materials mentioning features or use of this software
21  *    must display the following acknowledgement:
22  *      This product includes software developed by the University of
23  *      California, Lawrence Berkeley Laboratory and its contributors.
24  * 4. Neither the name of the University nor the names of its contributors
25  *    may be used to endorse or promote products derived from this software
26  *    without specific prior written permission.
27  *
28  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
29  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
30  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
31  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
32  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
33  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
34  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
35  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
36  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
37  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
38  * SUCH DAMAGE.
39  *
40  * based on:
41  *      nfs/krpc_subr.c
42  *      $NetBSD: krpc_subr.c,v 1.10 1995/08/08 20:43:43 gwr Exp $
43  */
44
45 #include <sys/cdefs.h>
46 __FBSDID("$FreeBSD$");
47
48 #include "opt_bootp.h"
49 #include "opt_nfs.h"
50 #include "opt_rootdevname.h"
51
52 #include <sys/param.h>
53 #include <sys/systm.h>
54 #include <sys/endian.h>
55 #include <sys/jail.h>
56 #include <sys/kernel.h>
57 #include <sys/sockio.h>
58 #include <sys/malloc.h>
59 #include <sys/mount.h>
60 #include <sys/mbuf.h>
61 #include <sys/proc.h>
62 #include <sys/reboot.h>
63 #include <sys/socket.h>
64 #include <sys/socketvar.h>
65 #include <sys/sysctl.h>
66 #include <sys/uio.h>
67
68 #include <net/if.h>
69 #include <net/if_var.h>
70 #include <net/route.h>
71 #include <net/route/route_ctl.h>
72
73 #include <netinet/in.h>
74 #include <netinet/in_var.h>
75 #include <net/if_types.h>
76 #include <net/if_dl.h>
77 #include <net/vnet.h>
78
79 #include <nfs/nfsproto.h>
80 #include <nfsclient/nfs.h>
81 #include <nfs/nfsdiskless.h>
82 #include <nfs/krpc.h>
83 #include <nfs/xdr_subs.h>
84
85 #define BOOTP_MIN_LEN           300     /* Minimum size of bootp udp packet */
86
87 #ifndef BOOTP_SETTLE_DELAY
88 #define BOOTP_SETTLE_DELAY 3
89 #endif
90
91 /* 
92  * Wait 10 seconds for interface appearance
93  * USB ethernet adapters might require some time to pop up
94  */
95 #ifndef BOOTP_IFACE_WAIT_TIMEOUT
96 #define BOOTP_IFACE_WAIT_TIMEOUT        10
97 #endif
98
99 /*
100  * What is the longest we will wait before re-sending a request?
101  * Note this is also the frequency of "RPC timeout" messages.
102  * The re-send loop count sup linearly to this maximum, so the
103  * first complaint will happen after (1+2+3+4+5)=15 seconds.
104  */
105 #define MAX_RESEND_DELAY 5      /* seconds */
106
107 /* Definitions from RFC951 */
108 struct bootp_packet {
109         u_int8_t op;
110         u_int8_t htype;
111         u_int8_t hlen;
112         u_int8_t hops;
113         u_int32_t xid;
114         u_int16_t secs;
115         u_int16_t flags;
116         struct in_addr ciaddr;
117         struct in_addr yiaddr;
118         struct in_addr siaddr;
119         struct in_addr giaddr;
120         unsigned char chaddr[16];
121         char sname[64];
122         char file[128];
123         unsigned char vend[1222];
124 };
125
126 struct bootpc_ifcontext {
127         STAILQ_ENTRY(bootpc_ifcontext) next;
128         struct bootp_packet call;
129         struct bootp_packet reply;
130         int replylen;
131         int overload;
132         union {
133                 struct ifreq _ifreq;
134                 struct in_aliasreq _in_alias_req;
135         } _req;
136 #define ireq    _req._ifreq
137 #define iareq   _req._in_alias_req
138         struct ifnet *ifp;
139         struct sockaddr_dl *sdl;
140         struct sockaddr_in myaddr;
141         struct sockaddr_in netmask;
142         struct sockaddr_in gw;
143         int gotgw;
144         int gotnetmask;
145         int gotrootpath;
146         int outstanding;
147         int sentmsg;
148         u_int32_t xid;
149         enum {
150                 IF_BOOTP_UNRESOLVED,
151                 IF_BOOTP_RESOLVED,
152                 IF_BOOTP_FAILED,
153                 IF_DHCP_UNRESOLVED,
154                 IF_DHCP_OFFERED,
155                 IF_DHCP_RESOLVED,
156                 IF_DHCP_FAILED,
157         } state;
158         int dhcpquerytype;              /* dhcp type sent */
159         struct in_addr dhcpserver;
160         int gotdhcpserver;
161         uint16_t mtu;
162 };
163
164 #define TAG_MAXLEN 1024
165 struct bootpc_tagcontext {
166         char buf[TAG_MAXLEN + 1];
167         int overload;
168         int badopt;
169         int badtag;
170         int foundopt;
171         int taglen;
172 };
173
174 struct bootpc_globalcontext {
175         STAILQ_HEAD(, bootpc_ifcontext) interfaces;
176         u_int32_t xid;
177         int any_root_overrides;
178         int gotrootpath;
179         int gotgw;
180         int ifnum;
181         int secs;
182         int starttime;
183         struct bootp_packet reply;
184         int replylen;
185         struct bootpc_ifcontext *setrootfs;
186         struct bootpc_ifcontext *sethostname;
187         struct bootpc_tagcontext tmptag;
188         struct bootpc_tagcontext tag;
189 };
190
191 #define IPPORT_BOOTPC 68
192 #define IPPORT_BOOTPS 67
193
194 #define BOOTP_REQUEST 1
195 #define BOOTP_REPLY 2
196
197 /* Common tags */
198 #define TAG_PAD           0  /* Pad option, implicit length 1 */
199 #define TAG_SUBNETMASK    1  /* RFC 950 subnet mask */
200 #define TAG_ROUTERS       3  /* Routers (in order of preference) */
201 #define TAG_HOSTNAME     12  /* Client host name */
202 #define TAG_ROOT         17  /* Root path */
203 #define TAG_INTF_MTU     26  /* Interface MTU Size (RFC2132) */
204
205 /* DHCP specific tags */
206 #define TAG_OVERLOAD     52  /* Option Overload */
207 #define TAG_MAXMSGSIZE   57  /* Maximum DHCP Message Size */
208
209 #define TAG_END         255  /* End Option (i.e. no more options) */
210
211 /* Overload values */
212 #define OVERLOAD_FILE     1
213 #define OVERLOAD_SNAME    2
214
215 /* Site specific tags: */
216 #define TAG_ROOTOPTS    130
217 #define TAG_COOKIE      134     /* ascii info for userland, via sysctl */
218
219 #define TAG_DHCP_MSGTYPE 53
220 #define TAG_DHCP_REQ_ADDR 50
221 #define TAG_DHCP_SERVERID 54
222 #define TAG_DHCP_LEASETIME 51
223
224 #define TAG_VENDOR_INDENTIFIER 60
225
226 #define DHCP_NOMSG    0
227 #define DHCP_DISCOVER 1
228 #define DHCP_OFFER    2
229 #define DHCP_REQUEST  3
230 #define DHCP_ACK      5
231
232 /* NFS read/write block size */
233 #ifndef BOOTP_BLOCKSIZE
234 #define BOOTP_BLOCKSIZE 8192
235 #endif
236
237 static char bootp_cookie[128];
238 static struct socket *bootp_so;
239 SYSCTL_STRING(_kern, OID_AUTO, bootp_cookie, CTLFLAG_RD,
240         bootp_cookie, 0, "Cookie (T134) supplied by bootp server");
241
242 /* mountd RPC */
243 static int      md_mount(struct sockaddr_in *mdsin, char *path, u_char *fhp,
244                     int *fhsizep, struct nfs_args *args, struct thread *td);
245 static int      setfs(struct sockaddr_in *addr, char *path, char *p,
246                     const struct in_addr *siaddr);
247 static int      getdec(char **ptr);
248 static int      getip(char **ptr, struct in_addr *ip);
249 static void     mountopts(struct nfs_args *args, char *p);
250 static int      xdr_opaque_decode(struct mbuf **ptr, u_char *buf, int len);
251 static int      xdr_int_decode(struct mbuf **ptr, int *iptr);
252 static void     print_in_addr(struct in_addr addr);
253 static void     print_sin_addr(struct sockaddr_in *addr);
254 static void     clear_sinaddr(struct sockaddr_in *sin);
255 static void     allocifctx(struct bootpc_globalcontext *gctx);
256 static void     bootpc_compose_query(struct bootpc_ifcontext *ifctx,
257                     struct thread *td);
258 static unsigned char *bootpc_tag(struct bootpc_tagcontext *tctx,
259                     struct bootp_packet *bp, int len, int tag);
260 static void bootpc_tag_helper(struct bootpc_tagcontext *tctx,
261                     unsigned char *start, int len, int tag);
262
263 #ifdef BOOTP_DEBUG
264 void bootpboot_p_if(struct ifnet *ifp, struct ifaddr *ifa);
265 void bootpboot_p_iflist(void);
266 #endif
267
268 static int      bootpc_call(struct bootpc_globalcontext *gctx,
269                     struct thread *td);
270
271 static void     bootpc_fakeup_interface(struct bootpc_ifcontext *ifctx,
272                     struct thread *td);
273
274 static void     bootpc_adjust_interface(struct bootpc_ifcontext *ifctx,
275                     struct bootpc_globalcontext *gctx, struct thread *td);
276
277 static void     bootpc_decode_reply(struct nfsv3_diskless *nd,
278                     struct bootpc_ifcontext *ifctx,
279                     struct bootpc_globalcontext *gctx);
280
281 static int      bootpc_received(struct bootpc_globalcontext *gctx,
282                     struct bootpc_ifcontext *ifctx);
283
284 static __inline int bootpc_ifctx_isresolved(struct bootpc_ifcontext *ifctx);
285 static __inline int bootpc_ifctx_isunresolved(struct bootpc_ifcontext *ifctx);
286 static __inline int bootpc_ifctx_isfailed(struct bootpc_ifcontext *ifctx);
287
288 /*
289  * In order to have multiple active interfaces with address 0.0.0.0
290  * and be able to send data to a selected interface, we first set
291  * mask to /8 on all interfaces, and temporarily set it to /0 when
292  * doing sosend().
293  */
294
295 #ifdef BOOTP_DEBUG
296 void
297 bootpboot_p_if(struct ifnet *ifp, struct ifaddr *ifa)
298 {
299
300         printf("%s flags %x, addr ",
301                ifp->if_xname, ifp->if_flags);
302         print_sin_addr((struct sockaddr_in *) ifa->ifa_addr);
303         printf(", broadcast ");
304         print_sin_addr((struct sockaddr_in *) ifa->ifa_dstaddr);
305         printf(", netmask ");
306         print_sin_addr((struct sockaddr_in *) ifa->ifa_netmask);
307         printf("\n");
308 }
309
310 void
311 bootpboot_p_iflist(void)
312 {
313         struct ifnet *ifp;
314         struct ifaddr *ifa;
315
316         printf("Interface list:\n");
317         IFNET_RLOCK();
318         for (ifp = CK_STAILQ_FIRST(&V_ifnet);
319              ifp != NULL;
320              ifp = CK_STAILQ_NEXT(ifp, if_link)) {
321                 for (ifa = CK_STAILQ_FIRST(&ifp->if_addrhead);
322                      ifa != NULL;
323                      ifa = CK_STAILQ_NEXT(ifa, ifa_link))
324                         if (ifa->ifa_addr->sa_family == AF_INET)
325                                 bootpboot_p_if(ifp, ifa);
326         }
327         IFNET_RUNLOCK();
328 }
329 #endif /* defined(BOOTP_DEBUG) */
330
331 static void
332 clear_sinaddr(struct sockaddr_in *sin)
333 {
334
335         bzero(sin, sizeof(*sin));
336         sin->sin_len = sizeof(*sin);
337         sin->sin_family = AF_INET;
338         sin->sin_addr.s_addr = INADDR_ANY; /* XXX: htonl(INAADDR_ANY) ? */
339         sin->sin_port = 0;
340 }
341
342 static void
343 allocifctx(struct bootpc_globalcontext *gctx)
344 {
345         struct bootpc_ifcontext *ifctx;
346
347         ifctx = malloc(sizeof(*ifctx), M_TEMP, M_WAITOK | M_ZERO);
348         ifctx->xid = gctx->xid;
349 #ifdef BOOTP_NO_DHCP
350         ifctx->state = IF_BOOTP_UNRESOLVED;
351 #else
352         ifctx->state = IF_DHCP_UNRESOLVED;
353 #endif
354         gctx->xid += 0x100;
355         STAILQ_INSERT_TAIL(&gctx->interfaces, ifctx, next);
356 }
357
358 static __inline int
359 bootpc_ifctx_isresolved(struct bootpc_ifcontext *ifctx)
360 {
361
362         if (ifctx->state == IF_BOOTP_RESOLVED ||
363             ifctx->state == IF_DHCP_RESOLVED)
364                 return 1;
365         return 0;
366 }
367
368 static __inline int
369 bootpc_ifctx_isunresolved(struct bootpc_ifcontext *ifctx)
370 {
371
372         if (ifctx->state == IF_BOOTP_UNRESOLVED ||
373             ifctx->state == IF_DHCP_UNRESOLVED)
374                 return 1;
375         return 0;
376 }
377
378 static __inline int
379 bootpc_ifctx_isfailed(struct bootpc_ifcontext *ifctx)
380 {
381
382         if (ifctx->state == IF_BOOTP_FAILED ||
383             ifctx->state == IF_DHCP_FAILED)
384                 return 1;
385         return 0;
386 }
387
388 static int
389 bootpc_received(struct bootpc_globalcontext *gctx,
390     struct bootpc_ifcontext *ifctx)
391 {
392         unsigned char dhcpreplytype;
393         char *p;
394
395         /*
396          * Need timeout for fallback to less
397          * desirable alternative.
398          */
399
400         /* This call used for the side effect (badopt flag) */
401         (void) bootpc_tag(&gctx->tmptag, &gctx->reply,
402                           gctx->replylen,
403                           TAG_END);
404
405         /* If packet is invalid, ignore it */
406         if (gctx->tmptag.badopt != 0)
407                 return 0;
408
409         p = bootpc_tag(&gctx->tmptag, &gctx->reply,
410                        gctx->replylen, TAG_DHCP_MSGTYPE);
411         if (p != NULL)
412                 dhcpreplytype = *p;
413         else
414                 dhcpreplytype = DHCP_NOMSG;
415
416         switch (ifctx->dhcpquerytype) {
417         case DHCP_DISCOVER:
418                 if (dhcpreplytype != DHCP_OFFER         /* Normal DHCP offer */
419 #ifndef BOOTP_FORCE_DHCP
420                     && dhcpreplytype != DHCP_NOMSG      /* Fallback to BOOTP */
421 #endif
422                         )
423                         return 0;
424                 break;
425         case DHCP_REQUEST:
426                 if (dhcpreplytype != DHCP_ACK)
427                         return 0;
428         case DHCP_NOMSG:
429                 break;
430         }
431
432         /* Ignore packet unless it gives us a root tag we didn't have */
433
434         if ((ifctx->state == IF_BOOTP_RESOLVED ||
435              (ifctx->dhcpquerytype == DHCP_DISCOVER &&
436               (ifctx->state == IF_DHCP_OFFERED ||
437                ifctx->state == IF_DHCP_RESOLVED))) &&
438             (bootpc_tag(&gctx->tmptag, &ifctx->reply,
439                         ifctx->replylen,
440                         TAG_ROOT) != NULL ||
441              bootpc_tag(&gctx->tmptag, &gctx->reply,
442                         gctx->replylen,
443                         TAG_ROOT) == NULL))
444                 return 0;
445
446         bcopy(&gctx->reply, &ifctx->reply, gctx->replylen);
447         ifctx->replylen = gctx->replylen;
448
449         /* XXX: Only reset if 'perfect' response */
450         if (ifctx->state == IF_BOOTP_UNRESOLVED)
451                 ifctx->state = IF_BOOTP_RESOLVED;
452         else if (ifctx->state == IF_DHCP_UNRESOLVED &&
453                  ifctx->dhcpquerytype == DHCP_DISCOVER) {
454                 if (dhcpreplytype == DHCP_OFFER)
455                         ifctx->state = IF_DHCP_OFFERED;
456                 else
457                         ifctx->state = IF_BOOTP_RESOLVED;       /* Fallback */
458         } else if (ifctx->state == IF_DHCP_OFFERED &&
459                    ifctx->dhcpquerytype == DHCP_REQUEST)
460                 ifctx->state = IF_DHCP_RESOLVED;
461
462
463         if (ifctx->dhcpquerytype == DHCP_DISCOVER &&
464             ifctx->state != IF_BOOTP_RESOLVED) {
465                 p = bootpc_tag(&gctx->tmptag, &ifctx->reply,
466                                ifctx->replylen, TAG_DHCP_SERVERID);
467                 if (p != NULL && gctx->tmptag.taglen == 4) {
468                         memcpy(&ifctx->dhcpserver, p, 4);
469                         ifctx->gotdhcpserver = 1;
470                 } else
471                         ifctx->gotdhcpserver = 0;
472                 return 1;
473         }
474
475         ifctx->gotrootpath = (bootpc_tag(&gctx->tmptag, &ifctx->reply,
476                                          ifctx->replylen,
477                                          TAG_ROOT) != NULL);
478         ifctx->gotgw = (bootpc_tag(&gctx->tmptag, &ifctx->reply,
479                                    ifctx->replylen,
480                                    TAG_ROUTERS) != NULL);
481         ifctx->gotnetmask = (bootpc_tag(&gctx->tmptag, &ifctx->reply,
482                                         ifctx->replylen,
483                                         TAG_SUBNETMASK) != NULL);
484         return 1;
485 }
486
487 static int
488 bootpc_call(struct bootpc_globalcontext *gctx, struct thread *td)
489 {
490         struct sockaddr_in *sin, dst;
491         struct uio auio;
492         struct sockopt sopt;
493         struct iovec aio;
494         int error, on, rcvflg, timo, len;
495         time_t atimo;
496         time_t rtimo;
497         struct timeval tv;
498         struct bootpc_ifcontext *ifctx;
499         int outstanding;
500         int gotrootpath;
501         int retry;
502         const char *s;
503
504         tv.tv_sec = 1;
505         tv.tv_usec = 0;
506         bzero(&sopt, sizeof(sopt));
507         sopt.sopt_dir = SOPT_SET;
508         sopt.sopt_level = SOL_SOCKET;
509         sopt.sopt_name = SO_RCVTIMEO;
510         sopt.sopt_val = &tv;
511         sopt.sopt_valsize = sizeof tv;
512
513         error = sosetopt(bootp_so, &sopt);
514         if (error != 0)
515                 goto out;
516
517         /*
518          * Enable broadcast.
519          */
520         on = 1;
521         sopt.sopt_name = SO_BROADCAST;
522         sopt.sopt_val = &on;
523         sopt.sopt_valsize = sizeof on;
524
525         error = sosetopt(bootp_so, &sopt);
526         if (error != 0)
527                 goto out;
528
529         /*
530          * Disable routing.
531          */
532
533         on = 1;
534         sopt.sopt_name = SO_DONTROUTE;
535         sopt.sopt_val = &on;
536         sopt.sopt_valsize = sizeof on;
537
538         error = sosetopt(bootp_so, &sopt);
539         if (error != 0)
540                 goto out;
541
542         /*
543          * Bind the local endpoint to a bootp client port.
544          */
545         sin = &dst;
546         clear_sinaddr(sin);
547         sin->sin_port = htons(IPPORT_BOOTPC);
548         error = sobind(bootp_so, (struct sockaddr *)sin, td);
549         if (error != 0) {
550                 printf("bind failed\n");
551                 goto out;
552         }
553
554         /*
555          * Setup socket address for the server.
556          */
557         sin = &dst;
558         clear_sinaddr(sin);
559         sin->sin_addr.s_addr = INADDR_BROADCAST;
560         sin->sin_port = htons(IPPORT_BOOTPS);
561
562         /*
563          * Send it, repeatedly, until a reply is received,
564          * but delay each re-send by an increasing amount.
565          * If the delay hits the maximum, start complaining.
566          */
567         timo = 0;
568         rtimo = 0;
569         for (;;) {
570
571                 outstanding = 0;
572                 gotrootpath = 0;
573
574                 STAILQ_FOREACH(ifctx, &gctx->interfaces, next) {
575                         if (bootpc_ifctx_isresolved(ifctx) != 0 &&
576                             bootpc_tag(&gctx->tmptag, &ifctx->reply,
577                                        ifctx->replylen,
578                                        TAG_ROOT) != NULL)
579                                 gotrootpath = 1;
580                 }
581
582                 STAILQ_FOREACH(ifctx, &gctx->interfaces, next) {
583                         struct in_aliasreq *ifra = &ifctx->iareq;
584                         sin = (struct sockaddr_in *)&ifra->ifra_mask;
585
586                         ifctx->outstanding = 0;
587                         if (bootpc_ifctx_isresolved(ifctx)  != 0 &&
588                             gotrootpath != 0) {
589                                 continue;
590                         }
591                         if (bootpc_ifctx_isfailed(ifctx) != 0)
592                                 continue;
593
594                         outstanding++;
595                         ifctx->outstanding = 1;
596
597                         /* Proceed to next step in DHCP negotiation */
598                         if ((ifctx->state == IF_DHCP_OFFERED &&
599                              ifctx->dhcpquerytype != DHCP_REQUEST) ||
600                             (ifctx->state == IF_DHCP_UNRESOLVED &&
601                              ifctx->dhcpquerytype != DHCP_DISCOVER) ||
602                             (ifctx->state == IF_BOOTP_UNRESOLVED &&
603                              ifctx->dhcpquerytype != DHCP_NOMSG)) {
604                                 ifctx->sentmsg = 0;
605                                 bootpc_compose_query(ifctx, td);
606                         }
607
608                         /* Send BOOTP request (or re-send). */
609
610                         if (ifctx->sentmsg == 0) {
611                                 switch(ifctx->dhcpquerytype) {
612                                 case DHCP_DISCOVER:
613                                         s = "DHCP Discover";
614                                         break;
615                                 case DHCP_REQUEST:
616                                         s = "DHCP Request";
617                                         break;
618                                 case DHCP_NOMSG:
619                                 default:
620                                         s = "BOOTP Query";
621                                         break;
622                                 }
623                                 printf("Sending %s packet from "
624                                        "interface %s (%*D)\n",
625                                        s,
626                                        ifctx->ireq.ifr_name,
627                                        ifctx->sdl->sdl_alen,
628                                        (unsigned char *) LLADDR(ifctx->sdl),
629                                        ":");
630                                 ifctx->sentmsg = 1;
631                         }
632
633                         aio.iov_base = (caddr_t) &ifctx->call;
634                         aio.iov_len = sizeof(ifctx->call);
635
636                         auio.uio_iov = &aio;
637                         auio.uio_iovcnt = 1;
638                         auio.uio_segflg = UIO_SYSSPACE;
639                         auio.uio_rw = UIO_WRITE;
640                         auio.uio_offset = 0;
641                         auio.uio_resid = sizeof(ifctx->call);
642                         auio.uio_td = td;
643
644                         /* Set netmask to 0.0.0.0 */
645                         clear_sinaddr(sin);
646                         error = ifioctl(bootp_so, SIOCAIFADDR, (caddr_t)ifra,
647                             td);
648                         if (error != 0)
649                                 panic("%s: SIOCAIFADDR, error=%d", __func__,
650                                     error);
651
652                         error = sosend(bootp_so, (struct sockaddr *) &dst,
653                                        &auio, NULL, NULL, 0, td);
654                         if (error != 0)
655                                 printf("%s: sosend: %d state %08x\n", __func__,
656                                     error, (int )bootp_so->so_state);
657
658                         /* Set netmask to 255.0.0.0 */
659                         sin->sin_addr.s_addr = htonl(IN_CLASSA_NET);
660                         error = ifioctl(bootp_so, SIOCAIFADDR, (caddr_t)ifra,
661                             td);
662                         if (error != 0)
663                                 panic("%s: SIOCAIFADDR, error=%d", __func__,
664                                     error);
665                 }
666
667                 if (outstanding == 0 &&
668                     (rtimo == 0 || time_second >= rtimo)) {
669                         error = 0;
670                         goto out;
671                 }
672
673                 /* Determine new timeout. */
674                 if (timo < MAX_RESEND_DELAY)
675                         timo++;
676                 else {
677                         printf("DHCP/BOOTP timeout for server ");
678                         print_sin_addr(&dst);
679                         printf("\n");
680                 }
681
682                 /*
683                  * Wait for up to timo seconds for a reply.
684                  * The socket receive timeout was set to 1 second.
685                  */
686                 atimo = timo + time_second;
687                 while (time_second < atimo) {
688                         aio.iov_base = (caddr_t) &gctx->reply;
689                         aio.iov_len = sizeof(gctx->reply);
690
691                         auio.uio_iov = &aio;
692                         auio.uio_iovcnt = 1;
693                         auio.uio_segflg = UIO_SYSSPACE;
694                         auio.uio_rw = UIO_READ;
695                         auio.uio_offset = 0;
696                         auio.uio_resid = sizeof(gctx->reply);
697                         auio.uio_td = td;
698
699                         rcvflg = 0;
700                         error = soreceive(bootp_so, NULL, &auio,
701                                           NULL, NULL, &rcvflg);
702                         gctx->secs = time_second - gctx->starttime;
703                         STAILQ_FOREACH(ifctx, &gctx->interfaces, next) {
704                                 if (bootpc_ifctx_isresolved(ifctx) != 0 ||
705                                     bootpc_ifctx_isfailed(ifctx) != 0)
706                                         continue;
707
708                                 ifctx->call.secs = htons(gctx->secs);
709                         }
710                         if (error == EWOULDBLOCK)
711                                 continue;
712                         if (error != 0)
713                                 goto out;
714                         len = sizeof(gctx->reply) - auio.uio_resid;
715
716                         /* Do we have the required number of bytes ? */
717                         if (len < BOOTP_MIN_LEN)
718                                 continue;
719                         gctx->replylen = len;
720
721                         /* Is it a reply? */
722                         if (gctx->reply.op != BOOTP_REPLY)
723                                 continue;
724
725                         /* Is this an answer to our query */
726                         STAILQ_FOREACH(ifctx, &gctx->interfaces, next) {
727                                 if (gctx->reply.xid != ifctx->call.xid)
728                                         continue;
729
730                                 /* Same HW address size ? */
731                                 if (gctx->reply.hlen != ifctx->call.hlen)
732                                         continue;
733
734                                 /* Correct HW address ? */
735                                 if (bcmp(gctx->reply.chaddr,
736                                          ifctx->call.chaddr,
737                                          ifctx->call.hlen) != 0)
738                                         continue;
739
740                                 break;
741                         }
742
743                         if (ifctx != NULL) {
744                                 s =  bootpc_tag(&gctx->tmptag,
745                                                 &gctx->reply,
746                                                 gctx->replylen,
747                                                 TAG_DHCP_MSGTYPE);
748                                 if (s != NULL) {
749                                         switch (*s) {
750                                         case DHCP_OFFER:
751                                                 s = "DHCP Offer";
752                                                 break;
753                                         case DHCP_ACK:
754                                                 s = "DHCP Ack";
755                                                 break;
756                                         default:
757                                                 s = "DHCP (unexpected)";
758                                                 break;
759                                         }
760                                 } else
761                                         s = "BOOTP Reply";
762
763                                 printf("Received %s packet"
764                                        " on %s from ",
765                                        s,
766                                        ifctx->ireq.ifr_name);
767                                 print_in_addr(gctx->reply.siaddr);
768                                 if (gctx->reply.giaddr.s_addr !=
769                                     htonl(INADDR_ANY)) {
770                                         printf(" via ");
771                                         print_in_addr(gctx->reply.giaddr);
772                                 }
773                                 if (bootpc_received(gctx, ifctx) != 0) {
774                                         printf(" (accepted)");
775                                         if (ifctx->outstanding) {
776                                                 ifctx->outstanding = 0;
777                                                 outstanding--;
778                                         }
779                                         /* Network settle delay */
780                                         if (outstanding == 0)
781                                                 atimo = time_second +
782                                                         BOOTP_SETTLE_DELAY;
783                                 } else
784                                         printf(" (ignored)");
785                                 if (ifctx->gotrootpath || 
786                                     gctx->any_root_overrides) {
787                                         gotrootpath = 1;
788                                         rtimo = time_second +
789                                                 BOOTP_SETTLE_DELAY;
790                                         if (ifctx->gotrootpath)
791                                                 printf(" (got root path)");
792                                 }
793                                 printf("\n");
794                         }
795                 } /* while secs */
796 #ifdef BOOTP_TIMEOUT
797                 if (gctx->secs > BOOTP_TIMEOUT && BOOTP_TIMEOUT > 0)
798                         break;
799 #endif
800                 /* Force a retry if halfway in DHCP negotiation */
801                 retry = 0;
802                 STAILQ_FOREACH(ifctx, &gctx->interfaces, next)
803                         if (ifctx->state == IF_DHCP_OFFERED) {
804                                 if (ifctx->dhcpquerytype == DHCP_DISCOVER)
805                                         retry = 1;
806                                 else
807                                         ifctx->state = IF_DHCP_UNRESOLVED;
808                         }
809
810                 if (retry != 0)
811                         continue;
812
813                 if (gotrootpath != 0) {
814                         gctx->gotrootpath = gotrootpath;
815                         if (rtimo != 0 && time_second >= rtimo)
816                                 break;
817                 }
818         } /* forever send/receive */
819
820         /*
821          * XXX: These are errors of varying seriousness being silently
822          * ignored
823          */
824
825         STAILQ_FOREACH(ifctx, &gctx->interfaces, next)
826                 if (bootpc_ifctx_isresolved(ifctx) == 0) {
827                         printf("%s timeout for interface %s\n",
828                                ifctx->dhcpquerytype != DHCP_NOMSG ?
829                                "DHCP" : "BOOTP",
830                                ifctx->ireq.ifr_name);
831                 }
832
833         if (gctx->gotrootpath != 0) {
834 #if 0
835                 printf("Got a root path, ignoring remaining timeout\n");
836 #endif
837                 error = 0;
838                 goto out;
839         }
840 #ifndef BOOTP_NFSROOT
841         STAILQ_FOREACH(ifctx, &gctx->interfaces, next)
842                 if (bootpc_ifctx_isresolved(ifctx) != 0) {
843                         error = 0;
844                         goto out;
845                 }
846 #endif
847         error = ETIMEDOUT;
848
849 out:
850         return (error);
851 }
852
853 static void
854 bootpc_fakeup_interface(struct bootpc_ifcontext *ifctx, struct thread *td)
855 {
856         struct ifreq *ifr;
857         struct in_aliasreq *ifra;
858         struct sockaddr_in *sin;
859         int error;
860
861         ifr = &ifctx->ireq;
862         ifra = &ifctx->iareq;
863
864         /*
865          * Bring up the interface.
866          *
867          * Get the old interface flags and or IFF_UP into them; if
868          * IFF_UP set blindly, interface selection can be clobbered.
869          */
870         error = ifioctl(bootp_so, SIOCGIFFLAGS, (caddr_t)ifr, td);
871         if (error != 0)
872                 panic("%s: SIOCGIFFLAGS, error=%d", __func__, error);
873         ifr->ifr_flags |= IFF_UP;
874         error = ifioctl(bootp_so, SIOCSIFFLAGS, (caddr_t)ifr, td);
875         if (error != 0)
876                 panic("%s: SIOCSIFFLAGS, error=%d", __func__, error);
877
878         /*
879          * Do enough of ifconfig(8) so that the chosen interface
880          * can talk to the servers. Set address to 0.0.0.0/8 and
881          * broadcast address to local broadcast.
882          */
883         sin = (struct sockaddr_in *)&ifra->ifra_addr;
884         clear_sinaddr(sin);
885         sin = (struct sockaddr_in *)&ifra->ifra_mask;
886         clear_sinaddr(sin);
887         sin->sin_addr.s_addr = htonl(IN_CLASSA_NET);
888         sin = (struct sockaddr_in *)&ifra->ifra_broadaddr;
889         clear_sinaddr(sin);
890         sin->sin_addr.s_addr = htonl(INADDR_BROADCAST);
891         error = ifioctl(bootp_so, SIOCAIFADDR, (caddr_t)ifra, td);
892         if (error != 0)
893                 panic("%s: SIOCAIFADDR, error=%d", __func__, error);
894 }
895
896 static void
897 bootpc_shutdown_interface(struct bootpc_ifcontext *ifctx, struct thread *td)
898 {
899         struct ifreq *ifr;
900         struct sockaddr_in *sin;
901         int error;
902
903         ifr = &ifctx->ireq;
904
905         printf("Shutdown interface %s\n", ifctx->ireq.ifr_name);
906         error = ifioctl(bootp_so, SIOCGIFFLAGS, (caddr_t)ifr, td);
907         if (error != 0)
908                 panic("%s: SIOCGIFFLAGS, error=%d", __func__, error);
909         ifr->ifr_flags &= ~IFF_UP;
910         error = ifioctl(bootp_so, SIOCSIFFLAGS, (caddr_t)ifr, td);
911         if (error != 0)
912                 panic("%s: SIOCSIFFLAGS, error=%d", __func__, error);
913
914         sin = (struct sockaddr_in *) &ifr->ifr_addr;
915         clear_sinaddr(sin);
916         error = ifioctl(bootp_so, SIOCDIFADDR, (caddr_t) ifr, td);
917         if (error != 0)
918                 panic("%s: SIOCDIFADDR, error=%d", __func__, error);
919 }
920
921 static void
922 bootpc_adjust_interface(struct bootpc_ifcontext *ifctx,
923     struct bootpc_globalcontext *gctx, struct thread *td)
924 {
925         int error;
926         struct sockaddr_in *sin;
927         struct ifreq *ifr;
928         struct in_aliasreq *ifra;
929         struct sockaddr_in *myaddr;
930         struct sockaddr_in *netmask;
931
932         ifr = &ifctx->ireq;
933         ifra = &ifctx->iareq;
934         myaddr = &ifctx->myaddr;
935         netmask = &ifctx->netmask;
936
937         if (bootpc_ifctx_isresolved(ifctx) == 0) {
938                 /* Shutdown interfaces where BOOTP failed */
939                 bootpc_shutdown_interface(ifctx, td);
940                 return;
941         }
942
943         printf("Adjusted interface %s", ifctx->ireq.ifr_name);
944
945         /* Do BOOTP interface options */
946         if (ifctx->mtu != 0) {
947                 printf(" (MTU=%d%s)", ifctx->mtu, 
948                     (ifctx->mtu > 1514) ? "/JUMBO" : "");
949                 ifr->ifr_mtu = ifctx->mtu;
950                 error = ifioctl(bootp_so, SIOCSIFMTU, (caddr_t) ifr, td);
951                 if (error != 0)
952                         panic("%s: SIOCSIFMTU, error=%d", __func__, error);
953         }
954         printf("\n");
955
956         /*
957          * Do enough of ifconfig(8) so that the chosen interface
958          * can talk to the servers.  (just set the address)
959          */
960         sin = (struct sockaddr_in *) &ifr->ifr_addr;
961         clear_sinaddr(sin);
962         error = ifioctl(bootp_so, SIOCDIFADDR, (caddr_t) ifr, td);
963         if (error != 0)
964                 panic("%s: SIOCDIFADDR, error=%d", __func__, error);
965
966         bcopy(myaddr, &ifra->ifra_addr, sizeof(*myaddr));
967         bcopy(netmask, &ifra->ifra_mask, sizeof(*netmask));
968         clear_sinaddr(&ifra->ifra_broadaddr);
969         ifra->ifra_broadaddr.sin_addr.s_addr = myaddr->sin_addr.s_addr |
970             ~netmask->sin_addr.s_addr;
971
972         error = ifioctl(bootp_so, SIOCAIFADDR, (caddr_t)ifra, td);
973         if (error != 0)
974                 panic("%s: SIOCAIFADDR, error=%d", __func__, error);
975 }
976
977 static void
978 bootpc_add_default_route(struct bootpc_ifcontext *ifctx)
979 {
980         int error;
981         struct sockaddr_in defdst;
982         struct sockaddr_in defmask;
983         struct rt_addrinfo info;
984         struct rib_cmd_info rc;
985
986         if (ifctx->gw.sin_addr.s_addr == htonl(INADDR_ANY))
987                 return;
988
989         clear_sinaddr(&defdst);
990         clear_sinaddr(&defmask);
991
992         bzero((caddr_t)&info, sizeof(info));
993         info.rti_flags = RTF_UP | RTF_GATEWAY | RTF_STATIC;
994         info.rti_info[RTAX_DST] = (struct sockaddr *)&defdst;
995         info.rti_info[RTAX_NETMASK] = (struct sockaddr *)&defmask;
996         info.rti_info[RTAX_GATEWAY] = (struct sockaddr *)&ifctx->gw;
997
998         error = rib_action(RT_DEFAULT_FIB, RTM_ADD, &info, &rc);
999
1000         if (error != 0) {
1001                 printf("%s: RTM_ADD, error=%d\n", __func__, error);
1002         }
1003 }
1004
1005 static void
1006 bootpc_remove_default_route(struct bootpc_ifcontext *ifctx)
1007 {
1008         int error;
1009         struct sockaddr_in defdst;
1010         struct sockaddr_in defmask;
1011         struct rt_addrinfo info;
1012         struct rib_cmd_info rc;
1013
1014         if (ifctx->gw.sin_addr.s_addr == htonl(INADDR_ANY))
1015                 return;
1016
1017         clear_sinaddr(&defdst);
1018         clear_sinaddr(&defmask);
1019
1020         bzero((caddr_t)&info, sizeof(info));
1021         info.rti_flags = RTF_UP | RTF_GATEWAY | RTF_STATIC;
1022         info.rti_info[RTAX_DST] = (struct sockaddr *)&defdst;
1023         info.rti_info[RTAX_NETMASK] = (struct sockaddr *)&defmask;
1024         info.rti_info[RTAX_GATEWAY] = (struct sockaddr *)&ifctx->gw;
1025
1026         error = rib_action(RT_DEFAULT_FIB, RTM_DELETE, &info, &rc);
1027         if (error != 0) {
1028                 printf("%s: RTM_DELETE, error=%d\n", __func__, error);
1029         }
1030 }
1031
1032 static int
1033 setfs(struct sockaddr_in *addr, char *path, char *p,
1034     const struct in_addr *siaddr)
1035 {
1036
1037         if (getip(&p, &addr->sin_addr) == 0) {
1038                 if (siaddr != NULL && *p == '/')
1039                         bcopy(siaddr, &addr->sin_addr, sizeof(struct in_addr));
1040                 else
1041                         return 0;
1042         } else {
1043                 if (*p != ':')
1044                         return 0;
1045                 p++;
1046         }
1047                 
1048         addr->sin_len = sizeof(struct sockaddr_in);
1049         addr->sin_family = AF_INET;
1050
1051         strlcpy(path, p, MNAMELEN);
1052         return 1;
1053 }
1054
1055 static int
1056 getip(char **ptr, struct in_addr *addr)
1057 {
1058         char *p;
1059         unsigned int ip;
1060         int val;
1061
1062         p = *ptr;
1063         ip = 0;
1064         if (((val = getdec(&p)) < 0) || (val > 255))
1065                 return 0;
1066         ip = val << 24;
1067         if (*p != '.')
1068                 return 0;
1069         p++;
1070         if (((val = getdec(&p)) < 0) || (val > 255))
1071                 return 0;
1072         ip |= (val << 16);
1073         if (*p != '.')
1074                 return 0;
1075         p++;
1076         if (((val = getdec(&p)) < 0) || (val > 255))
1077                 return 0;
1078         ip |= (val << 8);
1079         if (*p != '.')
1080                 return 0;
1081         p++;
1082         if (((val = getdec(&p)) < 0) || (val > 255))
1083                 return 0;
1084         ip |= val;
1085
1086         addr->s_addr = htonl(ip);
1087         *ptr = p;
1088         return 1;
1089 }
1090
1091 static int
1092 getdec(char **ptr)
1093 {
1094         char *p;
1095         int ret;
1096
1097         p = *ptr;
1098         ret = 0;
1099         if ((*p < '0') || (*p > '9'))
1100                 return -1;
1101         while ((*p >= '0') && (*p <= '9')) {
1102                 ret = ret * 10 + (*p - '0');
1103                 p++;
1104         }
1105         *ptr = p;
1106         return ret;
1107 }
1108
1109 static void
1110 mountopts(struct nfs_args *args, char *p)
1111 {
1112         args->version = NFS_ARGSVERSION;
1113         args->rsize = BOOTP_BLOCKSIZE;
1114         args->wsize = BOOTP_BLOCKSIZE;
1115         args->flags = NFSMNT_RSIZE | NFSMNT_WSIZE | NFSMNT_RESVPORT;
1116         args->sotype = SOCK_DGRAM;
1117         if (p != NULL)
1118                 nfs_parse_options(p, args);
1119 }
1120
1121 static int
1122 xdr_opaque_decode(struct mbuf **mptr, u_char *buf, int len)
1123 {
1124         struct mbuf *m;
1125         int alignedlen;
1126
1127         m = *mptr;
1128         alignedlen = ( len + 3 ) & ~3;
1129
1130         if (m->m_len < alignedlen) {
1131                 m = m_pullup(m, alignedlen);
1132                 if (m == NULL) {
1133                         *mptr = NULL;
1134                         return EBADRPC;
1135                 }
1136         }
1137         bcopy(mtod(m, u_char *), buf, len);
1138         m_adj(m, alignedlen);
1139         *mptr = m;
1140         return 0;
1141 }
1142
1143 static int
1144 xdr_int_decode(struct mbuf **mptr, int *iptr)
1145 {
1146         u_int32_t i;
1147
1148         if (xdr_opaque_decode(mptr, (u_char *) &i, sizeof(u_int32_t)) != 0)
1149                 return EBADRPC;
1150         *iptr = fxdr_unsigned(u_int32_t, i);
1151         return 0;
1152 }
1153
1154 static void
1155 print_sin_addr(struct sockaddr_in *sin)
1156 {
1157
1158         print_in_addr(sin->sin_addr);
1159 }
1160
1161 static void
1162 print_in_addr(struct in_addr addr)
1163 {
1164         unsigned int ip;
1165
1166         ip = ntohl(addr.s_addr);
1167         printf("%d.%d.%d.%d",
1168                ip >> 24, (ip >> 16) & 255, (ip >> 8) & 255, ip & 255);
1169 }
1170
1171 static void
1172 bootpc_compose_query(struct bootpc_ifcontext *ifctx, struct thread *td)
1173 {
1174         unsigned char *vendp;
1175         unsigned char vendor_client[64];
1176         uint32_t leasetime;
1177         uint8_t vendor_client_len;
1178
1179         ifctx->gotrootpath = 0;
1180
1181         bzero((caddr_t) &ifctx->call, sizeof(ifctx->call));
1182
1183         /* bootpc part */
1184         ifctx->call.op = BOOTP_REQUEST;         /* BOOTREQUEST */
1185         ifctx->call.htype = 1;                  /* 10mb ethernet */
1186         ifctx->call.hlen = ifctx->sdl->sdl_alen;/* Hardware address length */
1187         ifctx->call.hops = 0;
1188         if (bootpc_ifctx_isunresolved(ifctx) != 0)
1189                 ifctx->xid++;
1190         ifctx->call.xid = txdr_unsigned(ifctx->xid);
1191         bcopy(LLADDR(ifctx->sdl), &ifctx->call.chaddr, ifctx->sdl->sdl_alen);
1192
1193         vendp = ifctx->call.vend;
1194         *vendp++ = 99;          /* RFC1048 cookie */
1195         *vendp++ = 130;
1196         *vendp++ = 83;
1197         *vendp++ = 99;
1198         *vendp++ = TAG_MAXMSGSIZE;
1199         *vendp++ = 2;
1200         *vendp++ = (sizeof(struct bootp_packet) >> 8) & 255;
1201         *vendp++ = sizeof(struct bootp_packet) & 255;
1202
1203         snprintf(vendor_client, sizeof(vendor_client), "%s:%s:%s",
1204                 ostype, MACHINE, osrelease);
1205         vendor_client_len = strlen(vendor_client);
1206         *vendp++ = TAG_VENDOR_INDENTIFIER;
1207         *vendp++ = vendor_client_len;
1208         memcpy(vendp, vendor_client, vendor_client_len);
1209         vendp += vendor_client_len;
1210         ifctx->dhcpquerytype = DHCP_NOMSG;
1211         switch (ifctx->state) {
1212         case IF_DHCP_UNRESOLVED:
1213                 *vendp++ = TAG_DHCP_MSGTYPE;
1214                 *vendp++ = 1;
1215                 *vendp++ = DHCP_DISCOVER;
1216                 ifctx->dhcpquerytype = DHCP_DISCOVER;
1217                 ifctx->gotdhcpserver = 0;
1218                 break;
1219         case IF_DHCP_OFFERED:
1220                 *vendp++ = TAG_DHCP_MSGTYPE;
1221                 *vendp++ = 1;
1222                 *vendp++ = DHCP_REQUEST;
1223                 ifctx->dhcpquerytype = DHCP_REQUEST;
1224                 *vendp++ = TAG_DHCP_REQ_ADDR;
1225                 *vendp++ = 4;
1226                 memcpy(vendp, &ifctx->reply.yiaddr, 4);
1227                 vendp += 4;
1228                 if (ifctx->gotdhcpserver != 0) {
1229                         *vendp++ = TAG_DHCP_SERVERID;
1230                         *vendp++ = 4;
1231                         memcpy(vendp, &ifctx->dhcpserver, 4);
1232                         vendp += 4;
1233                 }
1234                 *vendp++ = TAG_DHCP_LEASETIME;
1235                 *vendp++ = 4;
1236                 leasetime = htonl(300);
1237                 memcpy(vendp, &leasetime, 4);
1238                 vendp += 4;
1239                 break;
1240         default:
1241                 break;
1242         }
1243         *vendp = TAG_END;
1244
1245         ifctx->call.secs = 0;
1246         ifctx->call.flags = htons(0x8000); /* We need a broadcast answer */
1247 }
1248
1249 static int
1250 bootpc_hascookie(struct bootp_packet *bp)
1251 {
1252
1253         return (bp->vend[0] == 99 && bp->vend[1] == 130 &&
1254                 bp->vend[2] == 83 && bp->vend[3] == 99);
1255 }
1256
1257 static void
1258 bootpc_tag_helper(struct bootpc_tagcontext *tctx,
1259     unsigned char *start, int len, int tag)
1260 {
1261         unsigned char *j;
1262         unsigned char *ej;
1263         unsigned char code;
1264
1265         if (tctx->badtag != 0 || tctx->badopt != 0)
1266                 return;
1267
1268         j = start;
1269         ej = j + len;
1270
1271         while (j < ej) {
1272                 code = *j++;
1273                 if (code == TAG_PAD)
1274                         continue;
1275                 if (code == TAG_END)
1276                         return;
1277                 if (j >= ej || j + *j + 1 > ej) {
1278                         tctx->badopt = 1;
1279                         return;
1280                 }
1281                 len = *j++;
1282                 if (code == tag) {
1283                         if (tctx->taglen + len > TAG_MAXLEN) {
1284                                 tctx->badtag = 1;
1285                                 return;
1286                         }
1287                         tctx->foundopt = 1;
1288                         if (len > 0)
1289                                 memcpy(tctx->buf + tctx->taglen,
1290                                        j, len);
1291                         tctx->taglen += len;
1292                 }
1293                 if (code == TAG_OVERLOAD)
1294                         tctx->overload = *j;
1295
1296                 j += len;
1297         }
1298 }
1299
1300 static unsigned char *
1301 bootpc_tag(struct bootpc_tagcontext *tctx,
1302     struct bootp_packet *bp, int len, int tag)
1303 {
1304         tctx->overload = 0;
1305         tctx->badopt = 0;
1306         tctx->badtag = 0;
1307         tctx->foundopt = 0;
1308         tctx->taglen = 0;
1309
1310         if (bootpc_hascookie(bp) == 0)
1311                 return NULL;
1312
1313         bootpc_tag_helper(tctx, &bp->vend[4],
1314                           (unsigned char *) bp + len - &bp->vend[4], tag);
1315
1316         if ((tctx->overload & OVERLOAD_FILE) != 0)
1317                 bootpc_tag_helper(tctx,
1318                                   (unsigned char *) bp->file,
1319                                   sizeof(bp->file),
1320                                   tag);
1321         if ((tctx->overload & OVERLOAD_SNAME) != 0)
1322                 bootpc_tag_helper(tctx,
1323                                   (unsigned char *) bp->sname,
1324                                   sizeof(bp->sname),
1325                                   tag);
1326
1327         if (tctx->badopt != 0 || tctx->badtag != 0 || tctx->foundopt == 0)
1328                 return NULL;
1329         tctx->buf[tctx->taglen] = '\0';
1330         return tctx->buf;
1331 }
1332
1333 static void
1334 bootpc_decode_reply(struct nfsv3_diskless *nd, struct bootpc_ifcontext *ifctx,
1335     struct bootpc_globalcontext *gctx)
1336 {
1337         char *p, *s;
1338         unsigned int ip;
1339
1340         ifctx->gotgw = 0;
1341         ifctx->gotnetmask = 0;
1342
1343         clear_sinaddr(&ifctx->myaddr);
1344         clear_sinaddr(&ifctx->netmask);
1345         clear_sinaddr(&ifctx->gw);
1346
1347         ifctx->myaddr.sin_addr = ifctx->reply.yiaddr;
1348
1349         ip = ntohl(ifctx->myaddr.sin_addr.s_addr);
1350
1351         printf("%s at ", ifctx->ireq.ifr_name);
1352         print_sin_addr(&ifctx->myaddr);
1353         printf(" server ");
1354         print_in_addr(ifctx->reply.siaddr);
1355
1356         ifctx->gw.sin_addr = ifctx->reply.giaddr;
1357         if (ifctx->reply.giaddr.s_addr != htonl(INADDR_ANY)) {
1358                 printf(" via gateway ");
1359                 print_in_addr(ifctx->reply.giaddr);
1360         }
1361
1362         /* This call used for the side effect (overload flag) */
1363         (void) bootpc_tag(&gctx->tmptag,
1364                           &ifctx->reply, ifctx->replylen, TAG_END);
1365
1366         if ((gctx->tmptag.overload & OVERLOAD_SNAME) == 0)
1367                 if (ifctx->reply.sname[0] != '\0')
1368                         printf(" server name %s", ifctx->reply.sname);
1369         if ((gctx->tmptag.overload & OVERLOAD_FILE) == 0)
1370                 if (ifctx->reply.file[0] != '\0')
1371                         printf(" boot file %s", ifctx->reply.file);
1372
1373         printf("\n");
1374
1375         p = bootpc_tag(&gctx->tag, &ifctx->reply, ifctx->replylen,
1376                        TAG_SUBNETMASK);
1377         if (p != NULL) {
1378                 if (gctx->tag.taglen != 4)
1379                         panic("bootpc: subnet mask len is %d",
1380                               gctx->tag.taglen);
1381                 bcopy(p, &ifctx->netmask.sin_addr, 4);
1382                 ifctx->gotnetmask = 1;
1383                 printf("subnet mask ");
1384                 print_sin_addr(&ifctx->netmask);
1385                 printf(" ");
1386         }
1387
1388         p = bootpc_tag(&gctx->tag, &ifctx->reply, ifctx->replylen,
1389                        TAG_ROUTERS);
1390         if (p != NULL) {
1391                 /* Routers */
1392                 if (gctx->tag.taglen % 4)
1393                         panic("bootpc: Router Len is %d", gctx->tag.taglen);
1394                 if (gctx->tag.taglen > 0) {
1395                         bcopy(p, &ifctx->gw.sin_addr, 4);
1396                         printf("router ");
1397                         print_sin_addr(&ifctx->gw);
1398                         printf(" ");
1399                         ifctx->gotgw = 1;
1400                         gctx->gotgw = 1;
1401                 }
1402         }
1403
1404         /*
1405          * Choose a root filesystem.  If a value is forced in the environment
1406          * and it contains "nfs:", use it unconditionally.  Otherwise, if the
1407          * kernel is compiled with the ROOTDEVNAME option, then use it if:
1408          *  - The server doesn't provide a pathname.
1409          *  - The boothowto flags include RB_DFLTROOT (user said to override
1410          *    the server value).
1411          */
1412         p = NULL;
1413         if ((s = kern_getenv("vfs.root.mountfrom")) != NULL) {
1414                 if ((p = strstr(s, "nfs:")) != NULL)
1415                         p = strdup(p + 4, M_TEMP);
1416                 freeenv(s);
1417         }
1418         if (p == NULL) {
1419                 p = bootpc_tag(&gctx->tag, &ifctx->reply, ifctx->replylen,
1420                        TAG_ROOT);
1421                 if (p != NULL)
1422                         ifctx->gotrootpath = 1;
1423         }
1424 #ifdef ROOTDEVNAME
1425         if ((p == NULL || (boothowto & RB_DFLTROOT) != 0) && 
1426             (p = strstr(ROOTDEVNAME, "nfs:")) != NULL) {
1427                 p += 4;
1428         }
1429 #endif
1430         if (p != NULL) {
1431                 if (gctx->setrootfs != NULL) {
1432                         printf("rootfs %s (ignored) ", p);
1433                 } else  if (setfs(&nd->root_saddr,
1434                                   nd->root_hostnam, p, &ifctx->reply.siaddr)) {
1435                         if (*p == '/') {
1436                                 printf("root_server ");
1437                                 print_sin_addr(&nd->root_saddr);
1438                                 printf(" ");
1439                         }
1440                         printf("rootfs %s ", p);
1441                         gctx->gotrootpath = 1;
1442                         gctx->setrootfs = ifctx;
1443
1444                         p = bootpc_tag(&gctx->tag, &ifctx->reply,
1445                                        ifctx->replylen,
1446                                        TAG_ROOTOPTS);
1447                         if (p != NULL) {
1448                                 mountopts(&nd->root_args, p);
1449                                 printf("rootopts %s ", p);
1450                         }
1451                 } else
1452                         panic("Failed to set rootfs to %s", p);
1453         }
1454
1455         p = bootpc_tag(&gctx->tag, &ifctx->reply, ifctx->replylen,
1456                        TAG_HOSTNAME);
1457         if (p != NULL) {
1458                 if (gctx->tag.taglen >= MAXHOSTNAMELEN)
1459                         panic("bootpc: hostname >= %d bytes",
1460                               MAXHOSTNAMELEN);
1461                 if (gctx->sethostname != NULL) {
1462                         printf("hostname %s (ignored) ", p);
1463                 } else {
1464                         strcpy(nd->my_hostnam, p);
1465                         mtx_lock(&prison0.pr_mtx);
1466                         strcpy(prison0.pr_hostname, p);
1467                         mtx_unlock(&prison0.pr_mtx);
1468                         printf("hostname %s ", p);
1469                         gctx->sethostname = ifctx;
1470                 }
1471         }
1472         p = bootpc_tag(&gctx->tag, &ifctx->reply, ifctx->replylen,
1473                         TAG_COOKIE);
1474         if (p != NULL) {        /* store in a sysctl variable */
1475                 int i, l = sizeof(bootp_cookie) - 1;
1476                 for (i = 0; i < l && p[i] != '\0'; i++)
1477                         bootp_cookie[i] = p[i];
1478                 p[i] = '\0';
1479         }
1480
1481         p = bootpc_tag(&gctx->tag, &ifctx->reply, ifctx->replylen,
1482                        TAG_INTF_MTU);
1483         if (p != NULL) {
1484                 ifctx->mtu = be16dec(p);
1485         }
1486
1487         printf("\n");
1488
1489         if (ifctx->gotnetmask == 0) {
1490                 if (IN_CLASSA(ntohl(ifctx->myaddr.sin_addr.s_addr)))
1491                         ifctx->netmask.sin_addr.s_addr = htonl(IN_CLASSA_NET);
1492                 else if (IN_CLASSB(ntohl(ifctx->myaddr.sin_addr.s_addr)))
1493                         ifctx->netmask.sin_addr.s_addr = htonl(IN_CLASSB_NET);
1494                 else
1495                         ifctx->netmask.sin_addr.s_addr = htonl(IN_CLASSC_NET);
1496         }
1497 }
1498
1499 void
1500 bootpc_init(void)
1501 {
1502         struct bootpc_ifcontext *ifctx;         /* Interface BOOTP contexts */
1503         struct bootpc_globalcontext *gctx;      /* Global BOOTP context */
1504         struct ifnet *ifp;
1505         struct sockaddr_dl *sdl;
1506         struct ifaddr *ifa;
1507         int error;
1508 #ifndef BOOTP_WIRED_TO
1509         int ifcnt;
1510 #endif
1511         struct nfsv3_diskless *nd;
1512         struct thread *td;
1513         int timeout;
1514         int delay;
1515
1516         timeout = BOOTP_IFACE_WAIT_TIMEOUT * hz;
1517         delay = hz / 10;
1518
1519         nd = &nfsv3_diskless;
1520         td = curthread;
1521
1522         /*
1523          * If already filled in, don't touch it here
1524          */
1525         if (nfs_diskless_valid != 0)
1526                 return;
1527
1528         gctx = malloc(sizeof(*gctx), M_TEMP, M_WAITOK | M_ZERO);
1529         STAILQ_INIT(&gctx->interfaces);
1530         gctx->xid = ~0xFFFF;
1531         gctx->starttime = time_second;
1532
1533         /*
1534          * If ROOTDEVNAME is defined or vfs.root.mountfrom is set then we have
1535          * root-path overrides that can potentially let us boot even if we don't
1536          * get a root path from the server, so we can treat that as a non-error.
1537          */
1538 #ifdef ROOTDEVNAME
1539         gctx->any_root_overrides = 1;
1540 #else
1541         gctx->any_root_overrides = testenv("vfs.root.mountfrom");
1542 #endif
1543
1544         /*
1545          * Find a network interface.
1546          */
1547         CURVNET_SET(TD_TO_VNET(td));
1548 #ifdef BOOTP_WIRED_TO
1549         printf("%s: wired to interface '%s'\n", __func__, 
1550                __XSTRING(BOOTP_WIRED_TO));
1551         allocifctx(gctx);
1552 #else
1553         /*
1554          * Preallocate interface context storage, if another interface
1555          * attaches and wins the race, it won't be eligible for bootp.
1556          */
1557         ifcnt = 0;
1558         IFNET_RLOCK();
1559         CK_STAILQ_FOREACH(ifp, &V_ifnet, if_link) {
1560                 if ((ifp->if_flags &
1561                      (IFF_LOOPBACK | IFF_POINTOPOINT | IFF_BROADCAST)) !=
1562                     IFF_BROADCAST)
1563                         continue;
1564                 switch (ifp->if_alloctype) {
1565                         case IFT_ETHER:
1566                                 break;
1567                         default:
1568                                 continue;
1569                 }
1570                 ifcnt++;
1571         }
1572         IFNET_RUNLOCK();
1573         if (ifcnt == 0)
1574                 panic("%s: no eligible interfaces", __func__);
1575         for (; ifcnt > 0; ifcnt--)
1576                 allocifctx(gctx);
1577 #endif
1578
1579 retry:
1580         ifctx = STAILQ_FIRST(&gctx->interfaces);
1581         IFNET_RLOCK();
1582         CK_STAILQ_FOREACH(ifp, &V_ifnet, if_link) {
1583                 if (ifctx == NULL)
1584                         break;
1585 #ifdef BOOTP_WIRED_TO
1586                 if (strcmp(ifp->if_xname, __XSTRING(BOOTP_WIRED_TO)) != 0)
1587                         continue;
1588 #else
1589                 if ((ifp->if_flags &
1590                      (IFF_LOOPBACK | IFF_POINTOPOINT | IFF_BROADCAST)) !=
1591                     IFF_BROADCAST)
1592                         continue;
1593                 switch (ifp->if_alloctype) {
1594                         case IFT_ETHER:
1595                                 break;
1596                         default:
1597                                 continue;
1598                 }
1599 #endif
1600                 strlcpy(ifctx->ireq.ifr_name, ifp->if_xname,
1601                     sizeof(ifctx->ireq.ifr_name));
1602                 ifctx->ifp = ifp;
1603
1604                 /* Get HW address */
1605                 sdl = NULL;
1606                 CK_STAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link)
1607                         if (ifa->ifa_addr->sa_family == AF_LINK) {
1608                                 sdl = (struct sockaddr_dl *)ifa->ifa_addr;
1609                                 if (sdl->sdl_type == IFT_ETHER)
1610                                         break;
1611                         }
1612                 if (sdl == NULL)
1613                         panic("bootpc: Unable to find HW address for %s",
1614                             ifctx->ireq.ifr_name);
1615                 ifctx->sdl = sdl;
1616
1617                 ifctx = STAILQ_NEXT(ifctx, next);
1618         }
1619         IFNET_RUNLOCK();
1620         CURVNET_RESTORE();
1621
1622         if (STAILQ_EMPTY(&gctx->interfaces) ||
1623             STAILQ_FIRST(&gctx->interfaces)->ifp == NULL) {
1624                 if (timeout > 0) {
1625                         pause("bootpc", delay);
1626                         timeout -= delay;
1627                         goto retry;
1628                 }
1629 #ifdef BOOTP_WIRED_TO
1630                 panic("%s: Could not find interface specified "
1631                       "by BOOTP_WIRED_TO: "
1632                       __XSTRING(BOOTP_WIRED_TO), __func__);
1633 #else
1634                 panic("%s: no suitable interface", __func__);
1635 #endif
1636         }
1637
1638         error = socreate(AF_INET, &bootp_so, SOCK_DGRAM, 0, td->td_ucred, td);
1639         if (error != 0)
1640                 panic("%s: socreate, error=%d", __func__, error);
1641
1642         STAILQ_FOREACH(ifctx, &gctx->interfaces, next)
1643                 bootpc_fakeup_interface(ifctx, td);
1644
1645         STAILQ_FOREACH(ifctx, &gctx->interfaces, next)
1646                 bootpc_compose_query(ifctx, td);
1647
1648         error = bootpc_call(gctx, td);
1649         if (error != 0) {
1650                 printf("BOOTP call failed\n");
1651         }
1652
1653         mountopts(&nd->root_args, NULL);
1654
1655         STAILQ_FOREACH(ifctx, &gctx->interfaces, next)
1656                 if (bootpc_ifctx_isresolved(ifctx) != 0)
1657                         bootpc_decode_reply(nd, ifctx, gctx);
1658
1659 #ifdef BOOTP_NFSROOT
1660         if (gctx->gotrootpath == 0 && gctx->any_root_overrides == 0)
1661                 panic("bootpc: No root path offered");
1662 #endif
1663
1664         STAILQ_FOREACH(ifctx, &gctx->interfaces, next)
1665                 bootpc_adjust_interface(ifctx, gctx, td);
1666
1667         soclose(bootp_so);
1668
1669         STAILQ_FOREACH(ifctx, &gctx->interfaces, next)
1670                 if (ifctx->gotrootpath != 0)
1671                         break;
1672         if (ifctx == NULL) {
1673                 STAILQ_FOREACH(ifctx, &gctx->interfaces, next)
1674                         if (bootpc_ifctx_isresolved(ifctx) != 0)
1675                                 break;
1676         }
1677         if (ifctx == NULL)
1678                 goto out;
1679
1680         if (gctx->gotrootpath != 0) {
1681                 struct epoch_tracker et;
1682
1683                 kern_setenv("boot.netif.name", ifctx->ifp->if_xname);
1684
1685                 NET_EPOCH_ENTER(et);
1686                 bootpc_add_default_route(ifctx);
1687                 error = md_mount(&nd->root_saddr, nd->root_hostnam,
1688                                  nd->root_fh, &nd->root_fhsize,
1689                                  &nd->root_args, td);
1690                 bootpc_remove_default_route(ifctx);
1691                 NET_EPOCH_EXIT(et);
1692                 if (error != 0) {
1693                         if (gctx->any_root_overrides == 0)
1694                                 panic("nfs_boot: mount root, error=%d", error);
1695                         else
1696                                 goto out;
1697                 }
1698                 rootdevnames[0] = "nfs:";
1699                 nfs_diskless_valid = 3;
1700         }
1701
1702         strcpy(nd->myif.ifra_name, ifctx->ireq.ifr_name);
1703         bcopy(&ifctx->myaddr, &nd->myif.ifra_addr, sizeof(ifctx->myaddr));
1704         bcopy(&ifctx->myaddr, &nd->myif.ifra_broadaddr, sizeof(ifctx->myaddr));
1705         ((struct sockaddr_in *) &nd->myif.ifra_broadaddr)->sin_addr.s_addr =
1706                 ifctx->myaddr.sin_addr.s_addr |
1707                 ~ ifctx->netmask.sin_addr.s_addr;
1708         bcopy(&ifctx->netmask, &nd->myif.ifra_mask, sizeof(ifctx->netmask));
1709         bcopy(&ifctx->gw, &nd->mygateway, sizeof(ifctx->gw));
1710
1711 out:
1712         while((ifctx = STAILQ_FIRST(&gctx->interfaces)) != NULL) {
1713                 STAILQ_REMOVE_HEAD(&gctx->interfaces, next);
1714                 free(ifctx, M_TEMP);
1715         }
1716         free(gctx, M_TEMP);
1717 }
1718
1719 /*
1720  * RPC: mountd/mount
1721  * Given a server pathname, get an NFS file handle.
1722  * Also, sets sin->sin_port to the NFS service port.
1723  */
1724 static int
1725 md_mount(struct sockaddr_in *mdsin, char *path, u_char *fhp, int *fhsizep,
1726     struct nfs_args *args, struct thread *td)
1727 {
1728         struct mbuf *m;
1729         int error;
1730         int authunixok;
1731         int authcount;
1732         int authver;
1733
1734 #define RPCPROG_MNT     100005
1735 #define RPCMNT_VER1     1
1736 #define RPCMNT_VER3     3
1737 #define RPCMNT_MOUNT    1
1738 #define AUTH_SYS        1               /* unix style (uid, gids) */
1739 #define AUTH_UNIX       AUTH_SYS
1740
1741         /* XXX honor v2/v3 flags in args->flags? */
1742 #ifdef BOOTP_NFSV3
1743         /* First try NFS v3 */
1744         /* Get port number for MOUNTD. */
1745         error = krpc_portmap(mdsin, RPCPROG_MNT, RPCMNT_VER3,
1746                              &mdsin->sin_port, td);
1747         if (error == 0) {
1748                 m = xdr_string_encode(path, strlen(path));
1749
1750                 /* Do RPC to mountd. */
1751                 error = krpc_call(mdsin, RPCPROG_MNT, RPCMNT_VER3,
1752                                   RPCMNT_MOUNT, &m, NULL, td);
1753         }
1754         if (error == 0) {
1755                 args->flags |= NFSMNT_NFSV3;
1756         } else {
1757 #endif
1758                 /* Fallback to NFS v2 */
1759
1760                 /* Get port number for MOUNTD. */
1761                 error = krpc_portmap(mdsin, RPCPROG_MNT, RPCMNT_VER1,
1762                                      &mdsin->sin_port, td);
1763                 if (error != 0)
1764                         return error;
1765
1766                 m = xdr_string_encode(path, strlen(path));
1767
1768                 /* Do RPC to mountd. */
1769                 error = krpc_call(mdsin, RPCPROG_MNT, RPCMNT_VER1,
1770                                   RPCMNT_MOUNT, &m, NULL, td);
1771                 if (error != 0)
1772                         return error;   /* message already freed */
1773
1774 #ifdef BOOTP_NFSV3
1775         }
1776 #endif
1777
1778         if (xdr_int_decode(&m, &error) != 0 || error != 0)
1779                 goto bad;
1780
1781         if ((args->flags & NFSMNT_NFSV3) != 0) {
1782                 if (xdr_int_decode(&m, fhsizep) != 0 ||
1783                     *fhsizep > NFSX_V3FHMAX ||
1784                     *fhsizep <= 0)
1785                         goto bad;
1786         } else
1787                 *fhsizep = NFSX_V2FH;
1788
1789         if (xdr_opaque_decode(&m, fhp, *fhsizep) != 0)
1790                 goto bad;
1791
1792         if (args->flags & NFSMNT_NFSV3) {
1793                 if (xdr_int_decode(&m, &authcount) != 0)
1794                         goto bad;
1795                 authunixok = 0;
1796                 if (authcount < 0 || authcount > 100)
1797                         goto bad;
1798                 while (authcount > 0) {
1799                         if (xdr_int_decode(&m, &authver) != 0)
1800                                 goto bad;
1801                         if (authver == AUTH_UNIX)
1802                                 authunixok = 1;
1803                         authcount--;
1804                 }
1805                 if (authunixok == 0)
1806                         goto bad;
1807         }
1808
1809         /* Set port number for NFS use. */
1810         error = krpc_portmap(mdsin, NFS_PROG,
1811                              (args->flags &
1812                               NFSMNT_NFSV3) ? NFS_VER3 : NFS_VER2,
1813                              &mdsin->sin_port, td);
1814
1815         goto out;
1816
1817 bad:
1818         error = EBADRPC;
1819
1820 out:
1821         m_freem(m);
1822         return error;
1823 }
1824
1825 SYSINIT(bootp_rootconf, SI_SUB_ROOT_CONF, SI_ORDER_FIRST, bootpc_init, NULL);