Rename KMALLOC_* -> MEM_* [2/2]
[akaros.git] / kern / src / net / ipifc.c
1 /* Copyright © 1994-1999 Lucent Technologies Inc.  All rights reserved.
2  * Portions Copyright © 1997-1999 Vita Nuova Limited
3  * Portions Copyright © 2000-2007 Vita Nuova Holdings Limited
4  *                                (www.vitanuova.com)
5  * Revisions Copyright © 2000-2007 Lucent Technologies Inc. and others
6  *
7  * Modified for the Akaros operating system:
8  * Copyright (c) 2013-2014 The Regents of the University of California
9  * Copyright (c) 2013-2015 Google Inc.
10  *
11  * Permission is hereby granted, free of charge, to any person obtaining a copy
12  * of this software and associated documentation files (the "Software"), to deal
13  * in the Software without restriction, including without limitation the rights
14  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
15  * copies of the Software, and to permit persons to whom the Software is
16  * furnished to do so, subject to the following conditions:
17  *
18  * The above copyright notice and this permission notice shall be included in
19  * all copies or substantial portions of the Software.
20  *
21  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
22  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
23  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL THE
24  * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
25  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
26  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
27  * SOFTWARE. */
28
29 #include <vfs.h>
30 #include <kfs.h>
31 #include <slab.h>
32 #include <kmalloc.h>
33 #include <kref.h>
34 #include <string.h>
35 #include <stdio.h>
36 #include <assert.h>
37 #include <error.h>
38 #include <cpio.h>
39 #include <pmap.h>
40 #include <smp.h>
41 #include <ip.h>
42
43 #define DPRINT if(0)print
44
45 enum {
46         Maxmedia = 32,
47         Nself = Maxmedia * 5,
48         NHASH = (1 << 6),
49         NCACHE = 256,
50         QMAX = 64 * 1024 - 1,
51 };
52
53 struct medium *media[Maxmedia] = {
54         0
55 };
56
57 /*
58  *  cache of local addresses (addresses we answer to)
59  */
60 struct Ipself {
61         uint8_t a[IPaddrlen];
62         struct Ipself *hnext;           /* next address in the hash table */
63         struct Iplink *link;            /* binding twixt Ipself and Ipifc */
64         uint32_t expire;
65         uint8_t type;                           /* type of address */
66         int ref;
67         struct Ipself *next;            /* free list */
68 };
69
70 struct Ipselftab {
71         qlock_t qlock;
72         int inited;
73         int acceptall;                          /* true if an interface has the null address */
74         struct Ipself *hash[NHASH];     /* hash chains */
75 };
76
77 /*
78  *  Multicast addresses are chained onto a Chan so that
79  *  we can remove them when the Chan is closed.
80  */
81 typedef struct Ipmcast Ipmcast;
82 struct Ipmcast {
83         Ipmcast *next;
84         uint8_t ma[IPaddrlen];          /* multicast address */
85         uint8_t ia[IPaddrlen];          /* interface address */
86 };
87
88 /* quick hash for ip addresses */
89 #define hashipa(a) ( ( ((a)[IPaddrlen-2]<<8) | (a)[IPaddrlen-1] )%NHASH )
90
91 static char tifc[] = "ifc ";
92
93 static void addselfcache(struct Fs *f, struct Ipifc *ifc, struct Iplifc *lifc,
94                                                  uint8_t * a, int type);
95 static void remselfcache(struct Fs *f,
96                                                  struct Ipifc *ifc, struct Iplifc *lifc, uint8_t * a);
97 static void ipifcjoinmulti(struct Ipifc *ifc, char **argv, int argc);
98 static void ipifcleavemulti(struct Ipifc *ifc, char **argv, int argc);
99 static void ipifcregisterproxy(struct Fs *, struct Ipifc *,
100                                                            uint8_t * unused_uint8_p_t);
101 static void ipifcremlifc(struct Ipifc *, struct Iplifc *);
102 static void ipifcaddpref6(struct Ipifc *ifc, char **argv, int argc);
103
104 /*
105  *  link in a new medium
106  */
107 void addipmedium(struct medium *med)
108 {
109         int i;
110
111         for (i = 0; i < ARRAY_SIZE(media) - 1; i++)
112                 if (media[i] == NULL) {
113                         media[i] = med;
114                         break;
115                 }
116 }
117
118 /*
119  *  find the medium with this name
120  */
121 struct medium *ipfindmedium(char *name)
122 {
123         struct medium **mp;
124
125         for (mp = media; *mp != NULL; mp++)
126                 if (strcmp((*mp)->name, name) == 0)
127                         break;
128         return *mp;
129 }
130
131 /*
132  *  attach a device (or pkt driver) to the interface.
133  *  called with c locked
134  */
135 static void ipifcbind(struct conv *c, char **argv, int argc)
136 {
137         ERRSTACK(1);
138         struct Ipifc *ifc;
139         struct medium *m;
140
141         if (argc < 2)
142                 error(EINVAL, "Too few args (%d) to %s", argc, __func__);
143
144         ifc = (struct Ipifc *)c->ptcl;
145
146         /* bind the device to the interface */
147         m = ipfindmedium(argv[1]);
148         if (m == NULL)
149                 error(EFAIL, "unknown interface type");
150
151         wlock(&ifc->rwlock);
152         if (ifc->m != NULL) {
153                 wunlock(&ifc->rwlock);
154                 error(EFAIL, "interfacr already bound");
155         }
156         if (waserror()) {
157                 wunlock(&ifc->rwlock);
158                 nexterror();
159         }
160
161         /* do medium specific binding */
162         (*m->bind) (ifc, argc, argv);
163
164         /* set the bound device name */
165         if (argc > 2)
166                 strlcpy(ifc->dev, argv[2], sizeof(ifc->dev));
167         else
168                 snprintf(ifc->dev, sizeof(ifc->dev), "%s%d", m->name, c->x);
169
170         /* set up parameters */
171         ifc->m = m;
172         ifc->mintu = ifc->m->mintu;
173         ifc->maxtu = ifc->m->maxtu;
174         if (ifc->m->unbindonclose == 0)
175                 ifc->conv->inuse++;
176         ifc->rp.mflag = 0;      // default not managed
177         ifc->rp.oflag = 0;
178         ifc->rp.maxraint = 600000;      // millisecs
179         ifc->rp.minraint = 200000;
180         ifc->rp.linkmtu = 0;    // no mtu sent
181         ifc->rp.reachtime = 0;
182         ifc->rp.rxmitra = 0;
183         ifc->rp.ttl = MAXTTL;
184         ifc->rp.routerlt = 3 * (ifc->rp.maxraint);
185
186         /* any ancillary structures (like routes) no longer pertain */
187         ifc->ifcid++;
188
189         /* reopen all the queues closed by a previous unbind */
190         qreopen(c->rq);
191         qreopen(c->eq);
192         qreopen(c->sq);
193
194         wunlock(&ifc->rwlock);
195         poperror();
196 }
197
198 /*
199  *  detach a device from an interface, close the interface
200  *  called with ifc->conv closed
201  */
202 static void ipifcunbind(struct Ipifc *ifc)
203 {
204         ERRSTACK(1);
205         char *err;
206
207         wlock(&ifc->rwlock);
208         if (waserror()) {
209                 wunlock(&ifc->rwlock);
210                 nexterror();
211         }
212
213         /* dissociate routes */
214         if (ifc->m != NULL && ifc->m->unbindonclose == 0)
215                 ifc->conv->inuse--;
216         ifc->ifcid++;
217
218         /* disassociate device */
219         if (ifc->m != NULL && ifc->m->unbind)
220                 (*ifc->m->unbind) (ifc);
221         memset(ifc->dev, 0, sizeof(ifc->dev));
222         ifc->arg = NULL;
223         ifc->reassemble = 0;
224
225         /* close queues to stop queuing of packets */
226         qclose(ifc->conv->rq);
227         qclose(ifc->conv->wq);
228         qclose(ifc->conv->sq);
229
230         /* disassociate logical interfaces */
231         while (ifc->lifc)
232                 ipifcremlifc(ifc, ifc->lifc);
233
234         ifc->m = NULL;
235         wunlock(&ifc->rwlock);
236         poperror();
237 }
238
239 char sfixedformat[] =
240         "device %s maxtu %d sendra %d recvra %d mflag %d oflag %d maxraint %d minraint %d linkmtu %d reachtime %d rxmitra %d ttl %d routerlt %d pktin %lu pktout %lu errin %lu errout %lu\n";
241
242 char slineformat[] = "  %-40I %-10M %-40I %-12lu %-12lu\n";
243
244 static int ipifcstate(struct conv *c, char *state, int n)
245 {
246         struct Ipifc *ifc;
247         struct Iplifc *lifc;
248         int m;
249
250         ifc = (struct Ipifc *)c->ptcl;
251
252         m = snprintf(state, n, sfixedformat,
253                                  ifc->dev, ifc->maxtu, ifc->sendra6, ifc->recvra6,
254                                  ifc->rp.mflag, ifc->rp.oflag, ifc->rp.maxraint,
255                                  ifc->rp.minraint, ifc->rp.linkmtu, ifc->rp.reachtime,
256                                  ifc->rp.rxmitra, ifc->rp.ttl, ifc->rp.routerlt,
257                                  ifc->in, ifc->out, ifc->inerr, ifc->outerr);
258
259         rlock(&ifc->rwlock);
260         for (lifc = ifc->lifc; lifc && n > m; lifc = lifc->next)
261                 m += snprintf(state + m, n - m, slineformat,
262                                           lifc->local, lifc->mask, lifc->remote,
263                                           lifc->validlt, lifc->preflt);
264         if (ifc->lifc == NULL)
265                 m += snprintf(state + m, n - m, "\n");
266         runlock(&ifc->rwlock);
267         return m;
268 }
269
270 static int ipifclocal(struct conv *c, char *state, int n)
271 {
272         struct Ipifc *ifc;
273         struct Iplifc *lifc;
274         struct Iplink *link;
275         int m;
276
277         ifc = (struct Ipifc *)c->ptcl;
278
279         m = 0;
280
281         rlock(&ifc->rwlock);
282         for (lifc = ifc->lifc; lifc; lifc = lifc->next) {
283                 m += snprintf(state + m, n - m, "%-40.40I ->", lifc->local);
284                 for (link = lifc->link; link; link = link->lifclink)
285                         m += snprintf(state + m, n - m, " %-40.40I", link->self->a);
286                 m += snprintf(state + m, n - m, "\n");
287         }
288         runlock(&ifc->rwlock);
289         return m;
290 }
291
292 static int ipifcinuse(struct conv *c)
293 {
294         struct Ipifc *ifc;
295
296         ifc = (struct Ipifc *)c->ptcl;
297         return ifc->m != NULL;
298 }
299
300 /*
301  *  called when a process writes to an interface's 'data'
302  */
303 static void ipifckick(void *x)
304 {
305         ERRSTACK(1);
306         struct conv *c = x;
307         struct block *bp;
308         struct Ipifc *ifc;
309
310         bp = qget(c->wq);
311         if (bp == NULL)
312                 return;
313
314         ifc = (struct Ipifc *)c->ptcl;
315         if (!canrlock(&ifc->rwlock)) {
316                 freeb(bp);
317                 return;
318         }
319         if (waserror()) {
320                 runlock(&ifc->rwlock);
321                 nexterror();
322         }
323         if (ifc->m == NULL || ifc->m->pktin == NULL)
324                 freeb(bp);
325         else
326                 (*ifc->m->pktin) (c->p->f, ifc, bp);
327         runlock(&ifc->rwlock);
328         poperror();
329 }
330
331 /*
332  *  called when a new ipifc structure is created
333  */
334 static void ipifccreate(struct conv *c)
335 {
336         struct Ipifc *ifc;
337
338         c->rq = qopen(QMAX, 0, 0, 0);
339         c->sq = qopen(2 * QMAX, 0, 0, 0);
340         c->wq = qopen(QMAX, Qkick, ipifckick, c);
341         ifc = (struct Ipifc *)c->ptcl;
342         ifc->conv = c;
343         ifc->unbinding = 0;
344         ifc->m = NULL;
345         ifc->reassemble = 0;
346 }
347
348 /*
349  *  called after last close of ipifc data or ctl
350  *  called with c locked, we must unlock
351  */
352 static void ipifcclose(struct conv *c)
353 {
354         struct Ipifc *ifc;
355         struct medium *m;
356
357         ifc = (struct Ipifc *)c->ptcl;
358         m = ifc->m;
359         if (m != NULL && m->unbindonclose)
360                 ipifcunbind(ifc);
361 }
362
363 /*
364  *  change an interface's mtu
365  */
366 static void ipifcsetmtu(struct Ipifc *ifc, char **argv, int argc)
367 {
368         int mtu;
369
370         if (argc < 2)
371                 error(EINVAL, "Too few args (%d) to %s", argc, __func__);
372         if (ifc->m == NULL)
373                 error(EFAIL, "No medium on IFC");
374         mtu = strtoul(argv[1], 0, 0);
375         if (mtu < ifc->m->mintu || mtu > ifc->m->maxtu)
376                 error(EFAIL, "Bad MTU size %d (%d, %d)", mtu, ifc->m->mintu,
377                       ifc->m->maxtu);
378         ifc->maxtu = mtu;
379 }
380
381 /*
382  *  add an address to an interface.
383  */
384 static void ipifcadd(struct Ipifc *ifc, char **argv, int argc, int tentative,
385                      struct Iplifc *lifcp)
386 {
387         uint8_t ip[IPaddrlen], mask[IPaddrlen], rem[IPaddrlen];
388         uint8_t bcast[IPaddrlen], net[IPaddrlen];
389         struct Iplifc *lifc, **l;
390         int i, type, mtu;
391         struct Fs *f;
392         int sendnbrdisc = 0;
393
394         if (ifc->m == NULL)
395                 error(EFAIL, "ipifc not yet bound to device");
396
397         f = ifc->conv->p->f;
398
399         type = Rifc;
400         memset(ip, 0, IPaddrlen);
401         memset(mask, 0, IPaddrlen);
402         memset(rem, 0, IPaddrlen);
403         switch (argc) {
404                 case 6:
405                         if (strcmp(argv[5], "proxy") == 0)
406                                 type |= Rproxy;
407                         /* fall through */
408                 case 5:
409                         mtu = strtoul(argv[4], 0, 0);
410                         if (mtu >= ifc->m->mintu && mtu <= ifc->m->maxtu)
411                                 ifc->maxtu = mtu;
412                         /* fall through */
413                 case 4:
414                         parseip(ip, argv[1]);
415                         parseipmask(mask, argv[2]);
416                         parseip(rem, argv[3]);
417                         maskip(rem, mask, net);
418                         break;
419                 case 3:
420                         parseip(ip, argv[1]);
421                         parseipmask(mask, argv[2]);
422                         maskip(ip, mask, rem);
423                         maskip(rem, mask, net);
424                         break;
425                 case 2:
426                         parseip(ip, argv[1]);
427                         memmove(mask, defmask(ip), IPaddrlen);
428                         maskip(ip, mask, rem);
429                         maskip(rem, mask, net);
430                         break;
431                 default:
432                         error(EINVAL, "Bad arg num to %s", __func__);
433         }
434         if (isv4(ip))
435                 tentative = 0;
436         wlock(&ifc->rwlock);
437
438         /* ignore if this is already a local address for this ifc */
439         for (lifc = ifc->lifc; lifc; lifc = lifc->next) {
440                 if (ipcmp(lifc->local, ip) == 0) {
441                         if (lifc->tentative != tentative)
442                                 lifc->tentative = tentative;
443                         if (lifcp != NULL) {
444                                 lifc->onlink = lifcp->onlink;
445                                 lifc->autoflag = lifcp->autoflag;
446                                 lifc->validlt = lifcp->validlt;
447                                 lifc->preflt = lifcp->preflt;
448                                 lifc->origint = lifcp->origint;
449                         }
450                         goto out;
451                 }
452         }
453
454         /* add the address to the list of logical ifc's for this ifc */
455         lifc = kzmalloc(sizeof(struct Iplifc), 0);
456         ipmove(lifc->local, ip);
457         ipmove(lifc->mask, mask);
458         ipmove(lifc->remote, rem);
459         ipmove(lifc->net, net);
460         lifc->tentative = tentative;
461         if (lifcp != NULL) {
462                 lifc->onlink = lifcp->onlink;
463                 lifc->autoflag = lifcp->autoflag;
464                 lifc->validlt = lifcp->validlt;
465                 lifc->preflt = lifcp->preflt;
466                 lifc->origint = lifcp->origint;
467         } else {        // default values
468                 lifc->onlink = 1;
469                 lifc->autoflag = 1;
470                 lifc->validlt = UINT64_MAX;
471                 lifc->preflt = UINT64_MAX;
472                 lifc->origint = NOW / 10 ^ 3;
473         }
474         lifc->next = NULL;
475
476         for (l = &ifc->lifc; *l; l = &(*l)->next) ;
477         *l = lifc;
478
479         /* check for point-to-point interface */
480         if (ipcmp(ip, v6loopback))      /* skip v6 loopback, it's a special address */
481                 if (ipcmp(mask, IPallbits) == 0)
482                         type |= Rptpt;
483
484         /* add local routes */
485         if (isv4(ip))
486                 v4addroute(f, tifc, rem + IPv4off, mask + IPv4off, rem + IPv4off, type);
487         else
488                 v6addroute(f, tifc, rem, mask, rem, type);
489
490         addselfcache(f, ifc, lifc, ip, Runi);
491
492         if ((type & (Rproxy | Rptpt)) == (Rproxy | Rptpt)) {
493                 ipifcregisterproxy(f, ifc, rem);
494                 goto out;
495         }
496
497         if (isv4(ip) || ipcmp(ip, IPnoaddr) == 0) {
498                 /* add subnet directed broadcast address to the self cache */
499                 for (i = 0; i < IPaddrlen; i++)
500                         bcast[i] = (ip[i] & mask[i]) | ~mask[i];
501                 addselfcache(f, ifc, lifc, bcast, Rbcast);
502
503                 /* add subnet directed network address to the self cache */
504                 for (i = 0; i < IPaddrlen; i++)
505                         bcast[i] = (ip[i] & mask[i]) & mask[i];
506                 addselfcache(f, ifc, lifc, bcast, Rbcast);
507
508                 /* add network directed broadcast address to the self cache */
509                 memmove(mask, defmask(ip), IPaddrlen);
510                 for (i = 0; i < IPaddrlen; i++)
511                         bcast[i] = (ip[i] & mask[i]) | ~mask[i];
512                 addselfcache(f, ifc, lifc, bcast, Rbcast);
513
514                 /* add network directed network address to the self cache */
515                 memmove(mask, defmask(ip), IPaddrlen);
516                 for (i = 0; i < IPaddrlen; i++)
517                         bcast[i] = (ip[i] & mask[i]) & mask[i];
518                 addselfcache(f, ifc, lifc, bcast, Rbcast);
519
520                 addselfcache(f, ifc, lifc, IPv4bcast, Rbcast);
521         } else {
522                 if (ipcmp(ip, v6loopback) == 0) {
523                         /* add node-local mcast address */
524                         addselfcache(f, ifc, lifc, v6allnodesN, Rmulti);
525
526                         /* add route for all node multicast */
527                         v6addroute(f, tifc, v6allnodesN, v6allnodesNmask, v6allnodesN,
528                                            Rmulti);
529                 }
530
531                 /* add all nodes multicast address */
532                 addselfcache(f, ifc, lifc, v6allnodesL, Rmulti);
533
534                 /* add route for all nodes multicast */
535                 v6addroute(f, tifc, v6allnodesL, v6allnodesLmask, v6allnodesL, Rmulti);
536
537                 /* add solicited-node multicast address */
538                 ipv62smcast(bcast, ip);
539                 addselfcache(f, ifc, lifc, bcast, Rmulti);
540
541                 sendnbrdisc = 1;
542         }
543
544         /* register the address on this network for address resolution */
545         if (isv4(ip) && ifc->m->areg != NULL)
546                 (*ifc->m->areg) (ifc, ip);
547
548 out:
549         wunlock(&ifc->rwlock);
550         if (tentative && sendnbrdisc)
551                 icmpns(f, 0, SRC_UNSPEC, ip, TARG_MULTI, ifc->mac);
552 }
553
554 /*
555  *  remove a logical interface from an ifc
556  *  always called with ifc wlock'd
557  */
558 static void ipifcremlifc(struct Ipifc *ifc, struct Iplifc *lifc)
559 {
560         struct Iplifc **l;
561         struct Fs *f;
562
563         f = ifc->conv->p->f;
564
565         /*
566          *  find address on this interface and remove from chain.
567          *  for pt to pt we actually specify the remote address as the
568          *  addresss to remove.
569          */
570         for (l = &ifc->lifc; *l != NULL && *l != lifc; l = &(*l)->next) ;
571         if (*l == NULL)
572                 error(EFAIL, "address not on this interface");
573         *l = lifc->next;
574
575         /* disassociate any addresses */
576         while (lifc->link)
577                 remselfcache(f, ifc, lifc, lifc->link->self->a);
578
579         /* remove the route for this logical interface */
580         if (isv4(lifc->local))
581                 v4delroute(f, lifc->remote + IPv4off, lifc->mask + IPv4off, 1);
582         else {
583                 v6delroute(f, lifc->remote, lifc->mask, 1);
584                 if (ipcmp(lifc->local, v6loopback) == 0)
585                         /* remove route for all node multicast */
586                         v6delroute(f, v6allnodesN, v6allnodesNmask, 1);
587                 else if (memcmp(lifc->local, v6linklocal, v6llpreflen) == 0)
588                         /* remove route for all link multicast */
589                         v6delroute(f, v6allnodesL, v6allnodesLmask, 1);
590         }
591
592         kfree(lifc);
593 }
594
595 /*
596  *  remove an address from an interface.
597  *  called with c locked
598  */
599 static void ipifcrem(struct Ipifc *ifc, char **argv, int argc)
600 {
601         ERRSTACK(1);
602         uint8_t ip[IPaddrlen];
603         uint8_t mask[IPaddrlen];
604         uint8_t rem[IPaddrlen];
605         struct Iplifc *lifc;
606
607         if (argc < 3)
608                 error(EINVAL, "Too few args (%d) to %s", argc, __func__);
609
610         parseip(ip, argv[1]);
611         parseipmask(mask, argv[2]);
612         if (argc < 4)
613                 maskip(ip, mask, rem);
614         else
615                 parseip(rem, argv[3]);
616
617         wlock(&ifc->rwlock);
618         if (waserror()) {
619                 wunlock(&ifc->rwlock);
620                 nexterror();
621         }
622
623         /*
624          *  find address on this interface and remove from chain.
625          *  for pt to pt we actually specify the remote address as the
626          *  addresss to remove.
627          */
628         for (lifc = ifc->lifc; lifc != NULL; lifc = lifc->next) {
629                 if (memcmp(ip, lifc->local, IPaddrlen) == 0
630                         && memcmp(mask, lifc->mask, IPaddrlen) == 0
631                         && memcmp(rem, lifc->remote, IPaddrlen) == 0)
632                         break;
633         }
634
635         ipifcremlifc(ifc, lifc);
636         poperror();
637         wunlock(&ifc->rwlock);
638 }
639
640 /*
641  * distribute routes to active interfaces like the
642  * TRIP linecards
643  */
644 void
645 ipifcaddroute(struct Fs *f, int vers, uint8_t * addr, uint8_t * mask,
646                           uint8_t * gate, int type)
647 {
648         struct medium *m;
649         struct conv **cp, **e;
650         struct Ipifc *ifc;
651
652         e = &f->ipifc->conv[f->ipifc->nc];
653         for (cp = f->ipifc->conv; cp < e; cp++) {
654                 if (*cp != NULL) {
655                         ifc = (struct Ipifc *)(*cp)->ptcl;
656                         m = ifc->m;
657                         if (m == NULL)
658                                 continue;
659                         if (m->addroute != NULL)
660                                 m->addroute(ifc, vers, addr, mask, gate, type);
661                 }
662         }
663 }
664
665 void ipifcremroute(struct Fs *f, int vers, uint8_t * addr, uint8_t * mask)
666 {
667         struct medium *m;
668         struct conv **cp, **e;
669         struct Ipifc *ifc;
670
671         e = &f->ipifc->conv[f->ipifc->nc];
672         for (cp = f->ipifc->conv; cp < e; cp++) {
673                 if (*cp != NULL) {
674                         ifc = (struct Ipifc *)(*cp)->ptcl;
675                         m = ifc->m;
676                         if (m == NULL)
677                                 continue;
678                         if (m->remroute != NULL)
679                                 m->remroute(ifc, vers, addr, mask);
680                 }
681         }
682 }
683
684 /*
685  *  associate an address with the interface.  This wipes out any previous
686  *  addresses.  This is a macro that means, remove all the old interfaces
687  *  and add a new one.
688  */
689 static void ipifcconnect(struct conv *c, char **argv, int argc)
690 {
691         ERRSTACK(1);
692         char *err;
693         struct Ipifc *ifc;
694
695         ifc = (struct Ipifc *)c->ptcl;
696
697         if (ifc->m == NULL)
698                 error(EFAIL, "ipifc not yet bound to device");
699
700         wlock(&ifc->rwlock);
701         if (waserror()) {
702                 wunlock(&ifc->rwlock);
703                 nexterror();
704         }
705         while (ifc->lifc)
706                 ipifcremlifc(ifc, ifc->lifc);
707         wunlock(&ifc->rwlock);
708         poperror();
709
710         ipifcadd(ifc, argv, argc, 0, NULL);
711
712         Fsconnected(c, NULL);
713 }
714
715 static void ipifcsetpar6(struct Ipifc *ifc, char **argv, int argc)
716 {
717         int i, argsleft, vmax = ifc->rp.maxraint, vmin = ifc->rp.minraint;
718
719         argsleft = argc - 1;
720         i = 1;
721
722         if (argsleft % 2 != 0)
723                 error(EINVAL, "Non-even number of args (%d) to %s", argc, __func__);
724
725         while (argsleft > 1) {
726                 if (strcmp(argv[i], "recvra") == 0)
727                         ifc->recvra6 = (atoi(argv[i + 1]) != 0);
728                 else if (strcmp(argv[i], "sendra") == 0)
729                         ifc->sendra6 = (atoi(argv[i + 1]) != 0);
730                 else if (strcmp(argv[i], "mflag") == 0)
731                         ifc->rp.mflag = (atoi(argv[i + 1]) != 0);
732                 else if (strcmp(argv[i], "oflag") == 0)
733                         ifc->rp.oflag = (atoi(argv[i + 1]) != 0);
734                 else if (strcmp(argv[i], "maxraint") == 0)
735                         ifc->rp.maxraint = atoi(argv[i + 1]);
736                 else if (strcmp(argv[i], "minraint") == 0)
737                         ifc->rp.minraint = atoi(argv[i + 1]);
738                 else if (strcmp(argv[i], "linkmtu") == 0)
739                         ifc->rp.linkmtu = atoi(argv[i + 1]);
740                 else if (strcmp(argv[i], "reachtime") == 0)
741                         ifc->rp.reachtime = atoi(argv[i + 1]);
742                 else if (strcmp(argv[i], "rxmitra") == 0)
743                         ifc->rp.rxmitra = atoi(argv[i + 1]);
744                 else if (strcmp(argv[i], "ttl") == 0)
745                         ifc->rp.ttl = atoi(argv[i + 1]);
746                 else if (strcmp(argv[i], "routerlt") == 0)
747                         ifc->rp.routerlt = atoi(argv[i + 1]);
748                 else
749                         error(EINVAL, "unknown command to %s", __func__);
750
751                 argsleft -= 2;
752                 i += 2;
753         }
754
755         // consistency check
756         if (ifc->rp.maxraint < ifc->rp.minraint) {
757                 ifc->rp.maxraint = vmax;
758                 ifc->rp.minraint = vmin;
759                 error(EINVAL, "inconsistent ifc->rp 'raint'");
760         }
761 }
762
763 static void ipifcsendra6(struct Ipifc *ifc, char **argv, int argc)
764 {
765         int i;
766
767         i = 0;
768         if (argc > 1)
769                 i = atoi(argv[1]);
770         ifc->sendra6 = (i != 0);
771 }
772
773 static void ipifcrecvra6(struct Ipifc *ifc, char **argv, int argc)
774 {
775         int i;
776
777         i = 0;
778         if (argc > 1)
779                 i = atoi(argv[1]);
780         ifc->recvra6 = (i != 0);
781 }
782
783 static void ipifc_iprouting(struct Fs *f, char **argv, int argc)
784 {
785         int i = 1;
786
787         if (argc > 1)
788                 i = atoi(argv[1]);
789         iprouting(f, i);
790 }
791
792 /*
793  *  non-standard control messages.
794  *  called with c locked.
795  */
796 static void ipifcctl(struct conv *c, char **argv, int argc)
797 {
798         struct Ipifc *ifc;
799         int i;
800
801         ifc = (struct Ipifc *)c->ptcl;
802         if (strcmp(argv[0], "add") == 0)
803                 ipifcadd(ifc, argv, argc, 0, NULL);
804         else if (strcmp(argv[0], "try") == 0)
805                 ipifcadd(ifc, argv, argc, 1, NULL);
806         else if (strcmp(argv[0], "remove") == 0)
807                 ipifcrem(ifc, argv, argc);
808         else if (strcmp(argv[0], "unbind") == 0)
809                 ipifcunbind(ifc);
810         else if (strcmp(argv[0], "joinmulti") == 0)
811                 ipifcjoinmulti(ifc, argv, argc);
812         else if (strcmp(argv[0], "leavemulti") == 0)
813                 ipifcleavemulti(ifc, argv, argc);
814         else if (strcmp(argv[0], "mtu") == 0)
815                 ipifcsetmtu(ifc, argv, argc);
816         else if (strcmp(argv[0], "reassemble") == 0)
817                 ifc->reassemble = 1;
818         else if (strcmp(argv[0], "iprouting") == 0)
819                 ipifc_iprouting(c->p->f, argv, argc);
820         else if (strcmp(argv[0], "addpref6") == 0)
821                 ipifcaddpref6(ifc, argv, argc);
822         else if (strcmp(argv[0], "setpar6") == 0)
823                 ipifcsetpar6(ifc, argv, argc);
824         else if (strcmp(argv[0], "sendra6") == 0)
825                 ipifcsendra6(ifc, argv, argc);
826         else if (strcmp(argv[0], "recvra6") == 0)
827                 ipifcrecvra6(ifc, argv, argc);
828         else
829                 error(EINVAL, "unknown command to %s", __func__);
830 }
831
832 int ipifcstats(struct Proto *ipifc, char *buf, int len)
833 {
834         return ipstats(ipifc->f, buf, len);
835 }
836
837 void ipifcinit(struct Fs *f)
838 {
839         struct Proto *ipifc;
840
841         ipifc = kzmalloc(sizeof(struct Proto), 0);
842         ipifc->name = "ipifc";
843         ipifc->connect = ipifcconnect;
844         ipifc->announce = NULL;
845         ipifc->bind = ipifcbind;
846         ipifc->state = ipifcstate;
847         ipifc->create = ipifccreate;
848         ipifc->close = ipifcclose;
849         ipifc->rcv = NULL;
850         ipifc->ctl = ipifcctl;
851         ipifc->advise = NULL;
852         ipifc->stats = ipifcstats;
853         ipifc->inuse = ipifcinuse;
854         ipifc->local = ipifclocal;
855         ipifc->ipproto = -1;
856         ipifc->nc = Maxmedia;
857         ipifc->ptclsize = sizeof(struct Ipifc);
858
859         f->ipifc = ipifc;       /* hack for ipifcremroute, findipifc, ... */
860         f->self = kzmalloc(sizeof(struct Ipselftab), 0);        /* hack for ipforme */
861         qlock_init(&f->self->qlock);
862
863         Fsproto(f, ipifc);
864 }
865
866 /*
867  *  add to self routing cache
868  *      called with c locked
869  */
870 static void
871 addselfcache(struct Fs *f, struct Ipifc *ifc,
872                          struct Iplifc *lifc, uint8_t * a, int type)
873 {
874         struct Ipself *p;
875         struct Iplink *lp;
876         int h;
877
878         qlock(&f->self->qlock);
879
880         /* see if the address already exists */
881         h = hashipa(a);
882         for (p = f->self->hash[h]; p; p = p->next)
883                 if (memcmp(a, p->a, IPaddrlen) == 0)
884                         break;
885
886         /* allocate a local address and add to hash chain */
887         if (p == NULL) {
888                 p = kzmalloc(sizeof(*p), 0);
889                 ipmove(p->a, a);
890                 p->type = type;
891                 p->next = f->self->hash[h];
892                 f->self->hash[h] = p;
893
894                 /* if the null address, accept all packets */
895                 if (ipcmp(a, v4prefix) == 0 || ipcmp(a, IPnoaddr) == 0)
896                         f->self->acceptall = 1;
897         }
898
899         /* look for a link for this lifc */
900         for (lp = p->link; lp; lp = lp->selflink)
901                 if (lp->lifc == lifc)
902                         break;
903
904         /* allocate a lifc-to-local link and link to both */
905         if (lp == NULL) {
906                 lp = kzmalloc(sizeof(*lp), 0);
907                 kref_init(&lp->ref, fake_release, 1);
908                 lp->lifc = lifc;
909                 lp->self = p;
910                 lp->selflink = p->link;
911                 p->link = lp;
912                 lp->lifclink = lifc->link;
913                 lifc->link = lp;
914
915                 /* add to routing table */
916                 if (isv4(a))
917                         v4addroute(f, tifc, a + IPv4off, IPallbits + IPv4off, a + IPv4off,
918                                            type);
919                 else
920                         v6addroute(f, tifc, a, IPallbits, a, type);
921
922                 if ((type & Rmulti) && ifc->m->addmulti != NULL)
923                         (*ifc->m->addmulti) (ifc, a, lifc->local);
924         } else {
925                 kref_get(&lp->ref, 1);
926         }
927
928         qunlock(&f->self->qlock);
929 }
930
931 /*
932  *  These structures are unlinked from their chains while
933  *  other threads may be using them.  To avoid excessive locking,
934  *  just put them aside for a while before freeing them.
935  *      called with f->self locked
936  */
937 static struct Iplink *freeiplink;
938 static struct Ipself *freeipself;
939
940 static void iplinkfree(struct Iplink *p)
941 {
942         struct Iplink **l, *np;
943         uint64_t now = NOW;
944
945         l = &freeiplink;
946         for (np = *l; np; np = *l) {
947                 if (np->expire > now) {
948                         *l = np->next;
949                         kfree(np);
950                         continue;
951                 }
952                 l = &np->next;
953         }
954         p->expire = now + 5000; /* give other threads 5 secs to get out */
955         p->next = NULL;
956         *l = p;
957 }
958
959 static void ipselffree(struct Ipself *p)
960 {
961         struct Ipself **l, *np;
962         uint64_t now = NOW;
963
964         l = &freeipself;
965         for (np = *l; np; np = *l) {
966                 if (np->expire > now) {
967                         *l = np->next;
968                         kfree(np);
969                         continue;
970                 }
971                 l = &np->next;
972         }
973         p->expire = now + 5000; /* give other threads 5 secs to get out */
974         p->next = NULL;
975         *l = p;
976 }
977
978 /*
979  *  Decrement reference for this address on this link.
980  *  Unlink from selftab if this is the last ref.
981  *      called with c locked
982  */
983 static void
984 remselfcache(struct Fs *f, struct Ipifc *ifc, struct Iplifc *lifc, uint8_t * a)
985 {
986         struct Ipself *p, **l;
987         struct Iplink *link, **l_self, **l_lifc;
988
989         qlock(&f->self->qlock);
990
991         /* find the unique selftab entry */
992         l = &f->self->hash[hashipa(a)];
993         for (p = *l; p; p = *l) {
994                 if (ipcmp(p->a, a) == 0)
995                         break;
996                 l = &p->next;
997         }
998
999         if (p == NULL)
1000                 goto out;
1001
1002         /*
1003          *  walk down links from an ifc looking for one
1004          *  that matches the selftab entry
1005          */
1006         l_lifc = &lifc->link;
1007         for (link = *l_lifc; link; link = *l_lifc) {
1008                 if (link->self == p)
1009                         break;
1010                 l_lifc = &link->lifclink;
1011         }
1012
1013         if (link == NULL)
1014                 goto out;
1015
1016         /*
1017          *  walk down the links from the selftab looking for
1018          *  the one we just found
1019          */
1020         l_self = &p->link;
1021         for (link = *l_self; link; link = *l_self) {
1022                 if (link == *(l_lifc))
1023                         break;
1024                 l_self = &link->selflink;
1025         }
1026
1027         if (link == NULL)
1028                 panic("remselfcache");
1029
1030         if (kref_refcnt(&link->ref) > 1)
1031                 goto out;
1032
1033         if ((p->type & Rmulti) && ifc->m->remmulti != NULL)
1034                 (*ifc->m->remmulti) (ifc, a, lifc->local);
1035
1036         /* ref == 0, remove from both chains and free the link */
1037         *l_lifc = link->lifclink;
1038         *l_self = link->selflink;
1039         iplinkfree(link);
1040
1041         if (p->link != NULL)
1042                 goto out;
1043
1044         /* remove from routing table */
1045         if (isv4(a))
1046                 v4delroute(f, a + IPv4off, IPallbits + IPv4off, 1);
1047         else
1048                 v6delroute(f, a, IPallbits, 1);
1049
1050         /* no more links, remove from hash and free */
1051         *l = p->next;
1052         ipselffree(p);
1053
1054         /* if IPnoaddr, forget */
1055         if (ipcmp(a, v4prefix) == 0 || ipcmp(a, IPnoaddr) == 0)
1056                 f->self->acceptall = 0;
1057
1058 out:
1059         qunlock(&f->self->qlock);
1060 }
1061
1062 static char *stformat = "%-44.44I %2.2d %4.4s\n";
1063 enum {
1064         Nstformat = 41,
1065 };
1066
1067 long ipselftabread(struct Fs *f, char *cp, uint32_t offset, int n)
1068 {
1069         int i, m, nifc, off;
1070         struct Ipself *p;
1071         struct Iplink *link;
1072         char state[8];
1073
1074         m = 0;
1075         off = offset;
1076         qlock(&f->self->qlock);
1077         for (i = 0; i < NHASH && m < n; i++) {
1078                 for (p = f->self->hash[i]; p != NULL && m < n; p = p->next) {
1079                         nifc = 0;
1080                         for (link = p->link; link; link = link->selflink)
1081                                 nifc++;
1082                         routetype(p->type, state);
1083                         m += snprintf(cp + m, n - m, stformat, p->a, nifc, state);
1084                         if (off > 0) {
1085                                 off -= m;
1086                                 m = 0;
1087                         }
1088                 }
1089         }
1090         qunlock(&f->self->qlock);
1091         return m;
1092 }
1093
1094 int iptentative(struct Fs *f, uint8_t * addr)
1095 {
1096         struct Ipself *p;
1097
1098         p = f->self->hash[hashipa(addr)];
1099         for (; p; p = p->next) {
1100                 if (ipcmp(addr, p->a) == 0) {
1101                         return p->link->lifc->tentative;
1102                 }
1103         }
1104         return 0;
1105 }
1106
1107 /*
1108  *  returns
1109  *      0               - no match
1110  *      Runi
1111  *      Rbcast
1112  *      Rmcast
1113  */
1114 int ipforme(struct Fs *f, uint8_t * addr)
1115 {
1116         struct Ipself *p;
1117
1118         p = f->self->hash[hashipa(addr)];
1119         for (; p; p = p->next) {
1120                 if (ipcmp(addr, p->a) == 0)
1121                         return p->type;
1122         }
1123
1124         /* hack to say accept anything */
1125         if (f->self->acceptall)
1126                 return Runi;
1127
1128         return 0;
1129 }
1130
1131 /*
1132  *  find the ifc on same net as the remote system.  If none,
1133  *  return NULL.
1134  */
1135 struct Ipifc *findipifc(struct Fs *f, uint8_t * remote, int type)
1136 {
1137         struct Ipifc *ifc, *x;
1138         struct Iplifc *lifc;
1139         struct conv **cp, **e;
1140         uint8_t gnet[IPaddrlen];
1141         uint8_t xmask[IPaddrlen];
1142
1143         x = NULL;
1144         memset(xmask, 0, IPaddrlen);
1145
1146         /* find most specific match */
1147         e = &f->ipifc->conv[f->ipifc->nc];
1148         for (cp = f->ipifc->conv; cp < e; cp++) {
1149                 if (*cp == 0)
1150                         continue;
1151
1152                 ifc = (struct Ipifc *)(*cp)->ptcl;
1153
1154                 for (lifc = ifc->lifc; lifc; lifc = lifc->next) {
1155                         maskip(remote, lifc->mask, gnet);
1156                         if (ipcmp(gnet, lifc->net) == 0) {
1157                                 if (x == NULL || ipcmp(lifc->mask, xmask) > 0) {
1158                                         x = ifc;
1159                                         ipmove(xmask, lifc->mask);
1160                                 }
1161                         }
1162                 }
1163         }
1164         if (x != NULL)
1165                 return x;
1166
1167         /* for now for broadcast and multicast, just use first interface */
1168         if (type & (Rbcast | Rmulti)) {
1169                 for (cp = f->ipifc->conv; cp < e; cp++) {
1170                         if (*cp == 0)
1171                                 continue;
1172                         ifc = (struct Ipifc *)(*cp)->ptcl;
1173                         if (ifc->lifc != NULL)
1174                                 return ifc;
1175                 }
1176         }
1177
1178         return NULL;
1179 }
1180
1181 enum {
1182         unknownv6,
1183         multicastv6,
1184         unspecifiedv6,
1185         linklocalv6,
1186         sitelocalv6,
1187         globalv6,
1188 };
1189
1190 int v6addrtype(uint8_t * addr)
1191 {
1192         if (isv6global(addr))
1193                 return globalv6;
1194         if (islinklocal(addr))
1195                 return linklocalv6;
1196         if (isv6mcast(addr))
1197                 return multicastv6;
1198         if (issitelocal(addr))
1199                 return sitelocalv6;
1200         return unknownv6;
1201 }
1202
1203 #define v6addrcurr(lifc) (( (lifc)->origint + (lifc)->preflt >= (NOW/10^3) ) || ( (lifc)->preflt == UINT64_MAX ))
1204
1205 static void findprimaryipv6(struct Fs *f, uint8_t * local)
1206 {
1207         struct conv **cp, **e;
1208         struct Ipifc *ifc;
1209         struct Iplifc *lifc;
1210         int atype, atypel;
1211
1212         ipmove(local, v6Unspecified);
1213         atype = unspecifiedv6;
1214
1215         /* find "best" (global > sitelocal > link local > unspecified)
1216          * local address; address must be current */
1217
1218         e = &f->ipifc->conv[f->ipifc->nc];
1219         for (cp = f->ipifc->conv; cp < e; cp++) {
1220                 if (*cp == 0)
1221                         continue;
1222                 ifc = (struct Ipifc *)(*cp)->ptcl;
1223                 for (lifc = ifc->lifc; lifc; lifc = lifc->next) {
1224                         atypel = v6addrtype(lifc->local);
1225                         if (atypel > atype)
1226                                 if (v6addrcurr(lifc)) {
1227                                         ipmove(local, lifc->local);
1228                                         atype = atypel;
1229                                         if (atype == globalv6)
1230                                                 return;
1231                                 }
1232                 }
1233         }
1234 }
1235
1236 /*
1237  *  returns first ip address configured
1238  */
1239 static void findprimaryipv4(struct Fs *f, uint8_t * local)
1240 {
1241         struct conv **cp, **e;
1242         struct Ipifc *ifc;
1243         struct Iplifc *lifc;
1244
1245         /* find first ifc local address */
1246         e = &f->ipifc->conv[f->ipifc->nc];
1247         for (cp = f->ipifc->conv; cp < e; cp++) {
1248                 if (*cp == 0)
1249                         continue;
1250                 ifc = (struct Ipifc *)(*cp)->ptcl;
1251                 if ((lifc = ifc->lifc) != NULL) {
1252                         ipmove(local, lifc->local);
1253                         return;
1254                 }
1255         }
1256 }
1257
1258 /*
1259  *  find the local address 'closest' to the remote system, copy it to
1260  *  local and return the ifc for that address
1261  */
1262 void findlocalip(struct Fs *f, uint8_t * local, uint8_t * remote)
1263 {
1264         struct Ipifc *ifc;
1265         struct Iplifc *lifc;
1266         struct route *r;
1267         uint8_t gate[IPaddrlen];
1268         uint8_t gnet[IPaddrlen];
1269         int version;
1270         int atype = unspecifiedv6, atypel = unknownv6;
1271
1272         qlock(&f->ipifc->qlock);
1273         r = v6lookup(f, remote, NULL);
1274         version = isv4(remote) ? V4 : V6;
1275
1276         if (r != NULL) {
1277                 ifc = r->rt.ifc;
1278                 if (r->rt.type & Rv4)
1279                         v4tov6(gate, r->v4.gate);
1280                 else {
1281                         ipmove(gate, r->v6.gate);
1282                         ipmove(local, v6Unspecified);
1283                 }
1284
1285                 /* find ifc address closest to the gateway to use */
1286                 switch (version) {
1287                         case V4:
1288                                 for (lifc = ifc->lifc; lifc; lifc = lifc->next) {
1289                                         maskip(gate, lifc->mask, gnet);
1290                                         if (ipcmp(gnet, lifc->net) == 0) {
1291                                                 ipmove(local, lifc->local);
1292                                                 goto out;
1293                                         }
1294                                 }
1295                                 break;
1296                         case V6:
1297                                 for (lifc = ifc->lifc; lifc; lifc = lifc->next) {
1298                                         atypel = v6addrtype(lifc->local);
1299                                         maskip(gate, lifc->mask, gnet);
1300                                         if (ipcmp(gnet, lifc->net) == 0)
1301                                                 if (atypel > atype)
1302                                                         if (v6addrcurr(lifc)) {
1303                                                                 ipmove(local, lifc->local);
1304                                                                 atype = atypel;
1305                                                                 if (atype == globalv6)
1306                                                                         break;
1307                                                         }
1308                                 }
1309                                 if (atype > unspecifiedv6)
1310                                         goto out;
1311                                 break;
1312                         default:
1313                                 panic("findlocalip: version %d", version);
1314                 }
1315         }
1316
1317         switch (version) {
1318                 case V4:
1319                         findprimaryipv4(f, local);
1320                         break;
1321                 case V6:
1322                         findprimaryipv6(f, local);
1323                         break;
1324                 default:
1325                         panic("findlocalip2: version %d", version);
1326         }
1327
1328 out:
1329         qunlock(&f->ipifc->qlock);
1330 }
1331
1332 /*
1333  *  return first v4 address associated with an interface
1334  */
1335 int ipv4local(struct Ipifc *ifc, uint8_t * addr)
1336 {
1337         struct Iplifc *lifc;
1338
1339         for (lifc = ifc->lifc; lifc; lifc = lifc->next) {
1340                 if (isv4(lifc->local)) {
1341                         memmove(addr, lifc->local + IPv4off, IPv4addrlen);
1342                         return 1;
1343                 }
1344         }
1345         return 0;
1346 }
1347
1348 /*
1349  *  return first v6 address associated with an interface
1350  */
1351 int ipv6local(struct Ipifc *ifc, uint8_t * addr)
1352 {
1353         struct Iplifc *lifc;
1354
1355         for (lifc = ifc->lifc; lifc; lifc = lifc->next) {
1356                 if (!isv4(lifc->local) && !(lifc->tentative)) {
1357                         ipmove(addr, lifc->local);
1358                         return 1;
1359                 }
1360         }
1361         return 0;
1362 }
1363
1364 int ipv6anylocal(struct Ipifc *ifc, uint8_t * addr)
1365 {
1366         struct Iplifc *lifc;
1367
1368         for (lifc = ifc->lifc; lifc; lifc = lifc->next) {
1369                 if (!isv4(lifc->local)) {
1370                         ipmove(addr, lifc->local);
1371                         return SRC_UNI;
1372                 }
1373         }
1374         return SRC_UNSPEC;
1375 }
1376
1377 /*
1378  *  see if this address is bound to the interface
1379  */
1380 struct Iplifc *iplocalonifc(struct Ipifc *ifc, uint8_t * ip)
1381 {
1382         struct Iplifc *lifc;
1383
1384         for (lifc = ifc->lifc; lifc; lifc = lifc->next)
1385                 if (ipcmp(ip, lifc->local) == 0)
1386                         return lifc;
1387         return NULL;
1388 }
1389
1390 /*
1391  *  See if we're proxying for this address on this interface
1392  */
1393 int ipproxyifc(struct Fs *f, struct Ipifc *ifc, uint8_t * ip)
1394 {
1395         struct route *r;
1396         uint8_t net[IPaddrlen];
1397         struct Iplifc *lifc;
1398
1399         /* see if this is a direct connected pt to pt address */
1400         r = v6lookup(f, ip, NULL);
1401         if (r == NULL)
1402                 return 0;
1403         if ((r->rt.type & (Rifc | Rproxy)) != (Rifc | Rproxy))
1404                 return 0;
1405
1406         /* see if this is on the right interface */
1407         for (lifc = ifc->lifc; lifc; lifc = lifc->next) {
1408                 maskip(ip, lifc->mask, net);
1409                 if (ipcmp(net, lifc->remote) == 0)
1410                         return 1;
1411         }
1412
1413         return 0;
1414 }
1415
1416 /*
1417  *  return multicast version if any
1418  */
1419 int ipismulticast(uint8_t * ip)
1420 {
1421         if (isv4(ip)) {
1422                 if (ip[IPv4off] >= 0xe0 && ip[IPv4off] < 0xf0)
1423                         return V4;
1424         } else {
1425                 if (ip[0] == 0xff)
1426                         return V6;
1427         }
1428         return 0;
1429 }
1430
1431 int ipisbm(uint8_t * ip)
1432 {
1433         if (isv4(ip)) {
1434                 if (ip[IPv4off] >= 0xe0 && ip[IPv4off] < 0xf0)
1435                         return V4;
1436                 if (ipcmp(ip, IPv4bcast) == 0)
1437                         return V4;
1438         } else {
1439                 if (ip[0] == 0xff)
1440                         return V6;
1441         }
1442         return 0;
1443 }
1444
1445 /*
1446  *  add a multicast address to an interface, called with c locked
1447  */
1448 void ipifcaddmulti(struct conv *c, uint8_t * ma, uint8_t * ia)
1449 {
1450         ERRSTACK(1);
1451         struct Ipifc *ifc;
1452         struct Iplifc *lifc;
1453         struct conv **p;
1454         struct Ipmulti *multi, **l;
1455         struct Fs *f;
1456
1457         f = c->p->f;
1458
1459         for (l = &c->multi; *l; l = &(*l)->next)
1460                 if (ipcmp(ma, (*l)->ma) == 0)
1461                         if (ipcmp(ia, (*l)->ia) == 0)
1462                                 return; /* it's already there */
1463
1464         multi = *l = kzmalloc(sizeof(*multi), 0);
1465         ipmove(multi->ma, ma);
1466         ipmove(multi->ia, ia);
1467         multi->next = NULL;
1468
1469         for (p = f->ipifc->conv; *p; p++) {
1470                 if ((*p)->inuse == 0)
1471                         continue;
1472                 ifc = (struct Ipifc *)(*p)->ptcl;
1473                 wlock(&ifc->rwlock);
1474                 if (waserror()) {
1475                         wunlock(&ifc->rwlock);
1476                         nexterror();
1477                 }
1478                 for (lifc = ifc->lifc; lifc; lifc = lifc->next)
1479                         if (ipcmp(ia, lifc->local) == 0)
1480                                 addselfcache(f, ifc, lifc, ma, Rmulti);
1481                 wunlock(&ifc->rwlock);
1482                 poperror();
1483         }
1484 }
1485
1486 /*
1487  *  remove a multicast address from an interface, called with c locked
1488  */
1489 void ipifcremmulti(struct conv *c, uint8_t * ma, uint8_t * ia)
1490 {
1491         ERRSTACK(1);
1492         struct Ipmulti *multi, **l;
1493         struct Iplifc *lifc;
1494         struct conv **p;
1495         struct Ipifc *ifc;
1496         struct Fs *f;
1497
1498         f = c->p->f;
1499
1500         for (l = &c->multi; *l; l = &(*l)->next)
1501                 if (ipcmp(ma, (*l)->ma) == 0)
1502                         if (ipcmp(ia, (*l)->ia) == 0)
1503                                 break;
1504
1505         multi = *l;
1506         if (multi == NULL)
1507                 return; /* we don't have it open */
1508
1509         *l = multi->next;
1510
1511         for (p = f->ipifc->conv; *p; p++) {
1512                 if ((*p)->inuse == 0)
1513                         continue;
1514
1515                 ifc = (struct Ipifc *)(*p)->ptcl;
1516                 wlock(&ifc->rwlock);
1517                 if (waserror()) {
1518                         wunlock(&ifc->rwlock);
1519                         nexterror();
1520                 }
1521                 for (lifc = ifc->lifc; lifc; lifc = lifc->next)
1522                         if (ipcmp(ia, lifc->local) == 0)
1523                                 remselfcache(f, ifc, lifc, ma);
1524                 wunlock(&ifc->rwlock);
1525                 poperror();
1526         }
1527
1528         kfree(multi);
1529 }
1530
1531 /*
1532  *  make lifc's join and leave multicast groups
1533  */
1534 static void ipifcjoinmulti(struct Ipifc *ifc, char **argv, int argc)
1535 {
1536         warn_once("Not implemented, should it be?");
1537 }
1538
1539 static void ipifcleavemulti(struct Ipifc *ifc, char **argv, int argc)
1540 {
1541         warn_once("Not implemented, should it be?");
1542 }
1543
1544 static void ipifcregisterproxy(struct Fs *f, struct Ipifc *ifc, uint8_t * ip)
1545 {
1546         struct conv **cp, **e;
1547         struct Ipifc *nifc;
1548         struct Iplifc *lifc;
1549         struct medium *m;
1550         uint8_t net[IPaddrlen];
1551
1552         /* register the address on any network that will proxy for us */
1553         e = &f->ipifc->conv[f->ipifc->nc];
1554
1555         if (!isv4(ip)) {        // V6
1556                 for (cp = f->ipifc->conv; cp < e; cp++) {
1557                         if (*cp == NULL)
1558                                 continue;
1559                         nifc = (struct Ipifc *)(*cp)->ptcl;
1560                         if (nifc == ifc)
1561                                 continue;
1562
1563                         rlock(&nifc->rwlock);
1564                         m = nifc->m;
1565                         if (m == NULL || m->addmulti == NULL) {
1566                                 runlock(&nifc->rwlock);
1567                                 continue;
1568                         }
1569                         for (lifc = nifc->lifc; lifc; lifc = lifc->next) {
1570                                 maskip(ip, lifc->mask, net);
1571                                 if (ipcmp(net, lifc->remote) == 0) {    /* add solicited-node multicast address */
1572                                         ipv62smcast(net, ip);
1573                                         addselfcache(f, nifc, lifc, net, Rmulti);
1574                                         arpenter(f, V6, ip, nifc->mac, 6, 0);
1575                                         //(*m->addmulti)(nifc, net, ip);
1576                                         break;
1577                                 }
1578                         }
1579                         runlock(&nifc->rwlock);
1580                 }
1581                 return;
1582         } else {        // V4
1583                 for (cp = f->ipifc->conv; cp < e; cp++) {
1584                         if (*cp == NULL)
1585                                 continue;
1586                         nifc = (struct Ipifc *)(*cp)->ptcl;
1587                         if (nifc == ifc)
1588                                 continue;
1589
1590                         rlock(&nifc->rwlock);
1591                         m = nifc->m;
1592                         if (m == NULL || m->areg == NULL) {
1593                                 runlock(&nifc->rwlock);
1594                                 continue;
1595                         }
1596                         for (lifc = nifc->lifc; lifc; lifc = lifc->next) {
1597                                 maskip(ip, lifc->mask, net);
1598                                 if (ipcmp(net, lifc->remote) == 0) {
1599                                         (*m->areg) (nifc, ip);
1600                                         break;
1601                                 }
1602                         }
1603                         runlock(&nifc->rwlock);
1604                 }
1605         }
1606 }
1607
1608 // added for new v6 mesg types
1609 static void adddefroute6(struct Fs *f, uint8_t * gate, int force)
1610 {
1611         struct route *r;
1612
1613         r = v6lookup(f, v6Unspecified, NULL);
1614         if (r != NULL)
1615                 if (!(force) && (strcmp(r->rt.tag, "ra") != 0)) // route entries generated
1616                         return; // by all other means take
1617         // precedence over router annc
1618
1619         v6delroute(f, v6Unspecified, v6Unspecified, 1);
1620         v6addroute(f, "ra", v6Unspecified, v6Unspecified, gate, 0);
1621 }
1622
1623 enum {
1624         Ngates = 3,
1625 };
1626
1627 static void ipifcaddpref6(struct Ipifc *ifc, char **argv, int argc)
1628 {
1629         uint8_t onlink = 1;
1630         uint8_t autoflag = 1;
1631         uint64_t validlt = UINT64_MAX;
1632         uint64_t preflt = UINT64_MAX;
1633         uint64_t origint = NOW / 10 ^ 3;
1634         uint8_t prefix[IPaddrlen];
1635         int plen = 64;
1636         struct Iplifc *lifc;
1637         char addr[40], preflen[6];
1638         char *params[3];
1639
1640         switch (argc) {
1641                 case 7:
1642                         preflt = atoi(argv[6]);
1643                         /* fall through */
1644                 case 6:
1645                         validlt = atoi(argv[5]);
1646                         /* fall through */
1647                 case 5:
1648                         autoflag = atoi(argv[4]);
1649                         /* fall through */
1650                 case 4:
1651                         onlink = atoi(argv[3]);
1652                         /* fall through */
1653                 case 3:
1654                         plen = atoi(argv[2]);
1655                 case 2:
1656                         break;
1657                 default:
1658                         error(EINVAL, "Bad arg num to %s", __func__);
1659         }
1660
1661         if ((parseip(prefix, argv[1]) != 6) ||
1662                 (validlt < preflt) || (plen < 0) || (plen > 64) || (islinklocal(prefix))
1663                 )
1664                 error(EFAIL, "IP parsing failed");
1665
1666         lifc = kzmalloc(sizeof(struct Iplifc), 0);
1667         lifc->onlink = (onlink != 0);
1668         lifc->autoflag = (autoflag != 0);
1669         lifc->validlt = validlt;
1670         lifc->preflt = preflt;
1671         lifc->origint = origint;
1672
1673         if (ifc->m->pref2addr != NULL)
1674                 ifc->m->pref2addr(prefix, ifc->mac);
1675         else
1676                 error(EFAIL, "Null IFC pref");
1677
1678         snprintf(addr, sizeof(addr), "%I", prefix);
1679         snprintf(preflen, sizeof(preflen), "/%d", plen);
1680         params[0] = "add";
1681         params[1] = addr;
1682         params[2] = preflen;
1683
1684         ipifcadd(ifc, params, 3, 0, lifc);
1685 }