Annotation of embedaddon/pimdd/routesock.c, revision 1.1
1.1 ! misho 1: /*
! 2: * Copyright (c) 1998 by the University of Southern California.
! 3: * All rights reserved.
! 4: *
! 5: * Permission to use, copy, modify, and distribute this software and
! 6: * its documentation in source and binary forms for lawful
! 7: * purposes and without fee is hereby granted, provided
! 8: * that the above copyright notice appear in all copies and that both
! 9: * the copyright notice and this permission notice appear in supporting
! 10: * documentation, and that any documentation, advertising materials,
! 11: * and other materials related to such distribution and use acknowledge
! 12: * that the software was developed by the University of Southern
! 13: * California and/or Information Sciences Institute.
! 14: * The name of the University of Southern California may not
! 15: * be used to endorse or promote products derived from this software
! 16: * without specific prior written permission.
! 17: *
! 18: * THE UNIVERSITY OF SOUTHERN CALIFORNIA DOES NOT MAKE ANY REPRESENTATIONS
! 19: * ABOUT THE SUITABILITY OF THIS SOFTWARE FOR ANY PURPOSE. THIS SOFTWARE IS
! 20: * PROVIDED "AS IS" AND WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES,
! 21: * INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
! 22: * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE, TITLE, AND
! 23: * NON-INFRINGEMENT.
! 24: *
! 25: * IN NO EVENT SHALL USC, OR ANY OTHER CONTRIBUTOR BE LIABLE FOR ANY
! 26: * SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES, WHETHER IN CONTRACT,
! 27: * TORT, OR OTHER FORM OF ACTION, ARISING OUT OF OR IN CONNECTION WITH,
! 28: * THE USE OR PERFORMANCE OF THIS SOFTWARE.
! 29: *
! 30: * Other copyrights might apply to parts of this software and are so
! 31: * noted when applicable.
! 32: */
! 33: /*
! 34: * Questions concerning this software should be directed to
! 35: * Pavlin Ivanov Radoslavov (pavlin@catarina.usc.edu)
! 36: *
! 37: * $Id: routesock.c,v 1.2 1998/05/29 20:08:57 kurtw Exp $
! 38: */
! 39: /*
! 40: * Part of this program has been derived from mrouted.
! 41: * The mrouted program is covered by the license in the accompanying file
! 42: * named "LICENSE.mrouted".
! 43: *
! 44: * The mrouted program is COPYRIGHT 1989 by The Board of Trustees of
! 45: * Leland Stanford Junior University.
! 46: *
! 47: */
! 48:
! 49: #include <sys/param.h>
! 50: #include <sys/file.h>
! 51: #include "defs.h"
! 52: #include <sys/socket.h>
! 53: #include <net/route.h>
! 54: #ifdef HAVE_ROUTING_SOCKETS
! 55: #include <net/if_dl.h>
! 56: #endif
! 57: #include <arpa/inet.h>
! 58: #include <netdb.h>
! 59: #include <stdlib.h>
! 60:
! 61: #ifdef HAVE_ROUTING_SOCKETS
! 62: union sockunion {
! 63: struct sockaddr sa;
! 64: struct sockaddr_in sin;
! 65: struct sockaddr_dl sdl;
! 66: } so_dst, so_ifp;
! 67: typedef union sockunion *sup;
! 68: int routing_socket;
! 69: int rtm_addrs, pid;
! 70: struct rt_metrics rt_metrics;
! 71: u_long rtm_inits;
! 72:
! 73: /*
! 74: * Local functions definitions.
! 75: */
! 76: static int getmsg __P((register struct rt_msghdr *, int,
! 77: struct rpfctl *rpfinfo));
! 78:
! 79: /*
! 80: * TODO: check again!
! 81: */
! 82: #ifdef IRIX
! 83: #define ROUNDUP(a) ((a) > 0 ? (1 + (((a) - 1) | (sizeof(__uint64_t) - 1))) \
! 84: : sizeof(__uint64_t))
! 85: #else
! 86: #define ROUNDUP(a) ((a) > 0 ? (1 + (((a) - 1) | (sizeof(long) - 1))) \
! 87: : sizeof(long))
! 88: #endif /* IRIX */
! 89:
! 90: #ifdef HAVE_SA_LEN
! 91: #define ADVANCE(x, n) (x += ROUNDUP((n)->sa_len))
! 92: #else
! 93: #define ADVANCE(x, n) (x += ROUNDUP(4)) /* TODO: a hack!! */
! 94: #endif
! 95:
! 96: /* Open and initialize the routing socket */
! 97: int
! 98: init_routesock()
! 99: {
! 100: int off;
! 101:
! 102: pid = getpid();
! 103: routing_socket = socket(PF_ROUTE, SOCK_RAW, 0);
! 104: if (routing_socket < 0) {
! 105: log(LOG_ERR, 0, "\nRouting socket error");
! 106: return -1;
! 107: }
! 108: if (fcntl(routing_socket, F_SETFL, O_NONBLOCK) == -1){
! 109: log(LOG_ERR, 0, "\n Routing socket error");
! 110: return -1;
! 111: }
! 112: if (setsockopt(routing_socket, SOL_SOCKET,
! 113: SO_USELOOPBACK, (char *)&off,
! 114: sizeof(off)) < 0){
! 115: log(LOG_ERR, 0 , "\n setsockopt(SO_USELOOPBACK,0)");
! 116: return -1;
! 117: }
! 118: return 0;
! 119: }
! 120:
! 121:
! 122: struct {
! 123: struct rt_msghdr m_rtm;
! 124: char m_space[512];
! 125: } m_rtmsg;
! 126:
! 127:
! 128: /* get the rpf neighbor info */
! 129: int
! 130: k_req_incoming(source, rpfp)
! 131: u_int32 source;
! 132: struct rpfctl *rpfp;
! 133: {
! 134: int flags = RTF_STATIC;
! 135: register sup su;
! 136: static int seq;
! 137: int rlen;
! 138: register char *cp = m_rtmsg.m_space;
! 139: register int l;
! 140: struct rpfctl rpfinfo;
! 141:
! 142: /* TODO: a hack!!!! */
! 143: #ifdef HAVE_SA_LEN
! 144: #define NEXTADDR(w, u) \
! 145: if (rtm_addrs & (w)) { \
! 146: l = ROUNDUP(u.sa.sa_len); bcopy((char *)&(u), cp, l); cp += l;\
! 147: }
! 148: #else
! 149: #define NEXTADDR(w, u) \
! 150: if (rtm_addrs & (w)) { \
! 151: l = ROUNDUP(4); bcopy((char *)&(u), cp, l); cp += l;\
! 152: }
! 153: #endif /* HAVE_SA_LEN */
! 154:
! 155: /* initialize */
! 156: rpfp->rpfneighbor.s_addr = INADDR_ANY_N;
! 157: rpfp->source.s_addr = source;
! 158:
! 159: /* check if local address or directly connected before calling the
! 160: * routing socket
! 161: */
! 162: if ((rpfp->iif = find_vif_direct_local(source)) != NO_VIF) {
! 163: rpfp->rpfneighbor.s_addr = source;
! 164: return(TRUE);
! 165: }
! 166:
! 167: /* prepare the routing socket params */
! 168: rtm_addrs |= RTA_DST;
! 169: rtm_addrs |= RTA_IFP;
! 170: su = &so_dst;
! 171: su->sin.sin_family = AF_INET;
! 172: #ifdef HAVE_SA_LEN
! 173: su->sin.sin_len = sizeof(struct sockaddr_in);
! 174: #endif
! 175: su->sin.sin_addr.s_addr = source;
! 176: if (inet_lnaof(su->sin.sin_addr) == INADDR_ANY) {
! 177: IF_DEBUG(DEBUG_RPF)
! 178: log(LOG_DEBUG, 0, "k_req_incoming: Invalid source %s",
! 179: inet_fmt(source,s1));
! 180: return(FALSE);
! 181: }
! 182: so_ifp.sa.sa_family = AF_LINK;
! 183: #ifdef HAVE_SA_LEN
! 184: so_ifp.sa.sa_len = sizeof(struct sockaddr_dl);
! 185: #endif
! 186: flags |= RTF_UP;
! 187: flags |= RTF_HOST;
! 188: flags |= RTF_GATEWAY;
! 189: errno = 0;
! 190: bzero((char *)&m_rtmsg, sizeof(m_rtmsg));
! 191:
! 192: #define rtm m_rtmsg.m_rtm
! 193: rtm.rtm_type = RTM_GET;
! 194: rtm.rtm_flags = flags;
! 195: rtm.rtm_version = RTM_VERSION;
! 196: rtm.rtm_seq = ++seq;
! 197: rtm.rtm_addrs = rtm_addrs;
! 198: rtm.rtm_rmx = rt_metrics;
! 199: rtm.rtm_inits = rtm_inits;
! 200:
! 201: NEXTADDR(RTA_DST, so_dst);
! 202: NEXTADDR(RTA_IFP, so_ifp);
! 203: rtm.rtm_msglen = l = cp - (char *)&m_rtmsg;
! 204:
! 205: if ((rlen = write(routing_socket, (char *)&m_rtmsg, l)) < 0) {
! 206: IF_DEBUG(DEBUG_RPF | DEBUG_KERN) {
! 207: if (errno == ESRCH)
! 208: log(LOG_DEBUG, 0,
! 209: "Writing to routing socket: no such route\n");
! 210: else
! 211: log(LOG_DEBUG, 0, "Error writing to routing socket");
! 212: }
! 213: return(FALSE);
! 214: }
! 215:
! 216: do {
! 217: l = read(routing_socket, (char *)&m_rtmsg, sizeof(m_rtmsg));
! 218: } while (l > 0 && (rtm.rtm_seq != seq || rtm.rtm_pid != pid));
! 219:
! 220: if (l < 0) {
! 221: IF_DEBUG(DEBUG_RPF | DEBUG_KERN)
! 222: log(LOG_DEBUG, 0, "Read from routing socket failed");
! 223: return(FALSE);
! 224: }
! 225:
! 226: if (getmsg(&rtm, l, &rpfinfo)){
! 227: rpfp->rpfneighbor.s_addr = rpfinfo.rpfneighbor.s_addr;
! 228: rpfp->iif = rpfinfo.iif;
! 229: }
! 230: #undef rtm
! 231: return (TRUE);
! 232: }
! 233:
! 234:
! 235: /*
! 236: * Returns TRUE on success, FALSE otherwise. rpfinfo contains the result.
! 237: */
! 238: int
! 239: getmsg(rtm, msglen, rpfinfop)
! 240: register struct rt_msghdr *rtm;
! 241: int msglen;
! 242: struct rpfctl *rpfinfop;
! 243: {
! 244: struct sockaddr *dst = NULL, *gate = NULL, *mask = NULL;
! 245: struct sockaddr_dl *ifp = NULL;
! 246: register struct sockaddr *sa;
! 247: register char *cp;
! 248: register int i;
! 249: struct in_addr in;
! 250: vifi_t vifi;
! 251: struct uvif *v;
! 252:
! 253: if (rpfinfop == (struct rpfctl *)NULL)
! 254: return(FALSE);
! 255:
! 256: in = ((struct sockaddr_in *)&so_dst)->sin_addr;
! 257: IF_DEBUG(DEBUG_RPF)
! 258: log(LOG_DEBUG, 0, "route to: %s", inet_fmt(in.s_addr, s1));
! 259: cp = ((char *)(rtm + 1));
! 260: if (rtm->rtm_addrs)
! 261: for (i = 1; i; i <<= 1)
! 262: if (i & rtm->rtm_addrs) {
! 263: sa = (struct sockaddr *)cp;
! 264: switch (i) {
! 265: case RTA_DST:
! 266: dst = sa;
! 267: break;
! 268: case RTA_GATEWAY:
! 269: gate = sa;
! 270: break;
! 271: case RTA_NETMASK:
! 272: mask = sa;
! 273: break;
! 274: case RTA_IFP:
! 275: if (sa->sa_family == AF_LINK &&
! 276: ((struct sockaddr_dl *)sa)->sdl_nlen)
! 277: ifp = (struct sockaddr_dl *)sa;
! 278: break;
! 279: }
! 280: ADVANCE(cp, sa);
! 281: }
! 282:
! 283: if (!ifp){ /* No incoming interface */
! 284: IF_DEBUG(DEBUG_RPF)
! 285: log(LOG_DEBUG, 0,
! 286: "No incoming interface for destination %s",
! 287: inet_fmt(in.s_addr, s1));
! 288: return(FALSE);
! 289: }
! 290: if (dst && mask)
! 291: mask->sa_family = dst->sa_family;
! 292: if (dst) {
! 293: in = ((struct sockaddr_in *)dst)->sin_addr;
! 294: IF_DEBUG(DEBUG_RPF)
! 295: log(LOG_DEBUG, 0, " destination is: %s",
! 296: inet_fmt(in.s_addr, s1));
! 297: }
! 298: if (gate && rtm->rtm_flags & RTF_GATEWAY) {
! 299: in = ((struct sockaddr_in *)gate)->sin_addr;
! 300: IF_DEBUG(DEBUG_RPF)
! 301: log(LOG_DEBUG, 0, " gateway is: %s",
! 302: inet_fmt(in.s_addr, s1));
! 303: rpfinfop->rpfneighbor = in;
! 304: }
! 305:
! 306: for (vifi = 0, v = uvifs; vifi < numvifs; ++vifi, ++v)
! 307: /* get the number of the interface by matching the name */
! 308: if (!(strncmp(v->uv_name,ifp->sdl_data,ifp->sdl_nlen)))
! 309: break;
! 310:
! 311: IF_DEBUG(DEBUG_RPF)
! 312: log(LOG_DEBUG, 0, " iif is %d", vifi);
! 313:
! 314: rpfinfop->iif = vifi;
! 315:
! 316: if (vifi >= numvifs){
! 317: IF_DEBUG(DEBUG_RPF)
! 318: log(LOG_DEBUG, 0, "Invalid incoming interface for destination %s, because of invalid virtual interface", inet_fmt(in.s_addr, s1));
! 319: return(FALSE);/* invalid iif */
! 320: }
! 321:
! 322: return(TRUE);
! 323: }
! 324:
! 325:
! 326: #else /* HAVE_ROUTING_SOCKETS */
! 327:
! 328:
! 329: /*
! 330: * Return in rpfcinfo the incoming interface and the next hop router
! 331: * toward source.
! 332: */
! 333: /* TODO: check whether next hop router address is in network or host order */
! 334: int
! 335: k_req_incoming(source, rpfcinfo)
! 336: u_int32 source;
! 337: struct rpfctl *rpfcinfo;
! 338: {
! 339: rpfcinfo->source.s_addr = source;
! 340: rpfcinfo->iif = NO_VIF; /* just initialized, will be */
! 341: /* changed in kernel */
! 342: rpfcinfo->rpfneighbor.s_addr = INADDR_ANY; /* initialized */
! 343:
! 344: if (ioctl(udp_socket, SIOCGETRPF, (char *) rpfcinfo) < 0){
! 345: log(LOG_ERR, errno, "ioctl SIOCGETRPF k_req_incoming");
! 346: return(FALSE);
! 347: }
! 348: return (TRUE);
! 349: }
! 350: #endif /* HAVE_ROUTING_SOCKETS */
! 351:
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to routesock.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / pimdd