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