route.c revision 6059 
1/*
2 *	      PPP Routing related Module
3 *
4 *	    Written by Toshiharu OHNO (tony-o@iij.ad.jp)
5 *
6 *   Copyright (C) 1994, Internet Initiative Japan, Inc. All rights reserverd.
7 *
8 * Redistribution and use in source and binary forms are permitted
9 * provided that the above copyright notice and this paragraph are
10 * duplicated in all such forms and that any documentation,
11 * advertising materials, and other materials related to such
12 * distribution and use acknowledge that the software was developed
13 * by the Internet Initiative Japan, Inc.  The name of the
14 * IIJ may not be used to endorse or promote products derived
15 * from this software without specific prior written permission.
16 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
18 * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
19 *
20 * $Id:$
21 */
22#include <sys/types.h>
23#include <machine/endian.h>
24#include <sys/param.h>
25#include <sys/socket.h>
26#include <net/route.h>
27#include <sys/ioctl.h>
28#include <net/if.h>
29#include <errno.h>
30#include <netinet/in_systm.h>
31#include <netinet/in.h>
32#include <arpa/inet.h>
33#if __FreeBSD__ >= 2
34#include <osreldate.h>
35#include <sys/sysctl.h>
36#else
37#include <sys/kinfo.h>
38#endif
39#include <stdlib.h>
40#include <stdio.h>
41#include <string.h>
42#include <unistd.h>
43
44static int IfIndex;
45
46struct rtmsg {
47  struct rt_msghdr m_rtm;
48  char m_space[64];
49};
50
51static int seqno;
52
53void
54OsSetRoute(cmd, dst, gateway, mask)
55int cmd;
56struct in_addr dst;
57struct in_addr gateway;
58struct in_addr mask;
59{
60  struct rtmsg rtmes;
61  int s, nb, wb;
62  char *cp;
63  u_long *lp;
64  struct sockaddr_in rtdata;
65
66  s = socket(PF_ROUTE, SOCK_RAW, 0);
67  if (s < 0)
68    logprintf("socket\n");
69
70  bzero(&rtmes, sizeof(rtmes));
71  rtmes.m_rtm.rtm_version = RTM_VERSION;
72  rtmes.m_rtm.rtm_type = cmd;
73  rtmes.m_rtm.rtm_addrs = RTA_DST | RTA_NETMASK;
74  if (cmd == RTM_ADD) rtmes.m_rtm.rtm_addrs |= RTA_GATEWAY;
75  rtmes.m_rtm.rtm_seq = ++seqno;
76  rtmes.m_rtm.rtm_pid = getpid();
77  rtmes.m_rtm.rtm_flags = RTF_UP | RTF_GATEWAY;
78
79  bzero(&rtdata, sizeof(rtdata));
80  rtdata.sin_len = 16;
81  rtdata.sin_family = AF_INET;
82  rtdata.sin_port = 0;
83  rtdata.sin_addr = dst;
84
85  cp = rtmes.m_space;
86  bcopy(&rtdata, cp, 16);
87  cp += 16;
88  if (gateway.s_addr) {
89    rtdata.sin_addr = gateway;
90    bcopy(&rtdata, cp, 16);
91    cp += 16;
92  }
93
94  if (dst.s_addr == INADDR_ANY)
95    mask.s_addr = INADDR_ANY;
96
97  lp = (u_long *)cp;
98
99  if (mask.s_addr) {
100    *lp++ = 8;
101    cp += sizeof(int);
102    *lp = mask.s_addr;
103  } else
104    *lp = 0;
105  cp += sizeof(u_long);
106
107  nb = cp - (char *)&rtmes;
108  rtmes.m_rtm.rtm_msglen = nb;
109  wb = write(s, &rtmes, nb);
110  if (wb < 0) {
111    perror("write");
112  }
113#ifdef DEBUG
114  logprintf("wrote %d: dst = %x, gateway = %x\n", nb, dst.s_addr, gateway.s_addr);
115#endif
116  close(s);
117}
118
119static void
120p_sockaddr(sa, width)
121struct sockaddr *sa;
122int width;
123{
124  register char *cp;
125  register struct sockaddr_in *sin = (struct sockaddr_in *)sa;
126
127  cp = (sin->sin_addr.s_addr == 0) ? "default" :
128	   inet_ntoa(sin->sin_addr);
129  printf("%-*.*s ", width, width, cp);
130}
131
132struct bits {
133  short b_mask;
134  char  b_val;
135} bits[] = {
136  { RTF_UP,	  'U' },
137  { RTF_GATEWAY,  'G' },
138  { RTF_HOST,	  'H' },
139  { RTF_DYNAMIC,  'D' },
140  { RTF_MODIFIED, 'M' },
141  { RTF_CLONING,  'C' },
142  { RTF_XRESOLVE, 'X' },
143  { RTF_LLINFO,   'L' },
144  { RTF_REJECT,   'R' },
145  { 0 }
146};
147
148static void
149p_flags(f, format)
150register int f;
151char *format;
152{
153  char name[33], *flags;
154  register struct bits *p = bits;
155
156  for (flags = name; p->b_mask; p++)
157    if (p->b_mask & f)
158      *flags++ = p->b_val;
159  *flags = '\0';
160  printf(format, name);
161}
162
163int
164ShowRoute()
165{
166  struct rt_msghdr *rtm;
167  struct sockaddr *sa;
168  char *sp, *ep, *cp;
169  u_char *wp;
170  int *lp;
171  int needed, nb;
172  u_long mask;
173#if ( __FreeBSD_version >= 199412 )
174  int 	mib[6];
175#endif
176
177#if ( __FreeBSD_version >= 199412 )
178  mib[0] = CTL_NET;
179  mib[1] = PF_ROUTE;
180  mib[2] = 0;             /* protocol */
181  mib[3] = 0;             /* wildcard address family */
182  mib[4] = NET_RT_DUMP;
183  mib[5] = 0;             /* no flags */
184  needed = sysctl(mib, 6, NULL, &needed, NULL, 0 );
185#else
186  needed = getkerninfo(KINFO_RT_DUMP, 0, 0, 0);
187#endif
188  if (needed < 0)
189    return(1);
190  sp = malloc(needed);
191  if (sp == NULL)
192    return(1);
193#if ( __FreeBSD_version >= 199412 )
194  if (sysctl(mib, 6, sp, &needed, NULL, 0 ) < 0)
195    return(1);
196#else
197  if (getkerninfo(KINFO_RT_DUMP, sp, &needed, 0) < 0)
198    return(1);
199#endif
200  ep = sp + needed;
201
202  for (cp = sp; cp < ep; cp += rtm->rtm_msglen) {
203    rtm = (struct rt_msghdr *)cp;
204    sa = (struct sockaddr *)(rtm + 1);
205    mask = 0xffffffff;
206    if (rtm->rtm_addrs == RTA_DST)
207      p_sockaddr(sa, 36);
208    else {
209      wp = (u_char *)cp + rtm->rtm_msglen;
210      p_sockaddr(sa, 16);
211      if (sa->sa_len == 0)
212	sa->sa_len = sizeof(long);
213      sa = (struct sockaddr *)(sa->sa_len + (char *)sa);
214      p_sockaddr(sa, 18);
215      lp = (int *)(sa->sa_len + (char *)sa);
216      if ((char *)lp < (char *)wp && *lp) {
217#ifdef DEBUG
218	logprintf(" flag = %x, rest = %d", rtm->rtm_flags, *lp);
219#endif
220	wp = (u_char *)(lp + 1);
221	mask = 0;
222	for (nb = *lp; nb > 4; nb--) {
223	  mask <<= 8;
224	  mask |= *wp++;
225	}
226	for (nb = 8 - *lp; nb > 0; nb--)
227	  mask <<= 8;
228      }
229    }
230    printf("%08x  ", mask);
231    p_flags(rtm->rtm_flags & (RTF_UP|RTF_GATEWAY|RTF_HOST), "%-6.6s ");
232    printf("(%d)\n", rtm->rtm_index);
233  }
234
235  return(1);
236}
237
238/*
239 *  Delete routes associated with our interface
240 */
241void
242DeleteIfRoutes(all)
243int all;
244{
245  struct rt_msghdr *rtm;
246  struct sockaddr *sa;
247  struct in_addr dstnet, gateway;
248  int needed;
249  char *sp, *cp, *ep;
250  u_long mask;
251  int *lp, nb;
252  u_char *wp;
253#if ( __FreeBSD_version >= 199412 )
254  int 	mib[6];
255#endif
256
257#ifdef DEBUG
258  logprintf("DeleteIfRoutes (%d)\n", IfIndex);
259#endif
260#if ( __FreeBSD_version >= 199412 )
261  mib[0] = CTL_NET;
262  mib[1] = PF_ROUTE;
263  mib[2] = 0;             /* protocol */
264  mib[3] = 0;             /* wildcard address family */
265  mib[4] = NET_RT_DUMP;
266  mib[5] = 0;             /* no flags */
267  needed = sysctl(mib, 6, NULL, &needed, NULL, 0 );
268#else
269  needed = getkerninfo(KINFO_RT_DUMP, 0, 0, 0);
270#endif
271  if (needed < 0)
272    return;
273
274  sp = malloc(needed);
275  if (sp == NULL)
276    return;
277
278#if ( __FreeBSD_version >= 199412 )
279  if (sysctl(mib, 6, sp, &needed, NULL, 0 ) < 0) {
280    free(sp);
281    return;
282  }
283#else
284  if (getkerninfo(KINFO_RT_DUMP, sp, &needed, 0) < 0) {
285    free(sp);
286    return;
287  }
288#endif
289  ep = sp + needed;
290
291  for (cp = sp; cp < ep; cp += rtm->rtm_msglen) {
292    rtm = (struct rt_msghdr *)cp;
293    sa = (struct sockaddr *)(rtm + 1);
294#ifdef DEBUG
295    logprintf("addrs: %x, index: %d, flags: %x, dstnet: %x\n",
296	rtm->rtm_addrs, rtm->rtm_index, rtm->rtm_flags,
297	((struct sockaddr_in *)sa)->sin_addr);
298#endif
299    if (rtm->rtm_addrs != RTA_DST &&
300       (rtm->rtm_index == IfIndex) &&
301       (all || (rtm->rtm_flags & RTF_GATEWAY))) {
302      dstnet = ((struct sockaddr_in *)sa)->sin_addr;
303      wp = (u_char *)cp + rtm->rtm_msglen;
304      if (sa->sa_len == 0)
305	sa->sa_len = sizeof(long);
306      sa = (struct sockaddr *)(sa->sa_len + (char *)sa);
307      gateway = ((struct sockaddr_in *)sa)->sin_addr;
308      lp = (int *)(sa->sa_len + (char *)sa);
309      mask = 0;
310      if ((char *)lp < (char *)wp && *lp) {
311#ifdef DEBUG
312	printf(" flag = %x, rest = %d", rtm->rtm_flags, *lp);
313#endif
314	wp = (u_char *)(lp + 1);
315	for (nb = *lp; nb > 4; nb--) {
316	  mask <<= 8;
317	  mask |= *wp++;
318	}
319	for (nb = 8 - *lp; nb > 0; nb--)
320	  mask <<= 8;
321      }
322#ifdef DEBUG
323      logprintf("## %s ", inet_ntoa(dstnet));
324      logprintf(" %s  %d\n", inet_ntoa(gateway), rtm->rtm_index);
325#endif
326      if (dstnet.s_addr == INADDR_ANY) {
327        gateway.s_addr = INADDR_ANY;
328        mask = INADDR_ANY;
329      }
330      OsSetRoute(RTM_DELETE, dstnet, gateway, htonl(mask));
331    }
332#ifdef DEBUG
333    else if (rtm->rtm_index == IfIndex) {
334      logprintf("??? addrs: %x, flags = %x\n", rtm->rtm_addrs, rtm->rtm_flags);
335    }
336#endif
337  }
338  free(sp);
339}
340
341int
342GetIfIndex(name)
343char *name;
344{
345  struct ifreq *ifrp;
346  int s, len, elen, index;
347  struct ifconf ifconfs;
348  struct ifreq reqbuf[32];
349
350  s = socket(AF_INET, SOCK_DGRAM, 0);
351  if (s < 0) {
352    perror("socket");
353    return(-1);
354  }
355
356  ifconfs.ifc_len = sizeof(reqbuf);
357  ifconfs.ifc_buf = (caddr_t)reqbuf;
358  if (ioctl(s, SIOCGIFCONF, &ifconfs) < 0) {
359    perror("IFCONF");
360    return(-1);
361  }
362
363  ifrp = ifconfs.ifc_req;
364
365  index = 1;
366  for (len = ifconfs.ifc_len; len > 0; len -= sizeof(struct ifreq)) {
367    elen = ifrp->ifr_addr.sa_len - sizeof(struct sockaddr);
368    if (ifrp->ifr_addr.sa_family == AF_LINK) {
369#ifdef DEBUG
370      logprintf("%d: %-*.*s, %d, %d\n", index, IFNAMSIZ, IFNAMSIZ, ifrp->ifr_name,
371	   ifrp->ifr_addr.sa_family, elen);
372#endif
373      if (strcmp(ifrp->ifr_name, name) == 0) {
374        IfIndex = index;
375        return(index);
376      }
377#if defined(__FreeBSD__) || (_BSDI_VERSION >= 199312)
378      index++;
379#endif
380    }
381
382    len -= elen;
383    ifrp = (struct ifreq *)((char *)ifrp + elen);
384    ifrp++;
385#if defined(_BSDI_VERSION) && (_BSDI_VERSION < 199312)
386    index++;
387#endif
388  }
389
390  close(s);
391  return(-1);
392}
393