1 /* $KAME: rtsock.c,v 1.3 2000/10/10 08:46:45 itojun Exp $ */ 2 /* $FreeBSD: src/usr.sbin/rtsold/rtsock.c,v 1.1.2.1 2001/07/03 11:02:16 ume Exp $ */ 3 /* $DragonFly: src/usr.sbin/rtsold/rtsock.c,v 1.6 2005/12/05 00:56:37 swildner Exp $ */ 4 5 /* 6 * Copyright (C) 2000 WIDE Project. 7 * All rights reserved. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 3. Neither the name of the project nor the names of its contributors 18 * may be used to endorse or promote products derived from this software 19 * without specific prior written permission. 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 22 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 23 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 24 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 25 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 26 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 27 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 28 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 29 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 30 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31 * SUCH DAMAGE. 32 */ 33 34 #include <sys/param.h> 35 #include <sys/socket.h> 36 #include <sys/uio.h> 37 #include <sys/time.h> 38 #include <sys/queue.h> 39 40 #include <net/if.h> 41 #include <net/route.h> 42 #include <net/if_dl.h> 43 44 #include <netinet/in.h> 45 #include <netinet/ip6.h> 46 #include <netinet/icmp6.h> 47 48 #include <time.h> 49 #include <unistd.h> 50 #include <stdio.h> 51 #include <stddef.h> 52 #include <err.h> 53 #include <errno.h> 54 #include <string.h> 55 #include <stdlib.h> 56 #include <syslog.h> 57 #include "rtsold.h" 58 59 #define ROUNDUP(a, size) \ 60 (((a) & ((size)-1)) ? (1 + ((a) | ((size)-1))) : (a)) 61 62 #define NEXT_SA(ap) (ap) = (struct sockaddr *) \ 63 ((caddr_t)(ap) + \ 64 ((ap)->sa_len ? ROUNDUP((ap)->sa_len, sizeof(u_long)) \ 65 : sizeof(u_long))) 66 67 #ifdef RTM_IFANNOUNCE /*NetBSD 1.5 or later*/ 68 static int rtsock_input_ifannounce(int, struct rt_msghdr *, char *); 69 #endif 70 71 static struct { 72 u_char type; 73 size_t minlen; 74 int (*func)(int, struct rt_msghdr *, char *); 75 } rtsock_dispatch[] = { 76 #ifdef RTM_IFANNOUNCE /*NetBSD 1.5 or later*/ 77 { RTM_IFANNOUNCE, sizeof(struct if_announcemsghdr), 78 rtsock_input_ifannounce }, 79 #endif 80 { 0, 0, NULL }, 81 }; 82 83 int 84 rtsock_open(void) 85 { 86 87 return socket(PF_ROUTE, SOCK_RAW, 0); 88 } 89 90 int 91 rtsock_input(int s) 92 { 93 ssize_t n; 94 char msg[2048]; 95 char *lim, *next; 96 struct rt_msghdr *rtm; 97 int idx; 98 ssize_t len; 99 int ret = 0; 100 const ssize_t lenlim = 101 offsetof(struct rt_msghdr, rtm_msglen) + sizeof(rtm->rtm_msglen); 102 103 n = read(s, msg, sizeof(msg)); 104 105 lim = msg + n; 106 for (next = msg; next < lim; next += len) { 107 rtm = (struct rt_msghdr *)next; 108 if (lim - next < lenlim) 109 break; 110 len = rtm->rtm_msglen; 111 if (len < lenlim) 112 break; 113 114 if (dflag > 1) { 115 warnmsg(LOG_INFO, __func__, 116 "rtmsg type %d, len=%lu", rtm->rtm_type, 117 (u_long)len); 118 } 119 120 for (idx = 0; rtsock_dispatch[idx].func; idx++) { 121 if (rtm->rtm_type != rtsock_dispatch[idx].type) 122 continue; 123 if (rtm->rtm_msglen < rtsock_dispatch[idx].minlen) { 124 warnmsg(LOG_INFO, __func__, 125 "rtmsg type %d too short!", rtm->rtm_type); 126 continue; 127 } 128 129 ret = (*rtsock_dispatch[idx].func)(s, rtm, lim); 130 break; 131 } 132 } 133 134 return ret; 135 } 136 137 #ifdef RTM_IFANNOUNCE /*NetBSD 1.5 or later*/ 138 static int 139 rtsock_input_ifannounce(int s __unused, struct rt_msghdr *rtm, char *lim) 140 { 141 struct if_announcemsghdr *ifan; 142 struct ifinfo *ifinfo; 143 144 ifan = (struct if_announcemsghdr *)rtm; 145 if ((char *)(ifan + 1) > lim) 146 return -1; 147 148 switch (ifan->ifan_what) { 149 case IFAN_ARRIVAL: 150 /* 151 * XXX for NetBSD 1.5, interface index will monotonically be 152 * increased as new pcmcia card gets inserted. 153 * we may be able to do a name-based interface match, 154 * and call ifreconfig() to enable the interface again. 155 */ 156 warnmsg(LOG_INFO, __func__, 157 "interface %s inserted", ifan->ifan_name); 158 break; 159 case IFAN_DEPARTURE: 160 warnmsg(LOG_WARNING, __func__, 161 "interface %s removed", ifan->ifan_name); 162 ifinfo = find_ifinfo(ifan->ifan_index); 163 if (ifinfo) { 164 if (dflag > 1) { 165 warnmsg(LOG_INFO, __func__, 166 "bring interface %s to DOWN state", 167 ifan->ifan_name); 168 } 169 ifinfo->state = IFS_DOWN; 170 } 171 break; 172 } 173 174 return 0; 175 } 176 #endif 177