1 /* 2 * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. Neither the name of the project nor the names of its contributors 14 * may be used to endorse or promote products derived from this software 15 * without specific prior written permission. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 * SUCH DAMAGE. 28 * 29 * $FreeBSD$ 30 */ 31 32 #include <sys/param.h> 33 #include <sys/socket.h> 34 #include <sys/sysctl.h> 35 #include <sys/ioctl.h> 36 37 #include <net/if.h> 38 #include <net/if_var.h> 39 #include <net/if_types.h> 40 #include <net/route.h> 41 #include <net/if_dl.h> 42 #include <net/if_media.h> 43 #include <net/ethernet.h> 44 #include <netinet/in.h> 45 #include <netinet/icmp6.h> 46 47 #include <netinet6/in6_var.h> 48 49 #include <stdio.h> 50 #include <unistd.h> 51 #include <stdlib.h> 52 #include <syslog.h> 53 #include <string.h> 54 #include <fcntl.h> 55 #include <errno.h> 56 #include <kvm.h> 57 #include <nlist.h> 58 #include <limits.h> 59 60 #include "rtsold.h" 61 62 static int ifsock; 63 64 static int getifa __P((char *name, struct in6_ifaddr *ifap)); 65 static void get_rtaddrs __P((int addrs, struct sockaddr *sa, 66 struct sockaddr **rti_info)); 67 68 int 69 ifinit() 70 { 71 if ((ifsock = socket(AF_INET6, SOCK_DGRAM, 0)) < 0) { 72 warnmsg(LOG_ERR, __FUNCTION__, "socket: %s", strerror(errno)); 73 return(-1); 74 } 75 76 return(0); 77 } 78 79 int 80 interface_up(char *name) 81 { 82 struct ifreq ifr; 83 struct in6_ifaddr ifa; 84 85 strncpy(ifr.ifr_name, name, sizeof(ifr.ifr_name)); 86 87 if (ioctl(ifsock, SIOCGIFFLAGS, (caddr_t)&ifr) < 0) { 88 warnmsg(LOG_WARNING, __FUNCTION__, "ioctl(SIOCGIFFLAGS): %s", 89 strerror(errno)); 90 return(-1); 91 } 92 if (!(ifr.ifr_flags & IFF_UP)) { 93 ifr.ifr_flags |= IFF_UP; 94 if (ioctl(ifsock, SIOCSIFFLAGS, (caddr_t)&ifr) < 0) { 95 warnmsg(LOG_ERR, __FUNCTION__, 96 "ioctl(SIOCSIFFLAGS): %s", strerror(errno)); 97 } 98 return(-1); 99 } 100 101 warnmsg(LOG_DEBUG, __FUNCTION__, "checking if %s is ready...", name); 102 103 if (getifa(name, &ifa) < 0) { 104 warnmsg(LOG_WARNING, __FUNCTION__, 105 "getifa() failed, anyway I'll try"); 106 return 0; 107 } 108 109 if (!(ifa.ia6_flags & IN6_IFF_NOTREADY)) { 110 warnmsg(LOG_DEBUG, __FUNCTION__, 111 "%s is ready", name); 112 return(0); 113 } 114 else { 115 if (ifa.ia6_flags & IN6_IFF_TENTATIVE) { 116 warnmsg(LOG_DEBUG, __FUNCTION__, "%s is tentative", 117 name); 118 return IFS_TENTATIVE; 119 } 120 if (ifa.ia6_flags & IN6_IFF_DUPLICATED) 121 warnmsg(LOG_DEBUG, __FUNCTION__, "%s is duplicated", 122 name); 123 return -1; 124 } 125 } 126 127 int 128 interface_status(struct ifinfo *ifinfo) 129 { 130 char *ifname = ifinfo->ifname; 131 struct ifreq ifr; 132 struct ifmediareq ifmr; 133 134 /* get interface flags */ 135 memset(&ifr, 0, sizeof(ifr)); 136 strncpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name)); 137 if (ioctl(ifsock, SIOCGIFFLAGS, &ifr) < 0) { 138 warnmsg(LOG_ERR, __FUNCTION__, "ioctl(SIOCGIFFLAGS) on %s: %s", 139 ifname, strerror(errno)); 140 return(-1); 141 } 142 /* 143 * if one of UP and RUNNING flags is dropped, 144 * the interface is not active. 145 */ 146 if ((ifr.ifr_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) { 147 goto inactive; 148 } 149 150 /* Next, check carrier on the interface, if possible */ 151 if (!ifinfo->mediareqok) 152 goto active; 153 memset(&ifmr, 0, sizeof(ifmr)); 154 strncpy(ifmr.ifm_name, ifname, sizeof(ifmr.ifm_name)); 155 156 if (ioctl(ifsock, SIOCGIFMEDIA, (caddr_t)&ifmr) < 0) { 157 if (errno != EINVAL) { 158 warnmsg(LOG_DEBUG, __FUNCTION__, 159 "ioctl(SIOCGIFMEDIA) on %s: %s", 160 ifname, strerror(errno)); 161 return(-1); 162 } 163 /* 164 * EINVAL simply means that the interface does not support 165 * the SIOCGIFMEDIA ioctl. We regard it alive. 166 */ 167 ifinfo->mediareqok = 0; 168 goto active; 169 } 170 171 if (ifmr.ifm_status & IFM_AVALID) { 172 switch(ifmr.ifm_active & IFM_NMASK) { 173 case IFM_ETHER: 174 if (ifmr.ifm_status & IFM_ACTIVE) 175 goto active; 176 else 177 goto inactive; 178 break; 179 default: 180 goto inactive; 181 } 182 } 183 184 inactive: 185 return(0); 186 187 active: 188 return(1); 189 } 190 191 #define ROUNDUP(a, size) \ 192 (((a) & ((size)-1)) ? (1 + ((a) | ((size)-1))) : (a)) 193 194 #define NEXT_SA(ap) (ap) = (struct sockaddr *) \ 195 ((caddr_t)(ap) + ((ap)->sa_len ? ROUNDUP((ap)->sa_len,\ 196 sizeof(u_long)) :\ 197 sizeof(u_long))) 198 #define ROUNDUP8(a) (1 + (((a) - 1) | 7)) 199 200 int 201 lladdropt_length(struct sockaddr_dl *sdl) 202 { 203 switch(sdl->sdl_type) { 204 case IFT_ETHER: 205 return(ROUNDUP8(ETHER_ADDR_LEN + 2)); 206 default: 207 return(0); 208 } 209 } 210 211 void 212 lladdropt_fill(struct sockaddr_dl *sdl, struct nd_opt_hdr *ndopt) 213 { 214 char *addr; 215 216 ndopt->nd_opt_type = ND_OPT_SOURCE_LINKADDR; /* fixed */ 217 218 switch(sdl->sdl_type) { 219 case IFT_ETHER: 220 ndopt->nd_opt_len = (ROUNDUP8(ETHER_ADDR_LEN + 2)) >> 3; 221 addr = (char *)(ndopt + 1); 222 memcpy(addr, LLADDR(sdl), ETHER_ADDR_LEN); 223 break; 224 default: 225 warnmsg(LOG_ERR, __FUNCTION__, 226 "unsupported link type(%d)", sdl->sdl_type); 227 exit(1); 228 } 229 230 return; 231 } 232 233 struct sockaddr_dl * 234 if_nametosdl(char *name) 235 { 236 int mib[6] = {CTL_NET, AF_ROUTE, 0, 0, NET_RT_IFLIST, 0}; 237 char *buf, *next, *lim; 238 size_t len; 239 struct if_msghdr *ifm; 240 struct sockaddr *sa, *rti_info[RTAX_MAX]; 241 struct sockaddr_dl *sdl = NULL, *ret_sdl; 242 243 if (sysctl(mib, 6, NULL, &len, NULL, 0) < 0) 244 return(NULL); 245 if ((buf = malloc(len)) == NULL) 246 return(NULL); 247 if (sysctl(mib, 6, buf, &len, NULL, 0) < 0) { 248 free(buf); 249 return(NULL); 250 } 251 252 lim = buf + len; 253 for (next = buf; next < lim; next += ifm->ifm_msglen) { 254 ifm = (struct if_msghdr *)next; 255 if (ifm->ifm_type == RTM_IFINFO) { 256 sa = (struct sockaddr *)(ifm + 1); 257 get_rtaddrs(ifm->ifm_addrs, sa, rti_info); 258 if ((sa = rti_info[RTAX_IFP]) != NULL) { 259 if (sa->sa_family == AF_LINK) { 260 sdl = (struct sockaddr_dl *)sa; 261 if (strncmp(&sdl->sdl_data[0], 262 name, 263 sdl->sdl_nlen) == 0) { 264 break; 265 } 266 } 267 } 268 } 269 } 270 if (next == lim) { 271 /* search failed */ 272 free(buf); 273 return(NULL); 274 } 275 276 if ((ret_sdl = malloc(sdl->sdl_len)) == NULL) 277 return(NULL); 278 memcpy((caddr_t)ret_sdl, (caddr_t)sdl, sdl->sdl_len); 279 280 return(ret_sdl); 281 } 282 283 int 284 getinet6sysctl(int code) 285 { 286 int mib[] = { CTL_NET, PF_INET6, IPPROTO_IPV6, 0 }; 287 int value; 288 size_t size; 289 290 mib[3] = code; 291 size = sizeof(value); 292 if (sysctl(mib, sizeof(mib)/sizeof(mib[0]), &value, &size, NULL, 0) < 0) 293 return -1; 294 else 295 return value; 296 } 297 298 /*------------------------------------------------------------*/ 299 300 static struct nlist nl[] = { 301 #define N_IFNET 0 302 { "_ifnet" }, 303 { "" }, 304 }; 305 306 #define KREAD(x, y, z) { \ 307 if (kvm_read(kvmd, (u_long)x, (void *)y, sizeof(z)) != sizeof(z)) { \ 308 warnmsg(LOG_ERR, __FUNCTION__, "kvm_read failed"); \ 309 goto bad; \ 310 } \ 311 } 312 313 static int 314 getifa(char *name, struct in6_ifaddr *ifap) 315 { 316 u_short index; 317 kvm_t *kvmd = NULL; 318 char buf[_POSIX2_LINE_MAX]; 319 struct ifnet *ifp; 320 struct ifnet ifnet; 321 struct in6_ifaddr *ifa; 322 323 if (!ifap) 324 exit(1); 325 326 index = (u_short)if_nametoindex(name); 327 if (index == 0) { 328 warnmsg(LOG_ERR, __FUNCTION__, "if_nametoindex failed for %s", 329 name); 330 goto bad; 331 } 332 if ((kvmd = kvm_openfiles(NULL, NULL, NULL, O_RDONLY, buf)) == NULL) { 333 warnmsg(LOG_ERR, __FUNCTION__, "kvm_openfiles failed"); 334 goto bad; 335 } 336 if (kvm_nlist(kvmd, nl) < 0) { 337 warnmsg(LOG_ERR, __FUNCTION__, "kvm_nlist failed"); 338 goto bad; 339 } 340 if (nl[N_IFNET].n_value == 0) { 341 warnmsg(LOG_ERR, __FUNCTION__, "symbol \"%s\" not found", 342 nl[N_IFNET].n_name); 343 goto bad; 344 } 345 346 KREAD(nl[N_IFNET].n_value, &ifp, struct ifnet *); 347 while (ifp) { 348 KREAD(ifp, &ifnet, struct ifnet); 349 if (ifnet.if_index == index) 350 break; 351 ifp = TAILQ_NEXT(&ifnet, if_link); 352 } 353 if (!ifp) { 354 warnmsg(LOG_ERR, __FUNCTION__, "interface \"%s\" not found", 355 name); 356 goto bad; 357 } 358 359 ifa = (struct in6_ifaddr *)TAILQ_FIRST(&ifnet.if_addrhead); 360 while (ifa) { 361 KREAD(ifa, ifap, *ifap); 362 if (ifap->ia_addr.sin6_family == AF_INET6 363 && IN6_IS_ADDR_LINKLOCAL(&ifap->ia_addr.sin6_addr)) { 364 kvm_close(kvmd); 365 return 0; 366 } 367 368 ifa = (struct in6_ifaddr *) 369 TAILQ_NEXT((struct ifaddr *)ifap, ifa_link); 370 } 371 warnmsg(LOG_ERR, __FUNCTION__, "no IPv6 link-local address for %s", 372 name); 373 374 bad: 375 if (kvmd) 376 kvm_close(kvmd); 377 return -1; 378 } 379 380 static void 381 get_rtaddrs(int addrs, struct sockaddr *sa, struct sockaddr **rti_info) 382 { 383 int i; 384 385 for (i = 0; i < RTAX_MAX; i++) { 386 if (addrs & (1 << i)) { 387 rti_info[i] = sa; 388 NEXT_SA(sa); 389 } 390 else 391 rti_info[i] = NULL; 392 } 393 } 394