Annotation of embedaddon/pimd/routesock.c, revision 1.1.1.1
1.1 misho 1: /*
2: * Copyright (c) 1998-2001
3: * University of Southern California/Information Sciences Institute.
4: * All rights reserved.
5: *
6: * Redistribution and use in source and binary forms, with or without
7: * modification, are permitted provided that the following conditions
8: * are met:
9: * 1. Redistributions of source code must retain the above copyright
10: * notice, this list of conditions and the following disclaimer.
11: * 2. Redistributions in binary form must reproduce the above copyright
12: * notice, this list of conditions and the following disclaimer in the
13: * documentation and/or other materials provided with the distribution.
14: * 3. Neither the name of the project nor the names of its contributors
15: * may be used to endorse or promote products derived from this software
16: * without specific prior written permission.
17: *
18: * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
19: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21: * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
22: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28: * SUCH DAMAGE.
29: */
30: /*
31: * Part of this program has been derived from mrouted.
32: * The mrouted program is covered by the license in the accompanying file
33: * named "LICENSE.mrouted".
34: *
35: * The mrouted program is COPYRIGHT 1989 by The Board of Trustees of
36: * Leland Stanford Junior University.
37: *
38: */
39:
40: #include <sys/param.h>
41: #include <sys/file.h>
42: #include "defs.h"
43: #include <sys/socket.h>
44: #include <net/route.h>
45: #ifdef HAVE_ROUTING_SOCKETS
46: #include <net/if_dl.h>
47: #endif
48: #include <arpa/inet.h>
49: #include <netdb.h>
50: #include <stdlib.h>
51:
52: /* All the BSDs have routing sockets (not Netlink), but only Linux seems
53: * to have SIOCGETRPF, which is used in the #else below ... the original
54: * authors wanted to merge routesock.c and netlink.c, but I don't know
55: * anymore. --Joachim */
56: #ifdef HAVE_ROUTING_SOCKETS
57: union sockunion {
58: struct sockaddr sa;
59: struct sockaddr_in sin;
60: struct sockaddr_dl sdl;
61: } so_dst, so_ifp;
62: typedef union sockunion *sup;
63: int routing_socket = -1;
64: int rtm_addrs;
65: static pid_t pid;
66: struct rt_metrics rt_metrics;
67: uint32_t rtm_inits;
68:
69: struct {
70: struct rt_msghdr m_rtm;
71: char m_space[512];
72: } m_rtmsg;
73:
74: /*
75: * Local functions definitions.
76: */
77: static int getmsg(struct rt_msghdr *, int, 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(sizeof(*(n)))) /* XXX: sizeof(struct sockaddr) */
94: #endif
95:
96: /* Open and initialize the routing socket */
97: int init_routesock(void)
98: {
99: #if 0
100: int on = 0;
101: #endif
102:
103: routing_socket = socket(PF_ROUTE, SOCK_RAW, 0);
104: if (routing_socket < 0) {
105: logit(LOG_ERR, errno, "Failed creating routing socket");
106: return -1;
107: }
108:
109: if (fcntl(routing_socket, F_SETFL, O_NONBLOCK) == -1) {
110: logit(LOG_ERR, errno, "Failed setting routing socket as non-blocking");
111: return -1;
112: }
113:
114: #if 0
115: /* XXX: if it is OFF, no queries will succeed (!?) */
116: if (setsockopt(routing_socket, SOL_SOCKET, SO_USELOOPBACK, (char *)&on, sizeof(on)) < 0) {
117: logit(LOG_ERR, errno , "setsockopt(SO_USELOOPBACK, 0)");
118: return -1;
119: }
120: #endif
121:
122: return 0;
123: }
124:
125: /* get the rpf neighbor info */
126: int k_req_incoming(uint32_t source, struct rpfctl *rpfp)
127: {
128: int rlen, l, flags = RTF_STATIC, retry_count = 3;
129: sup su;
130: static int seq;
131: char *cp = m_rtmsg.m_space;
132: struct rpfctl rpfinfo;
133:
134: /* TODO: a hack!!!! */
135: #ifdef HAVE_SA_LEN
136: #define NEXTADDR(w, u) \
137: if (rtm_addrs & (w)) { \
138: l = ROUNDUP(u.sa.sa_len); \
139: memcpy(cp, &(u), l); \
140: cp += l; \
141: }
142: #else
143: #define NEXTADDR(w, u) \
144: if (rtm_addrs & (w)) { \
145: l = ROUNDUP(sizeof(struct sockaddr)); \
146: memcpy(cp, &(u), l); \
147: cp += l; \
148: }
149: #endif /* HAVE_SA_LEN */
150:
151: /* initialize */
152: rpfp->rpfneighbor.s_addr = INADDR_ANY_N;
153: rpfp->source.s_addr = source;
154:
155: /* check if local address or directly connected before calling the
156: * routing socket
157: */
158: if ((rpfp->iif = find_vif_direct_local(source)) != NO_VIF) {
159: rpfp->rpfneighbor.s_addr = source;
160: return TRUE;
161: }
162:
163: /* prepare the routing socket params */
164: rtm_addrs |= RTA_DST;
165: rtm_addrs |= RTA_IFP;
166: su = &so_dst;
167: su->sin.sin_family = AF_INET;
168: #ifdef HAVE_SA_LEN
169: su->sin.sin_len = sizeof(struct sockaddr_in);
170: #endif
171: su->sin.sin_addr.s_addr = source;
172:
173: if (inet_lnaof(su->sin.sin_addr) == INADDR_ANY) {
174: IF_DEBUG(DEBUG_RPF) {
175: logit(LOG_DEBUG, 0, "k_req_incoming: Invalid source %s",
176: inet_fmt(source, s1, sizeof(s1)));
177: }
178:
179: return FALSE;
180: }
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: memset (&m_rtmsg, 0, 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: rlen = write(routing_socket, &m_rtmsg, l);
206: if (rlen <= 0) {
207: IF_DEBUG(DEBUG_RPF | DEBUG_KERN) {
208: if (errno == ESRCH)
209: logit(LOG_DEBUG, 0, "Writing to routing socket: no such route");
210: else
211: logit(LOG_DEBUG, 0, "Error writing to routing socket");
212: }
213:
214: return FALSE;
215: }
216:
217: pid = getpid();
218:
219: while (1) {
220: rlen = read(routing_socket, &m_rtmsg, sizeof(m_rtmsg));
221: if (rlen < 0) {
222: if (errno == EINTR)
223: continue; /* Signalled, retry syscall. */
224: if (errno == EAGAIN && retry_count--) {
225: logit(LOG_DEBUG, 0, "Kernel busy, retrying (%d/3) routing socket read in one sec ...", 3 - retry_count);
226: sleep(1);
227: continue;
228: }
229:
230: IF_DEBUG(DEBUG_RPF | DEBUG_KERN)
231: logit(LOG_DEBUG, errno, "Read from routing socket failed");
232:
233: return FALSE;
234: }
235:
236: if (rlen > 0 && (rtm.rtm_seq != seq || rtm.rtm_pid != pid))
237: continue;
238:
239: break;
240: }
241:
242: memset(&rpfinfo, 0, sizeof(rpfinfo));
243: if (getmsg(&rtm, l, &rpfinfo)) {
244: rpfp->rpfneighbor.s_addr = rpfinfo.rpfneighbor.s_addr;
245: rpfp->iif = rpfinfo.iif;
246: }
247: #undef rtm
248:
249: return TRUE;
250: }
251:
252: static void find_sockaddrs(struct rt_msghdr *rtm, struct sockaddr **dst, struct sockaddr **gate,
253: struct sockaddr **mask, struct sockaddr_dl **ifp)
254: {
255: int i;
256: char *cp = (char *)(rtm + 1);
257: struct sockaddr *sa;
258:
259: if (rtm->rtm_addrs) {
260: for (i = 1; i; i <<= 1) {
261: if (i & rtm->rtm_addrs) {
262: sa = (struct sockaddr *)cp;
263:
264: switch (i) {
265: case RTA_DST:
266: *dst = sa;
267: break;
268:
269: case RTA_GATEWAY:
270: *gate = sa;
271: break;
272:
273: case RTA_NETMASK:
274: *mask = sa;
275: break;
276:
277: case RTA_IFP:
278: if (sa->sa_family == AF_LINK && ((struct sockaddr_dl *)sa)->sdl_nlen)
279: *ifp = (struct sockaddr_dl *)sa;
280: break;
281: }
282: ADVANCE(cp, sa);
283: }
284: }
285: }
286: }
287:
288: /*
289: * Returns TRUE on success, FALSE otherwise. rpfinfo contains the result.
290: */
291: static int getmsg(struct rt_msghdr *rtm, int msglen __attribute__((unused)), struct rpfctl *rpf)
292: {
293: struct sockaddr *dst = NULL, *gate = NULL, *mask = NULL;
294: struct sockaddr_dl *ifp = NULL;
295: struct in_addr in;
296: vifi_t vifi;
297: struct uvif *v;
298:
299: if (!rpf) {
300: logit(LOG_WARNING, 0, "Missing rpf pointer to routesock.c:getmsg()!");
301: return FALSE;
302: }
303:
304: rpf->iif = NO_VIF;
305: rpf->rpfneighbor.s_addr = INADDR_ANY;
306:
307: in = ((struct sockaddr_in *)&so_dst)->sin_addr;
308: IF_DEBUG(DEBUG_RPF)
309: logit(LOG_DEBUG, 0, "route to: %s", inet_fmt(in.s_addr, s1, sizeof(s1)));
310:
311: find_sockaddrs(rtm, &dst, &gate, &mask, &ifp);
312:
313: if (!ifp) { /* No incoming interface */
314: IF_DEBUG(DEBUG_RPF)
315: logit(LOG_DEBUG, 0, "No incoming interface for destination %s", inet_fmt(in.s_addr, s1, sizeof(s1)));
316:
317: return FALSE;
318: }
319:
320: if (dst && mask)
321: mask->sa_family = dst->sa_family;
322:
323: if (dst) {
324: in = ((struct sockaddr_in *)dst)->sin_addr;
325: IF_DEBUG(DEBUG_RPF)
326: logit(LOG_DEBUG, 0, " destination is: %s", inet_fmt(in.s_addr, s1, sizeof(s1)));
327: }
328:
329: if (gate && (rtm->rtm_flags & RTF_GATEWAY)) {
330: in = ((struct sockaddr_in *)gate)->sin_addr;
331: IF_DEBUG(DEBUG_RPF)
332: logit(LOG_DEBUG, 0, " gateway is: %s", inet_fmt(in.s_addr, s1, sizeof(s1)));
333:
334: rpf->rpfneighbor = in;
335: }
336:
337: for (vifi = 0, v = uvifs; vifi < numvifs; ++vifi, ++v) {
338: /* get the number of the interface by matching the name */
339: if ((strlen(v->uv_name) == ifp->sdl_nlen)
340: && !(strncmp(v->uv_name, ifp->sdl_data, ifp->sdl_nlen)))
341: break;
342: }
343:
344: /* Found inbound interface in vifi */
345: rpf->iif = vifi;
346:
347: IF_DEBUG(DEBUG_RPF)
348: logit(LOG_DEBUG, 0, " iif is %d", vifi);
349:
350: if (vifi >= numvifs) {
351: IF_DEBUG(DEBUG_RPF)
352: logit(LOG_DEBUG, 0, "Invalid incoming interface for destination %s, because of invalid virtual interface",
353: inet_fmt(in.s_addr, s1, sizeof(s1)));
354:
355: return FALSE; /* invalid iif */
356: }
357:
358: return TRUE;
359: }
360:
361:
362: #else /* !HAVE_ROUTING_SOCKETS -- if we want to run on Linux without Netlink */
363:
364: /* API compat dummy. */
365: int init_routesock(void)
366: {
367: return dup(udp_socket);
368: }
369:
370: /*
371: * Return in rpfcinfo the incoming interface and the next hop router
372: * toward source.
373: */
374: /* TODO: check whether next hop router address is in network or host order */
375: int k_req_incoming(uint32_t source, struct rpfctl *rpfcinfo)
376: {
377: rpfcinfo->source.s_addr = source;
378: rpfcinfo->iif = NO_VIF; /* Initialize, will be changed in kernel */
379: rpfcinfo->rpfneighbor.s_addr = INADDR_ANY; /* Initialize */
380:
381: if (ioctl(udp_socket, SIOCGETRPF, (char *) rpfcinfo) < 0) {
382: logit(LOG_WARNING, errno, "Failed ioctl SIOCGETRPF in k_req_incoming()");
383: return FALSE;
384: }
385:
386: return TRUE;
387: }
388: #endif /* HAVE_ROUTING_SOCKETS */
389:
390: /**
391: * Local Variables:
392: * version-control: t
393: * indent-tabs-mode: t
394: * c-file-style: "ellemtel"
395: * c-basic-offset: 4
396: * End:
397: */
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 / pimd