route.c revision 134789 
1/*-
2 * Copyright (c) 1996 - 2001 Brian Somers <brian@Awfulhak.org>
3 *          based on work by Toshiharu OHNO <tony-o@iij.ad.jp>
4 *                           Internet Initiative Japan, Inc (IIJ)
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 *    notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 *    notice, this list of conditions and the following disclaimer in the
14 *    documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 *
28 * $FreeBSD: head/usr.sbin/ppp/route.c 134789 2004-09-05 01:46:52Z brian $
29 */
30
31#include <sys/param.h>
32#include <sys/socket.h>
33#include <net/if_types.h>
34#include <net/route.h>
35#include <net/if.h>
36#include <netinet/in.h>
37#include <arpa/inet.h>
38#include <net/if_dl.h>
39#include <netinet/in_systm.h>
40#include <netinet/ip.h>
41#include <sys/un.h>
42
43#include <errno.h>
44#include <stdarg.h>
45#include <stdio.h>
46#include <stdlib.h>
47#include <string.h>
48#include <sys/sysctl.h>
49#include <termios.h>
50#include <unistd.h>
51
52#include "layer.h"
53#include "defs.h"
54#include "command.h"
55#include "mbuf.h"
56#include "log.h"
57#include "iplist.h"
58#include "timer.h"
59#include "throughput.h"
60#include "lqr.h"
61#include "hdlc.h"
62#include "fsm.h"
63#include "lcp.h"
64#include "ccp.h"
65#include "link.h"
66#include "slcompress.h"
67#include "ncpaddr.h"
68#include "ipcp.h"
69#include "filter.h"
70#include "descriptor.h"
71#include "mp.h"
72#ifndef NORADIUS
73#include "radius.h"
74#endif
75#include "ipv6cp.h"
76#include "ncp.h"
77#include "bundle.h"
78#include "route.h"
79#include "prompt.h"
80#include "iface.h"
81#include "id.h"
82
83
84static void
85p_sockaddr(struct prompt *prompt, struct sockaddr *phost,
86           struct sockaddr *pmask, int width)
87{
88  struct ncprange range;
89  char buf[29];
90  struct sockaddr_dl *dl = (struct sockaddr_dl *)phost;
91
92  if (log_IsKept(LogDEBUG)) {
93    char tmp[50];
94
95    log_Printf(LogDEBUG, "Found the following sockaddr:\n");
96    log_Printf(LogDEBUG, "  Family %d, len %d\n",
97               (int)phost->sa_family, (int)phost->sa_len);
98    inet_ntop(phost->sa_family, phost->sa_data, tmp, sizeof tmp);
99    log_Printf(LogDEBUG, "  Addr %s\n", tmp);
100    if (pmask) {
101      inet_ntop(pmask->sa_family, pmask->sa_data, tmp, sizeof tmp);
102      log_Printf(LogDEBUG, "  Mask %s\n", tmp);
103    }
104  }
105
106  switch (phost->sa_family) {
107  case AF_INET:
108#ifndef NOINET6
109  case AF_INET6:
110#endif
111    ncprange_setsa(&range, phost, pmask);
112    if (ncprange_isdefault(&range))
113      prompt_Printf(prompt, "%-*s ", width - 1, "default");
114    else
115      prompt_Printf(prompt, "%-*s ", width - 1, ncprange_ntoa(&range));
116    return;
117
118  case AF_LINK:
119    if (dl->sdl_nlen)
120      snprintf(buf, sizeof buf, "%.*s", dl->sdl_nlen, dl->sdl_data);
121    else if (dl->sdl_alen) {
122      if (dl->sdl_type == IFT_ETHER) {
123        if (dl->sdl_alen < sizeof buf / 3) {
124          int f;
125          u_char *MAC;
126
127          MAC = (u_char *)dl->sdl_data + dl->sdl_nlen;
128          for (f = 0; f < dl->sdl_alen; f++)
129            sprintf(buf+f*3, "%02x:", MAC[f]);
130          buf[f*3-1] = '\0';
131        } else
132          strcpy(buf, "??:??:??:??:??:??");
133      } else
134        sprintf(buf, "<IFT type %d>", dl->sdl_type);
135    }  else if (dl->sdl_slen)
136      sprintf(buf, "<slen %d?>", dl->sdl_slen);
137    else
138      sprintf(buf, "link#%d", dl->sdl_index);
139    break;
140
141  default:
142    sprintf(buf, "<AF type %d>", phost->sa_family);
143    break;
144  }
145
146  prompt_Printf(prompt, "%-*s ", width-1, buf);
147}
148
149static struct bits {
150  u_int32_t b_mask;
151  char b_val;
152} bits[] = {
153  { RTF_UP, 'U' },
154  { RTF_GATEWAY, 'G' },
155  { RTF_HOST, 'H' },
156  { RTF_REJECT, 'R' },
157  { RTF_DYNAMIC, 'D' },
158  { RTF_MODIFIED, 'M' },
159  { RTF_DONE, 'd' },
160  { RTF_CLONING, 'C' },
161  { RTF_XRESOLVE, 'X' },
162  { RTF_LLINFO, 'L' },
163  { RTF_STATIC, 'S' },
164  { RTF_PROTO1, '1' },
165  { RTF_PROTO2, '2' },
166  { RTF_BLACKHOLE, 'B' },
167#ifdef RTF_WASCLONED
168  { RTF_WASCLONED, 'W' },
169#endif
170#ifdef RTF_PRCLONING
171  { RTF_PRCLONING, 'c' },
172#endif
173#ifdef RTF_PROTO3
174  { RTF_PROTO3, '3' },
175#endif
176#ifdef RTF_BROADCAST
177  { RTF_BROADCAST, 'b' },
178#endif
179  { 0, '\0' }
180};
181
182#ifndef RTF_WASCLONED
183#define RTF_WASCLONED (0)
184#endif
185
186static void
187p_flags(struct prompt *prompt, u_int32_t f, unsigned max)
188{
189  char name[33], *flags;
190  register struct bits *p = bits;
191
192  if (max > sizeof name - 1)
193    max = sizeof name - 1;
194
195  for (flags = name; p->b_mask && flags - name < (int)max; p++)
196    if (p->b_mask & f)
197      *flags++ = p->b_val;
198  *flags = '\0';
199  prompt_Printf(prompt, "%-*.*s", max, max, name);
200}
201
202static int route_nifs = -1;
203
204const char *
205Index2Nam(int idx)
206{
207  /*
208   * XXX: Maybe we should select() on the routing socket so that we can
209   *      notice interfaces that come & go (PCCARD support).
210   *      Or we could even support a signal that resets these so that
211   *      the PCCARD insert/remove events can signal ppp.
212   */
213  static char **ifs;		/* Figure these out once */
214  static int debug_done;	/* Debug once */
215
216  if (idx > route_nifs || (idx > 0 && ifs[idx-1] == NULL)) {
217    int mib[6], have, had;
218    size_t needed;
219    char *buf, *ptr, *end;
220    struct sockaddr_dl *dl;
221    struct if_msghdr *ifm;
222
223    if (ifs) {
224      free(ifs);
225      ifs = NULL;
226      route_nifs = 0;
227    }
228    debug_done = 0;
229
230    mib[0] = CTL_NET;
231    mib[1] = PF_ROUTE;
232    mib[2] = 0;
233    mib[3] = 0;
234    mib[4] = NET_RT_IFLIST;
235    mib[5] = 0;
236
237    if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) {
238      log_Printf(LogERROR, "Index2Nam: sysctl: estimate: %s\n",
239                 strerror(errno));
240      return NumStr(idx, NULL, 0);
241    }
242    if ((buf = malloc(needed)) == NULL)
243      return NumStr(idx, NULL, 0);
244    if (sysctl(mib, 6, buf, &needed, NULL, 0) < 0) {
245      free(buf);
246      return NumStr(idx, NULL, 0);
247    }
248    end = buf + needed;
249
250    have = 0;
251    for (ptr = buf; ptr < end; ptr += ifm->ifm_msglen) {
252      ifm = (struct if_msghdr *)ptr;
253      if (ifm->ifm_type != RTM_IFINFO)
254        continue;
255      dl = (struct sockaddr_dl *)(ifm + 1);
256      if (ifm->ifm_index > 0) {
257        if (ifm->ifm_index > have) {
258          char **newifs;
259
260          had = have;
261          have = ifm->ifm_index + 5;
262          if (had)
263            newifs = (char **)realloc(ifs, sizeof(char *) * have);
264          else
265            newifs = (char **)malloc(sizeof(char *) * have);
266          if (!newifs) {
267            log_Printf(LogDEBUG, "Index2Nam: %s\n", strerror(errno));
268            route_nifs = 0;
269            if (ifs) {
270              free(ifs);
271              ifs = NULL;
272            }
273            free(buf);
274            return NumStr(idx, NULL, 0);
275          }
276          ifs = newifs;
277          memset(ifs + had, '\0', sizeof(char *) * (have - had));
278        }
279        if (ifs[ifm->ifm_index-1] == NULL) {
280          ifs[ifm->ifm_index-1] = (char *)malloc(dl->sdl_nlen+1);
281          memcpy(ifs[ifm->ifm_index-1], dl->sdl_data, dl->sdl_nlen);
282          ifs[ifm->ifm_index-1][dl->sdl_nlen] = '\0';
283          if (route_nifs < ifm->ifm_index)
284            route_nifs = ifm->ifm_index;
285        }
286      } else if (log_IsKept(LogDEBUG))
287        log_Printf(LogDEBUG, "Skipping out-of-range interface %d!\n",
288                  ifm->ifm_index);
289    }
290    free(buf);
291  }
292
293  if (log_IsKept(LogDEBUG) && !debug_done) {
294    int f;
295
296    log_Printf(LogDEBUG, "Found the following interfaces:\n");
297    for (f = 0; f < route_nifs; f++)
298      if (ifs[f] != NULL)
299        log_Printf(LogDEBUG, " Index %d, name \"%s\"\n", f+1, ifs[f]);
300    debug_done = 1;
301  }
302
303  if (idx < 1 || idx > route_nifs || ifs[idx-1] == NULL)
304    return NumStr(idx, NULL, 0);
305
306  return ifs[idx-1];
307}
308
309void
310route_ParseHdr(struct rt_msghdr *rtm, struct sockaddr *sa[RTAX_MAX])
311{
312  char *wp;
313  int rtax;
314
315  wp = (char *)(rtm + 1);
316
317  for (rtax = 0; rtax < RTAX_MAX; rtax++)
318    if (rtm->rtm_addrs & (1 << rtax)) {
319      sa[rtax] = (struct sockaddr *)wp;
320      wp += ROUNDUP(sa[rtax]->sa_len);
321      if (sa[rtax]->sa_family == 0)
322        sa[rtax] = NULL;	/* ??? */
323    } else
324      sa[rtax] = NULL;
325}
326
327int
328route_Show(struct cmdargs const *arg)
329{
330  struct rt_msghdr *rtm;
331  struct sockaddr *sa[RTAX_MAX];
332  char *sp, *ep, *cp;
333  size_t needed;
334  int mib[6];
335
336  mib[0] = CTL_NET;
337  mib[1] = PF_ROUTE;
338  mib[2] = 0;
339  mib[3] = 0;
340  mib[4] = NET_RT_DUMP;
341  mib[5] = 0;
342  if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) {
343    log_Printf(LogERROR, "route_Show: sysctl: estimate: %s\n", strerror(errno));
344    return (1);
345  }
346  sp = malloc(needed);
347  if (sp == NULL)
348    return (1);
349  if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) {
350    log_Printf(LogERROR, "route_Show: sysctl: getroute: %s\n", strerror(errno));
351    free(sp);
352    return (1);
353  }
354  ep = sp + needed;
355
356  prompt_Printf(arg->prompt, "%-20s%-20sFlags  Netif\n",
357                "Destination", "Gateway");
358  for (cp = sp; cp < ep; cp += rtm->rtm_msglen) {
359    rtm = (struct rt_msghdr *)cp;
360
361    route_ParseHdr(rtm, sa);
362
363    if (sa[RTAX_DST] && sa[RTAX_GATEWAY]) {
364      p_sockaddr(arg->prompt, sa[RTAX_DST], sa[RTAX_NETMASK], 20);
365      p_sockaddr(arg->prompt, sa[RTAX_GATEWAY], NULL, 20);
366
367      p_flags(arg->prompt, rtm->rtm_flags, 6);
368      prompt_Printf(arg->prompt, " %s\n", Index2Nam(rtm->rtm_index));
369    } else
370      prompt_Printf(arg->prompt, "<can't parse routing entry>\n");
371  }
372  free(sp);
373  return 0;
374}
375
376/*
377 *  Delete routes associated with our interface
378 */
379void
380route_IfDelete(struct bundle *bundle, int all)
381{
382  struct rt_msghdr *rtm;
383  struct sockaddr *sa[RTAX_MAX];
384  struct ncprange range;
385  int pass;
386  size_t needed;
387  char *sp, *cp, *ep;
388  int mib[6];
389
390  log_Printf(LogDEBUG, "route_IfDelete (%d)\n", bundle->iface->index);
391
392  mib[0] = CTL_NET;
393  mib[1] = PF_ROUTE;
394  mib[2] = 0;
395  mib[3] = 0;
396  mib[4] = NET_RT_DUMP;
397  mib[5] = 0;
398  if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) {
399    log_Printf(LogERROR, "route_IfDelete: sysctl: estimate: %s\n",
400              strerror(errno));
401    return;
402  }
403
404  sp = malloc(needed);
405  if (sp == NULL)
406    return;
407
408  if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) {
409    log_Printf(LogERROR, "route_IfDelete: sysctl: getroute: %s\n",
410              strerror(errno));
411    free(sp);
412    return;
413  }
414  ep = sp + needed;
415
416  for (pass = 0; pass < 2; pass++) {
417    /*
418     * We do 2 passes.  The first deletes all cloned routes.  The second
419     * deletes all non-cloned routes.  This is done to avoid
420     * potential errors from trying to delete route X after route Y where
421     * route X was cloned from route Y (and is no longer there 'cos it
422     * may have gone with route Y).
423     */
424    if (RTF_WASCLONED == 0 && pass == 0)
425      /* So we can't tell ! */
426      continue;
427    for (cp = sp; cp < ep; cp += rtm->rtm_msglen) {
428      rtm = (struct rt_msghdr *)cp;
429      route_ParseHdr(rtm, sa);
430      if (rtm->rtm_index == bundle->iface->index &&
431          sa[RTAX_DST] && sa[RTAX_GATEWAY] &&
432          (sa[RTAX_DST]->sa_family == AF_INET
433#ifndef NOINET6
434           || sa[RTAX_DST]->sa_family == AF_INET6
435#endif
436           ) &&
437          (all || (rtm->rtm_flags & RTF_GATEWAY))) {
438        if (log_IsKept(LogDEBUG)) {
439          char gwstr[41];
440          struct ncpaddr gw;
441          ncprange_setsa(&range, sa[RTAX_DST], sa[RTAX_NETMASK]);
442          ncpaddr_setsa(&gw, sa[RTAX_GATEWAY]);
443          snprintf(gwstr, sizeof gwstr, "%s", ncpaddr_ntoa(&gw));
444          log_Printf(LogDEBUG, "Found %s %s\n", ncprange_ntoa(&range), gwstr);
445        }
446        if (sa[RTAX_GATEWAY]->sa_family == AF_INET ||
447#ifndef NOINET6
448            sa[RTAX_GATEWAY]->sa_family == AF_INET6 ||
449#endif
450            sa[RTAX_GATEWAY]->sa_family == AF_LINK) {
451          if ((pass == 0 && (rtm->rtm_flags & RTF_WASCLONED)) ||
452              (pass == 1 && !(rtm->rtm_flags & RTF_WASCLONED))) {
453            ncprange_setsa(&range, sa[RTAX_DST], sa[RTAX_NETMASK]);
454            rt_Set(bundle, RTM_DELETE, &range, NULL, 0, 0);
455          } else
456            log_Printf(LogDEBUG, "route_IfDelete: Skip it (pass %d)\n", pass);
457        } else
458          log_Printf(LogDEBUG,
459                    "route_IfDelete: Can't remove routes for family %d\n",
460                    sa[RTAX_GATEWAY]->sa_family);
461      }
462    }
463  }
464  free(sp);
465}
466
467
468/*
469 *  Update the MTU on all routes for the given interface
470 */
471void
472route_UpdateMTU(struct bundle *bundle)
473{
474  struct rt_msghdr *rtm;
475  struct sockaddr *sa[RTAX_MAX];
476  struct ncprange dst;
477  size_t needed;
478  char *sp, *cp, *ep;
479  int mib[6];
480
481  log_Printf(LogDEBUG, "route_UpdateMTU (%d)\n", bundle->iface->index);
482
483  mib[0] = CTL_NET;
484  mib[1] = PF_ROUTE;
485  mib[2] = 0;
486  mib[3] = 0;
487  mib[4] = NET_RT_DUMP;
488  mib[5] = 0;
489  if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) {
490    log_Printf(LogERROR, "route_IfDelete: sysctl: estimate: %s\n",
491              strerror(errno));
492    return;
493  }
494
495  sp = malloc(needed);
496  if (sp == NULL)
497    return;
498
499  if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) {
500    log_Printf(LogERROR, "route_IfDelete: sysctl: getroute: %s\n",
501              strerror(errno));
502    free(sp);
503    return;
504  }
505  ep = sp + needed;
506
507  for (cp = sp; cp < ep; cp += rtm->rtm_msglen) {
508    rtm = (struct rt_msghdr *)cp;
509    route_ParseHdr(rtm, sa);
510    if (sa[RTAX_DST] && (sa[RTAX_DST]->sa_family == AF_INET
511#ifndef NOINET6
512                         || sa[RTAX_DST]->sa_family == AF_INET6
513#endif
514                        ) &&
515        sa[RTAX_GATEWAY] && rtm->rtm_index == bundle->iface->index) {
516      if (log_IsKept(LogTCPIP)) {
517        ncprange_setsa(&dst, sa[RTAX_DST], sa[RTAX_NETMASK]);
518        log_Printf(LogTCPIP, "route_UpdateMTU: Netif: %d (%s), dst %s,"
519                   " mtu %lu\n", rtm->rtm_index, Index2Nam(rtm->rtm_index),
520                   ncprange_ntoa(&dst), bundle->iface->mtu);
521      }
522      rt_Update(bundle, sa[RTAX_DST], sa[RTAX_GATEWAY], sa[RTAX_NETMASK]);
523    }
524  }
525
526  free(sp);
527}
528
529int
530GetIfIndex(char *name)
531{
532  int idx;
533
534  idx = 1;
535  while (route_nifs == -1 || idx < route_nifs)
536    if (strcmp(Index2Nam(idx), name) == 0)
537      return idx;
538    else
539      idx++;
540  return -1;
541}
542
543void
544route_Change(struct bundle *bundle, struct sticky_route *r,
545             const struct ncpaddr *me, const struct ncpaddr *peer)
546{
547  struct ncpaddr dst;
548
549  for (; r; r = r->next) {
550    ncprange_getaddr(&r->dst, &dst);
551    if (ncpaddr_family(me) == AF_INET) {
552      if ((r->type & ROUTE_DSTMYADDR) && !ncpaddr_equal(&dst, me)) {
553        rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
554        ncprange_sethost(&r->dst, me);
555        if (r->type & ROUTE_GWHISADDR)
556          ncpaddr_copy(&r->gw, peer);
557      } else if ((r->type & ROUTE_DSTHISADDR) && !ncpaddr_equal(&dst, peer)) {
558        rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
559        ncprange_sethost(&r->dst, peer);
560        if (r->type & ROUTE_GWHISADDR)
561          ncpaddr_copy(&r->gw, peer);
562      } else if ((r->type & ROUTE_DSTDNS0) && !ncpaddr_equal(&dst, peer)) {
563        if (bundle->ncp.ipcp.ns.dns[0].s_addr == INADDR_NONE)
564          continue;
565        rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
566        if (r->type & ROUTE_GWHISADDR)
567          ncpaddr_copy(&r->gw, peer);
568      } else if ((r->type & ROUTE_DSTDNS1) && !ncpaddr_equal(&dst, peer)) {
569        if (bundle->ncp.ipcp.ns.dns[1].s_addr == INADDR_NONE)
570          continue;
571        rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
572        if (r->type & ROUTE_GWHISADDR)
573          ncpaddr_copy(&r->gw, peer);
574      } else if ((r->type & ROUTE_GWHISADDR) && !ncpaddr_equal(&r->gw, peer))
575        ncpaddr_copy(&r->gw, peer);
576#ifndef NOINET6
577    } else if (ncpaddr_family(me) == AF_INET6) {
578      if ((r->type & ROUTE_DSTMYADDR6) && !ncpaddr_equal(&dst, me)) {
579        rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
580        ncprange_sethost(&r->dst, me);
581        if (r->type & ROUTE_GWHISADDR)
582          ncpaddr_copy(&r->gw, peer);
583      } else if ((r->type & ROUTE_DSTHISADDR6) && !ncpaddr_equal(&dst, peer)) {
584        rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
585        ncprange_sethost(&r->dst, peer);
586        if (r->type & ROUTE_GWHISADDR)
587          ncpaddr_copy(&r->gw, peer);
588      } else if ((r->type & ROUTE_GWHISADDR6) && !ncpaddr_equal(&r->gw, peer))
589        ncpaddr_copy(&r->gw, peer);
590#endif
591    }
592    rt_Set(bundle, RTM_ADD, &r->dst, &r->gw, 1, 0);
593  }
594}
595
596void
597route_Add(struct sticky_route **rp, int type, const struct ncprange *dst,
598          const struct ncpaddr *gw)
599{
600  struct sticky_route *r;
601  int dsttype = type & ROUTE_DSTANY;
602
603  r = NULL;
604  while (*rp) {
605    if ((dsttype && dsttype == ((*rp)->type & ROUTE_DSTANY)) ||
606        (!dsttype && ncprange_equal(&(*rp)->dst, dst))) {
607      /* Oops, we already have this route - unlink it */
608      free(r);			/* impossible really  */
609      r = *rp;
610      *rp = r->next;
611    } else
612      rp = &(*rp)->next;
613  }
614
615  if (!r)
616    r = (struct sticky_route *)malloc(sizeof(struct sticky_route));
617  r->type = type;
618  r->next = NULL;
619  ncprange_copy(&r->dst, dst);
620  ncpaddr_copy(&r->gw, gw);
621  *rp = r;
622}
623
624void
625route_Delete(struct sticky_route **rp, int type, const struct ncprange *dst)
626{
627  struct sticky_route *r;
628  int dsttype = type & ROUTE_DSTANY;
629
630  for (; *rp; rp = &(*rp)->next) {
631    if ((dsttype && dsttype == ((*rp)->type & ROUTE_DSTANY)) ||
632        (!dsttype && ncprange_equal(dst, &(*rp)->dst))) {
633      r = *rp;
634      *rp = r->next;
635      free(r);
636      break;
637    }
638  }
639}
640
641void
642route_DeleteAll(struct sticky_route **rp)
643{
644  struct sticky_route *r, *rn;
645
646  for (r = *rp; r; r = rn) {
647    rn = r->next;
648    free(r);
649  }
650  *rp = NULL;
651}
652
653void
654route_ShowSticky(struct prompt *p, struct sticky_route *r, const char *tag,
655                 int indent)
656{
657  int tlen = strlen(tag);
658
659  if (tlen + 2 > indent)
660    prompt_Printf(p, "%s:\n%*s", tag, indent, "");
661  else
662    prompt_Printf(p, "%s:%*s", tag, indent - tlen - 1, "");
663
664  for (; r; r = r->next) {
665    prompt_Printf(p, "%*sadd ", tlen ? 0 : indent, "");
666    tlen = 0;
667    if (r->type & ROUTE_DSTMYADDR)
668      prompt_Printf(p, "MYADDR");
669    else if (r->type & ROUTE_DSTMYADDR6)
670      prompt_Printf(p, "MYADDR6");
671    else if (r->type & ROUTE_DSTHISADDR)
672      prompt_Printf(p, "HISADDR");
673    else if (r->type & ROUTE_DSTHISADDR6)
674      prompt_Printf(p, "HISADDR6");
675    else if (r->type & ROUTE_DSTDNS0)
676      prompt_Printf(p, "DNS0");
677    else if (r->type & ROUTE_DSTDNS1)
678      prompt_Printf(p, "DNS1");
679    else if (ncprange_isdefault(&r->dst))
680      prompt_Printf(p, "default");
681    else
682      prompt_Printf(p, "%s", ncprange_ntoa(&r->dst));
683
684    if (r->type & ROUTE_GWHISADDR)
685      prompt_Printf(p, " HISADDR\n");
686    else if (r->type & ROUTE_GWHISADDR6)
687      prompt_Printf(p, " HISADDR6\n");
688    else
689      prompt_Printf(p, " %s\n", ncpaddr_ntoa(&r->gw));
690  }
691}
692
693struct rtmsg {
694  struct rt_msghdr m_rtm;
695  char m_space[256];
696};
697
698static size_t
699memcpy_roundup(char *cp, const void *data, size_t len)
700{
701  size_t padlen;
702
703  padlen = ROUNDUP(len);
704  memcpy(cp, data, len);
705  if (padlen > len)
706    memset(cp + len, '\0', padlen - len);
707
708  return padlen;
709}
710
711#if defined(__KAME__) && !defined(NOINET6)
712static void
713add_scope(struct sockaddr *sa, int ifindex)
714{
715  struct sockaddr_in6 *sa6;
716
717  if (sa->sa_family != AF_INET6)
718    return;
719  sa6 = (struct sockaddr_in6 *)sa;
720  if (!IN6_IS_ADDR_LINKLOCAL(&sa6->sin6_addr) &&
721      !IN6_IS_ADDR_MC_LINKLOCAL(&sa6->sin6_addr))
722    return;
723  if (*(u_int16_t *)&sa6->sin6_addr.s6_addr[2] != 0)
724    return;
725  *(u_int16_t *)&sa6->sin6_addr.s6_addr[2] = htons(ifindex);
726}
727#endif
728
729int
730rt_Set(struct bundle *bundle, int cmd, const struct ncprange *dst,
731       const struct ncpaddr *gw, int bang, int quiet)
732{
733  struct rtmsg rtmes;
734  int s, nb, wb;
735  char *cp;
736  const char *cmdstr;
737  struct sockaddr_storage sadst, samask, sagw;
738  int result = 1;
739
740  if (bang)
741    cmdstr = (cmd == RTM_ADD ? "Add!" : "Delete!");
742  else
743    cmdstr = (cmd == RTM_ADD ? "Add" : "Delete");
744  s = ID0socket(PF_ROUTE, SOCK_RAW, 0);
745  if (s < 0) {
746    log_Printf(LogERROR, "rt_Set: socket(): %s\n", strerror(errno));
747    return result;
748  }
749  memset(&rtmes, '\0', sizeof rtmes);
750  rtmes.m_rtm.rtm_version = RTM_VERSION;
751  rtmes.m_rtm.rtm_type = cmd;
752  rtmes.m_rtm.rtm_addrs = RTA_DST;
753  rtmes.m_rtm.rtm_seq = ++bundle->routing_seq;
754  rtmes.m_rtm.rtm_pid = getpid();
755  rtmes.m_rtm.rtm_flags = RTF_UP | RTF_GATEWAY | RTF_STATIC;
756
757  if (cmd == RTM_ADD) {
758    if (bundle->ncp.cfg.sendpipe > 0) {
759      rtmes.m_rtm.rtm_rmx.rmx_sendpipe = bundle->ncp.cfg.sendpipe;
760      rtmes.m_rtm.rtm_inits |= RTV_SPIPE;
761    }
762    if (bundle->ncp.cfg.recvpipe > 0) {
763      rtmes.m_rtm.rtm_rmx.rmx_recvpipe = bundle->ncp.cfg.recvpipe;
764      rtmes.m_rtm.rtm_inits |= RTV_RPIPE;
765    }
766  }
767
768  ncprange_getsa(dst, &sadst, &samask);
769#if defined(__KAME__) && !defined(NOINET6)
770  add_scope((struct sockaddr *)&sadst, bundle->iface->index);
771#endif
772
773  cp = rtmes.m_space;
774  cp += memcpy_roundup(cp, &sadst, sadst.ss_len);
775  if (cmd == RTM_ADD) {
776    if (gw == NULL) {
777      log_Printf(LogERROR, "rt_Set: Program error\n");
778      close(s);
779      return result;
780    }
781    ncpaddr_getsa(gw, &sagw);
782#if defined(__KAME__) && !defined(NOINET6)
783    add_scope((struct sockaddr *)&sagw, bundle->iface->index);
784#endif
785    if (ncpaddr_isdefault(gw)) {
786      if (!quiet)
787        log_Printf(LogERROR, "rt_Set: Cannot add a route with"
788                   " gateway 0.0.0.0\n");
789      close(s);
790      return result;
791    } else {
792      cp += memcpy_roundup(cp, &sagw, sagw.ss_len);
793      rtmes.m_rtm.rtm_addrs |= RTA_GATEWAY;
794    }
795  }
796
797  if (!ncprange_ishost(dst)) {
798    cp += memcpy_roundup(cp, &samask, samask.ss_len);
799    rtmes.m_rtm.rtm_addrs |= RTA_NETMASK;
800  }
801
802  nb = cp - (char *)&rtmes;
803  rtmes.m_rtm.rtm_msglen = nb;
804  wb = ID0write(s, &rtmes, nb);
805  if (wb < 0) {
806    log_Printf(LogTCPIP, "rt_Set failure:\n");
807    log_Printf(LogTCPIP, "rt_Set:  Cmd = %s\n", cmdstr);
808    log_Printf(LogTCPIP, "rt_Set:  Dst = %s\n", ncprange_ntoa(dst));
809    if (gw != NULL)
810      log_Printf(LogTCPIP, "rt_Set:  Gateway = %s\n", ncpaddr_ntoa(gw));
811failed:
812    if (cmd == RTM_ADD && (rtmes.m_rtm.rtm_errno == EEXIST ||
813                           (rtmes.m_rtm.rtm_errno == 0 && errno == EEXIST))) {
814      if (!bang) {
815        log_Printf(LogWARN, "Add route failed: %s already exists\n",
816		   ncprange_ntoa(dst));
817        result = 0;	/* Don't add to our dynamic list */
818      } else {
819        rtmes.m_rtm.rtm_type = cmd = RTM_CHANGE;
820        if ((wb = ID0write(s, &rtmes, nb)) < 0)
821          goto failed;
822      }
823    } else if (cmd == RTM_DELETE &&
824             (rtmes.m_rtm.rtm_errno == ESRCH ||
825              (rtmes.m_rtm.rtm_errno == 0 && errno == ESRCH))) {
826      if (!bang)
827        log_Printf(LogWARN, "Del route failed: %s: Non-existent\n",
828                  ncprange_ntoa(dst));
829    } else if (rtmes.m_rtm.rtm_errno == 0) {
830      if (!quiet || errno != ENETUNREACH)
831        log_Printf(LogWARN, "%s route failed: %s: errno: %s\n", cmdstr,
832                   ncprange_ntoa(dst), strerror(errno));
833    } else
834      log_Printf(LogWARN, "%s route failed: %s: %s\n",
835		 cmdstr, ncprange_ntoa(dst), strerror(rtmes.m_rtm.rtm_errno));
836  }
837
838  if (log_IsKept(LogDEBUG)) {
839    char gwstr[40];
840
841    if (gw)
842      snprintf(gwstr, sizeof gwstr, "%s", ncpaddr_ntoa(gw));
843    else
844      snprintf(gwstr, sizeof gwstr, "<none>");
845    log_Printf(LogDEBUG, "wrote %d: cmd = %s, dst = %s, gateway = %s\n",
846               wb, cmdstr, ncprange_ntoa(dst), gwstr);
847  }
848  close(s);
849
850  return result;
851}
852
853void
854rt_Update(struct bundle *bundle, const struct sockaddr *dst,
855          const struct sockaddr *gw, const struct sockaddr *mask)
856{
857  struct ncprange ncpdst;
858  struct rtmsg rtmes;
859  char *p;
860  int s, wb;
861
862  s = ID0socket(PF_ROUTE, SOCK_RAW, 0);
863  if (s < 0) {
864    log_Printf(LogERROR, "rt_Update: socket(): %s\n", strerror(errno));
865    return;
866  }
867
868  memset(&rtmes, '\0', sizeof rtmes);
869  rtmes.m_rtm.rtm_version = RTM_VERSION;
870  rtmes.m_rtm.rtm_type = RTM_CHANGE;
871  rtmes.m_rtm.rtm_addrs = 0;
872  rtmes.m_rtm.rtm_seq = ++bundle->routing_seq;
873  rtmes.m_rtm.rtm_pid = getpid();
874  rtmes.m_rtm.rtm_flags = RTF_UP | RTF_STATIC;
875
876  if (bundle->ncp.cfg.sendpipe > 0) {
877    rtmes.m_rtm.rtm_rmx.rmx_sendpipe = bundle->ncp.cfg.sendpipe;
878    rtmes.m_rtm.rtm_inits |= RTV_SPIPE;
879  }
880
881  if (bundle->ncp.cfg.recvpipe > 0) {
882    rtmes.m_rtm.rtm_rmx.rmx_recvpipe = bundle->ncp.cfg.recvpipe;
883    rtmes.m_rtm.rtm_inits |= RTV_RPIPE;
884  }
885
886  rtmes.m_rtm.rtm_rmx.rmx_mtu = bundle->iface->mtu;
887  rtmes.m_rtm.rtm_inits |= RTV_MTU;
888  p = rtmes.m_space;
889
890  if (dst) {
891    rtmes.m_rtm.rtm_addrs |= RTA_DST;
892    p += memcpy_roundup(p, dst, dst->sa_len);
893  }
894
895  rtmes.m_rtm.rtm_addrs |= RTA_GATEWAY;
896  p += memcpy_roundup(p, gw, gw->sa_len);
897  if (mask) {
898    rtmes.m_rtm.rtm_addrs |= RTA_NETMASK;
899    p += memcpy_roundup(p, mask, mask->sa_len);
900  }
901
902  rtmes.m_rtm.rtm_msglen = p - (char *)&rtmes;
903
904  wb = ID0write(s, &rtmes, rtmes.m_rtm.rtm_msglen);
905  if (wb < 0) {
906    ncprange_setsa(&ncpdst, dst, mask);
907
908    log_Printf(LogTCPIP, "rt_Update failure:\n");
909    log_Printf(LogTCPIP, "rt_Update:  Dst = %s\n", ncprange_ntoa(&ncpdst));
910
911    if (rtmes.m_rtm.rtm_errno == 0)
912      log_Printf(LogWARN, "%s: Change route failed: errno: %s\n",
913                 ncprange_ntoa(&ncpdst), strerror(errno));
914    else
915      log_Printf(LogWARN, "%s: Change route failed: %s\n",
916		 ncprange_ntoa(&ncpdst), strerror(rtmes.m_rtm.rtm_errno));
917  }
918  close(s);
919}
920