route.c revision 8857 
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: route.c,v 1.2 1995/02/26 12:17:56 amurai Exp $
21 *
22 */
23#include <sys/types.h>
24#include <machine/endian.h>
25#include <sys/param.h>
26#include <sys/socket.h>
27#include <net/route.h>
28#include <sys/ioctl.h>
29#include <net/if.h>
30#include <errno.h>
31#include <netinet/in_systm.h>
32#include <netinet/in.h>
33#include <arpa/inet.h>
34#if (BSD >= 199306)
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 (BSD >= 199306)
174  int mib[6];
175#endif
176
177#if (BSD >= 199306)
178  mib[0] = CTL_NET;
179  mib[1] = PF_ROUTE;
180  mib[2] = 0;
181  mib[3] = 0;
182  mib[4] = NET_RT_DUMP;
183  mib[5] = 0;
184  if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) {
185    perror("sysctl-estimate");
186    return(1);
187  }
188#else
189  needed = getkerninfo(KINFO_RT_DUMP, 0, 0, 0);
190#endif
191  if (needed < 0)
192    return(1);
193  sp = malloc(needed);
194  if (sp == NULL)
195    return(1);
196#if (BSD >= 199306)
197  if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) {
198    perror("sysctl-getroute");
199    return(1);
200  }
201#else
202  if (getkerninfo(KINFO_RT_DUMP, sp, &needed, 0) < 0)
203    return(1);
204#endif
205  ep = sp + needed;
206
207  for (cp = sp; cp < ep; cp += rtm->rtm_msglen) {
208    rtm = (struct rt_msghdr *)cp;
209    sa = (struct sockaddr *)(rtm + 1);
210    mask = 0xffffffff;
211    if (rtm->rtm_addrs == RTA_DST)
212      p_sockaddr(sa, 36);
213    else {
214      wp = (u_char *)cp + rtm->rtm_msglen;
215      p_sockaddr(sa, 16);
216      if (sa->sa_len == 0)
217	sa->sa_len = sizeof(long);
218      sa = (struct sockaddr *)(sa->sa_len + (char *)sa);
219      p_sockaddr(sa, 18);
220      lp = (int *)(sa->sa_len + (char *)sa);
221      if ((char *)lp < (char *)wp && *lp) {
222#ifdef DEBUG
223	logprintf(" flag = %x, rest = %d", rtm->rtm_flags, *lp);
224#endif
225	wp = (u_char *)(lp + 1);
226	mask = 0;
227	for (nb = *lp; nb > 4; nb--) {
228	  mask <<= 8;
229	  mask |= *wp++;
230	}
231	for (nb = 8 - *lp; nb > 0; nb--)
232	  mask <<= 8;
233      }
234    }
235    printf("%08x  ", mask);
236    p_flags(rtm->rtm_flags & (RTF_UP|RTF_GATEWAY|RTF_HOST), "%-6.6s ");
237    printf("(%d)\n", rtm->rtm_index);
238  }
239
240  return(1);
241}
242
243/*
244 *  Delete routes associated with our interface
245 */
246void
247DeleteIfRoutes(all)
248int all;
249{
250  struct rt_msghdr *rtm;
251  struct sockaddr *sa;
252  struct in_addr dstnet, gateway;
253  int needed;
254  char *sp, *cp, *ep;
255  u_long mask;
256  int *lp, nb;
257  u_char *wp;
258#if (BSD >= 199306)
259  int mib[6];
260#endif
261
262#ifdef DEBUG
263  logprintf("DeleteIfRoutes (%d)\n", IfIndex);
264#endif
265#if (BSD >= 199306)
266  mib[0] = CTL_NET;
267  mib[1] = PF_ROUTE;
268  mib[2] = 0;
269  mib[3] = 0;
270  mib[4] = NET_RT_DUMP;
271  mib[5] = 0;
272  if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) {
273    perror("sysctl-estimate");
274    return;
275  }
276#else
277  needed = getkerninfo(KINFO_RT_DUMP, 0, 0, 0);
278#endif
279
280  if (needed < 0)
281    return;
282
283  sp = malloc(needed);
284  if (sp == NULL)
285    return;
286
287#if (BSD >= 199306)
288  if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) {
289    free(sp);
290    perror("sysctl-getroute");
291    return;
292  }
293#else
294  if (getkerninfo(KINFO_RT_DUMP, sp, &needed, 0) < 0) {
295    free(sp);
296    return;
297  }
298#endif
299  ep = sp + needed;
300
301  for (cp = sp; cp < ep; cp += rtm->rtm_msglen) {
302    rtm = (struct rt_msghdr *)cp;
303    sa = (struct sockaddr *)(rtm + 1);
304#ifdef DEBUG
305    logprintf("addrs: %x, index: %d, flags: %x, dstnet: %x\n",
306	rtm->rtm_addrs, rtm->rtm_index, rtm->rtm_flags,
307	((struct sockaddr_in *)sa)->sin_addr);
308#endif
309    if (rtm->rtm_addrs != RTA_DST &&
310       (rtm->rtm_index == IfIndex) &&
311       (all || (rtm->rtm_flags & RTF_GATEWAY))) {
312      dstnet = ((struct sockaddr_in *)sa)->sin_addr;
313      wp = (u_char *)cp + rtm->rtm_msglen;
314      if (sa->sa_len == 0)
315	sa->sa_len = sizeof(long);
316      sa = (struct sockaddr *)(sa->sa_len + (char *)sa);
317      gateway = ((struct sockaddr_in *)sa)->sin_addr;
318      lp = (int *)(sa->sa_len + (char *)sa);
319      mask = 0;
320      if ((char *)lp < (char *)wp && *lp) {
321#ifdef DEBUG
322	printf(" flag = %x, rest = %d", rtm->rtm_flags, *lp);
323#endif
324	wp = (u_char *)(lp + 1);
325	for (nb = *lp; nb > 4; nb--) {
326	  mask <<= 8;
327	  mask |= *wp++;
328	}
329	for (nb = 8 - *lp; nb > 0; nb--)
330	  mask <<= 8;
331      }
332#ifdef DEBUG
333      logprintf("## %s ", inet_ntoa(dstnet));
334      logprintf(" %s  %d\n", inet_ntoa(gateway), rtm->rtm_index);
335#endif
336      if (dstnet.s_addr == INADDR_ANY) {
337        gateway.s_addr = INADDR_ANY;
338        mask = INADDR_ANY;
339      }
340      OsSetRoute(RTM_DELETE, dstnet, gateway, htonl(mask));
341    }
342#ifdef DEBUG
343    else if (rtm->rtm_index == IfIndex) {
344      logprintf("??? addrs: %x, flags = %x\n", rtm->rtm_addrs, rtm->rtm_flags);
345    }
346#endif
347  }
348  free(sp);
349}
350
351int
352GetIfIndex(name)
353char *name;
354{
355  struct ifreq *ifrp;
356  int s, len, elen, index;
357  struct ifconf ifconfs;
358  struct ifreq reqbuf[32];
359
360  s = socket(AF_INET, SOCK_DGRAM, 0);
361  if (s < 0) {
362    perror("socket");
363    return(-1);
364  }
365
366  ifconfs.ifc_len = sizeof(reqbuf);
367  ifconfs.ifc_buf = (caddr_t)reqbuf;
368  if (ioctl(s, SIOCGIFCONF, &ifconfs) < 0) {
369    perror("IFCONF");
370    return(-1);
371  }
372
373  ifrp = ifconfs.ifc_req;
374
375  index = 1;
376  for (len = ifconfs.ifc_len; len > 0; len -= sizeof(struct ifreq)) {
377    elen = ifrp->ifr_addr.sa_len - sizeof(struct sockaddr);
378    if (ifrp->ifr_addr.sa_family == AF_LINK) {
379#ifdef DEBUG
380      logprintf("%d: %-*.*s, %d, %d\n", index, IFNAMSIZ, IFNAMSIZ, ifrp->ifr_name,
381	   ifrp->ifr_addr.sa_family, elen);
382#endif
383      if (strcmp(ifrp->ifr_name, name) == 0) {
384        IfIndex = index;
385        return(index);
386      }
387      index++;
388    }
389
390    len -= elen;
391    ifrp = (struct ifreq *)((char *)ifrp + elen);
392    ifrp++;
393  }
394
395  close(s);
396  return(-1);
397}
398