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 44 static int IfIndex; 45 46 struct rtmsg { 47 struct rt_msghdr m_rtm; 48 char m_space[64]; 49 }; 50 51 static int seqno; 52 53 void 54 OsSetRoute(cmd, dst, gateway, mask) 55 int cmd; 56 struct in_addr dst; 57 struct in_addr gateway; 58 struct 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 119 static void 120 p_sockaddr(sa, width) 121 struct sockaddr *sa; 122 int 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 132 struct 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 148 static void 149 p_flags(f, format) 150 register int f; 151 char *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 163 int 164 ShowRoute() 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 */ 246 void 247 DeleteIfRoutes(all) 248 int 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 351 int 352 GetIfIndex(name) 353 char *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