| File: | src/usr.sbin/dhcrelay6/dispatch.c |
| Warning: | line 324, column 15 Use of zero-allocated memory |
Press '?' to see keyboard shortcuts
Keyboard shortcuts:
| 1 | /* $OpenBSD: dispatch.c,v 1.2 2021/01/17 13:41:24 claudio Exp $ */ | |||
| 2 | ||||
| 3 | /* | |||
| 4 | * Copyright 2004 Henning Brauer <henning@openbsd.org> | |||
| 5 | * Copyright (c) 1995, 1996, 1997, 1998, 1999 | |||
| 6 | * The Internet Software Consortium. All rights reserved. | |||
| 7 | * | |||
| 8 | * Redistribution and use in source and binary forms, with or without | |||
| 9 | * modification, are permitted provided that the following conditions | |||
| 10 | * are met: | |||
| 11 | * | |||
| 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 Internet Software Consortium nor the names | |||
| 18 | * of its contributors may be used to endorse or promote products derived | |||
| 19 | * from this software without specific prior written permission. | |||
| 20 | * | |||
| 21 | * THIS SOFTWARE IS PROVIDED BY THE INTERNET SOFTWARE CONSORTIUM AND | |||
| 22 | * CONTRIBUTORS ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, | |||
| 23 | * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF | |||
| 24 | * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE | |||
| 25 | * DISCLAIMED. IN NO EVENT SHALL THE INTERNET SOFTWARE CONSORTIUM OR | |||
| 26 | * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, | |||
| 27 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | |||
| 28 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF | |||
| 29 | * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND | |||
| 30 | * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, | |||
| 31 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT | |||
| 32 | * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF | |||
| 33 | * SUCH DAMAGE. | |||
| 34 | * | |||
| 35 | * This software has been written for the Internet Software Consortium | |||
| 36 | * by Ted Lemon <mellon@fugue.com> in cooperation with Vixie | |||
| 37 | * Enterprises. To learn more about the Internet Software Consortium, | |||
| 38 | * see ``http://www.vix.com/isc''. To learn more about Vixie | |||
| 39 | * Enterprises, see ``http://www.vix.com''. | |||
| 40 | */ | |||
| 41 | ||||
| 42 | #include <sys/types.h> | |||
| 43 | #include <sys/ioctl.h> | |||
| 44 | #include <sys/socket.h> | |||
| 45 | ||||
| 46 | #include <net/if.h> | |||
| 47 | #include <net/if_dl.h> | |||
| 48 | #include <net/if_media.h> | |||
| 49 | #include <net/if_types.h> | |||
| 50 | ||||
| 51 | #include <netinet/in.h> | |||
| 52 | #include <netinet/if_ether.h> | |||
| 53 | ||||
| 54 | #include <errno(*__errno()).h> | |||
| 55 | #include <ifaddrs.h> | |||
| 56 | #include <limits.h> | |||
| 57 | #include <poll.h> | |||
| 58 | #include <stdlib.h> | |||
| 59 | #include <string.h> | |||
| 60 | #include <syslog.h> | |||
| 61 | #include <time.h> | |||
| 62 | #include <unistd.h> | |||
| 63 | ||||
| 64 | #include "dhcp.h" | |||
| 65 | #include "dhcpd.h" | |||
| 66 | #include "log.h" | |||
| 67 | ||||
| 68 | /* | |||
| 69 | * Macros implementation used to generate link-local addresses. This | |||
| 70 | * code was copied from: sys/netinet6/in6_ifattach.c. | |||
| 71 | */ | |||
| 72 | #define EUI64_UBIT0x02 0x02 | |||
| 73 | #define EUI64_TO_IFID(in6)do { (in6)->__u6_addr.__u6_addr8[8] ^= 0x02; } while (0) \ | |||
| 74 | do { (in6)->s6_addr__u6_addr.__u6_addr8[8] ^= EUI64_UBIT0x02; } while (0) | |||
| 75 | ||||
| 76 | struct protocol *protocols; | |||
| 77 | struct timeout *timeouts; | |||
| 78 | static struct timeout *free_timeouts; | |||
| 79 | static int interfaces_invalidated; | |||
| 80 | ||||
| 81 | void (*bootp_packet_handler)(struct interface_info *, | |||
| 82 | void *, size_t, struct packet_ctx *); | |||
| 83 | ||||
| 84 | static int interface_status(struct interface_info *ifinfo); | |||
| 85 | ||||
| 86 | struct interface_info * | |||
| 87 | iflist_getbyindex(unsigned int index) | |||
| 88 | { | |||
| 89 | struct interface_info *intf; | |||
| 90 | ||||
| 91 | TAILQ_FOREACH(intf, &intflist, entry)for((intf) = ((&intflist)->tqh_first); (intf) != ((void *)0); (intf) = ((intf)->entry.tqe_next)) { | |||
| 92 | if (intf->index != index) | |||
| 93 | continue; | |||
| 94 | ||||
| 95 | return intf; | |||
| 96 | } | |||
| 97 | ||||
| 98 | return NULL((void *)0); | |||
| 99 | } | |||
| 100 | ||||
| 101 | struct interface_info * | |||
| 102 | iflist_getbyname(const char *name) | |||
| 103 | { | |||
| 104 | struct interface_info *intf; | |||
| 105 | ||||
| 106 | TAILQ_FOREACH(intf, &intflist, entry)for((intf) = ((&intflist)->tqh_first); (intf) != ((void *)0); (intf) = ((intf)->entry.tqe_next)) { | |||
| 107 | if (strcmp(intf->name, name) != 0) | |||
| 108 | continue; | |||
| 109 | ||||
| 110 | return intf; | |||
| 111 | } | |||
| 112 | ||||
| 113 | return NULL((void *)0); | |||
| 114 | } | |||
| 115 | ||||
| 116 | struct interface_info * | |||
| 117 | iflist_getbyaddr6(struct in6_addr *addr) | |||
| 118 | { | |||
| 119 | struct interface_info *intf; | |||
| 120 | ||||
| 121 | TAILQ_FOREACH(intf, &intflist, entry)for((intf) = ((&intflist)->tqh_first); (intf) != ((void *)0); (intf) = ((intf)->entry.tqe_next)) { | |||
| 122 | /* Look for link-layer address. */ | |||
| 123 | if (memcmp(&intf->linklocal, addr, sizeof(*addr)) == 0) | |||
| 124 | return intf; | |||
| 125 | } | |||
| 126 | ||||
| 127 | return NULL((void *)0); | |||
| 128 | } | |||
| 129 | ||||
| 130 | void | |||
| 131 | setup_iflist(void) | |||
| 132 | { | |||
| 133 | struct interface_info *intf; | |||
| 134 | struct sockaddr_dl *sdl; | |||
| 135 | struct ifaddrs *ifap, *ifa; | |||
| 136 | struct if_data *ifi; | |||
| 137 | struct sockaddr_in *sin; | |||
| 138 | struct sockaddr_in6 *sin6; | |||
| 139 | ||||
| 140 | TAILQ_INIT(&intflist)do { (&intflist)->tqh_first = ((void *)0); (&intflist )->tqh_last = &(&intflist)->tqh_first; } while ( 0); | |||
| 141 | if (getifaddrs(&ifap)) | |||
| 142 | fatalx("getifaddrs failed"); | |||
| 143 | ||||
| 144 | for (ifa = ifap; ifa != NULL((void *)0); ifa = ifa->ifa_next) { | |||
| 145 | if ((ifa->ifa_flags & IFF_LOOPBACK0x8) || | |||
| 146 | (ifa->ifa_flags & IFF_POINTOPOINT0x10)) | |||
| 147 | continue; | |||
| 148 | ||||
| 149 | /* Find interface or create it. */ | |||
| 150 | intf = iflist_getbyname(ifa->ifa_name); | |||
| 151 | if (intf == NULL((void *)0)) { | |||
| 152 | intf = calloc(1, sizeof(*intf)); | |||
| 153 | if (intf == NULL((void *)0)) | |||
| 154 | fatal("calloc"); | |||
| 155 | ||||
| 156 | strlcpy(intf->name, ifa->ifa_name, | |||
| 157 | sizeof(intf->name)); | |||
| 158 | TAILQ_INSERT_HEAD(&intflist, intf, entry)do { if (((intf)->entry.tqe_next = (&intflist)->tqh_first ) != ((void *)0)) (&intflist)->tqh_first->entry.tqe_prev = &(intf)->entry.tqe_next; else (&intflist)->tqh_last = &(intf)->entry.tqe_next; (&intflist)->tqh_first = (intf); (intf)->entry.tqe_prev = &(&intflist)-> tqh_first; } while (0); | |||
| 159 | } | |||
| 160 | ||||
| 161 | /* Signal disabled interface. */ | |||
| 162 | if ((ifa->ifa_flags & IFF_UP0x1) == 0) | |||
| 163 | intf->dead = 1; | |||
| 164 | ||||
| 165 | if (ifa->ifa_addr->sa_family == AF_LINK18) { | |||
| 166 | sdl = (struct sockaddr_dl *)ifa->ifa_addr; | |||
| 167 | ifi = (struct if_data *)ifa->ifa_data; | |||
| 168 | ||||
| 169 | /* Skip non ethernet interfaces. */ | |||
| 170 | if (ifi->ifi_type != IFT_ETHER0x06 && | |||
| 171 | ifi->ifi_type != IFT_ENC0xf4) { | |||
| 172 | TAILQ_REMOVE(&intflist, intf, entry)do { if (((intf)->entry.tqe_next) != ((void *)0)) (intf)-> entry.tqe_next->entry.tqe_prev = (intf)->entry.tqe_prev ; else (&intflist)->tqh_last = (intf)->entry.tqe_prev ; *(intf)->entry.tqe_prev = (intf)->entry.tqe_next; ; ; } while (0); | |||
| 173 | free(intf); | |||
| 174 | continue; | |||
| 175 | } | |||
| 176 | ||||
| 177 | intf->index = sdl->sdl_index; | |||
| 178 | intf->hw_address.hlen = sdl->sdl_alen; | |||
| 179 | memcpy(intf->hw_address.haddr, | |||
| 180 | LLADDR(sdl)((caddr_t)((sdl)->sdl_data + (sdl)->sdl_nlen)), sdl->sdl_alen); | |||
| 181 | } else if (ifa->ifa_addr->sa_family == AF_INET2) { | |||
| 182 | sin = (struct sockaddr_in *)ifa->ifa_addr; | |||
| 183 | if (sin->sin_addr.s_addr == htonl(INADDR_LOOPBACK)(__uint32_t)(__builtin_constant_p(((u_int32_t)(0x7f000001))) ? (__uint32_t)(((__uint32_t)(((u_int32_t)(0x7f000001))) & 0xff ) << 24 | ((__uint32_t)(((u_int32_t)(0x7f000001))) & 0xff00) << 8 | ((__uint32_t)(((u_int32_t)(0x7f000001)) ) & 0xff0000) >> 8 | ((__uint32_t)(((u_int32_t)(0x7f000001 ))) & 0xff000000) >> 24) : __swap32md(((u_int32_t)( 0x7f000001)))) || | |||
| 184 | intf->primary_address.s_addr != INADDR_ANY((u_int32_t)(0x00000000))) | |||
| 185 | continue; | |||
| 186 | ||||
| 187 | intf->primary_address = sin->sin_addr; | |||
| 188 | } else if (ifa->ifa_addr->sa_family == AF_INET624) { | |||
| 189 | sin6 = (struct sockaddr_in6 *)ifa->ifa_addr; | |||
| 190 | if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr)(((&sin6->sin6_addr)->__u6_addr.__u6_addr8[0] == 0xfe ) && (((&sin6->sin6_addr)->__u6_addr.__u6_addr8 [1] & 0xc0) == 0x80))) { | |||
| 191 | intf->linklocal = sin6->sin6_addr; | |||
| 192 | #ifdef __KAME__ | |||
| 193 | /* | |||
| 194 | * Remove possible scope from address if | |||
| 195 | * link-local. | |||
| 196 | */ | |||
| 197 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[2] = 0; | |||
| 198 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[3] = 0; | |||
| 199 | #endif | |||
| 200 | } else | |||
| 201 | intf->gipv6 = 1; | |||
| 202 | ||||
| 203 | /* At least one IPv6 address was found. */ | |||
| 204 | intf->ipv6 = 1; | |||
| 205 | } | |||
| 206 | } | |||
| 207 | ||||
| 208 | freeifaddrs(ifap); | |||
| 209 | ||||
| 210 | /* | |||
| 211 | * Generate link-local IPv6 address for interfaces without it. | |||
| 212 | * | |||
| 213 | * For IPv6 DHCP Relay it doesn't matter what is used for | |||
| 214 | * link-addr field, so let's generate an address that won't | |||
| 215 | * change during execution so we can always find the interface | |||
| 216 | * to relay packets back. This is only used for layer 2 relaying | |||
| 217 | * when the interface might not have an address. | |||
| 218 | */ | |||
| 219 | TAILQ_FOREACH(intf, &intflist, entry)for((intf) = ((&intflist)->tqh_first); (intf) != ((void *)0); (intf) = ((intf)->entry.tqe_next)) { | |||
| 220 | if (memcmp(&intf->linklocal, &in6addr_any, | |||
| 221 | sizeof(in6addr_any)) != 0) | |||
| 222 | continue; | |||
| 223 | ||||
| 224 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[0] = 0xfe; | |||
| 225 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[1] = 0x80; | |||
| 226 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[8] = intf->hw_address.haddr[0]; | |||
| 227 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[9] = intf->hw_address.haddr[1]; | |||
| 228 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[10] = intf->hw_address.haddr[2]; | |||
| 229 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[11] = 0xff; | |||
| 230 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[12] = 0xfe; | |||
| 231 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[13] = intf->hw_address.haddr[3]; | |||
| 232 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[14] = intf->hw_address.haddr[4]; | |||
| 233 | intf->linklocal.s6_addr__u6_addr.__u6_addr8[15] = intf->hw_address.haddr[5]; | |||
| 234 | EUI64_TO_IFID(&intf->linklocal)do { (&intf->linklocal)->__u6_addr.__u6_addr8[8] ^= 0x02; } while (0); | |||
| 235 | } | |||
| 236 | } | |||
| 237 | ||||
| 238 | struct interface_info * | |||
| 239 | register_interface(const char *ifname, void (*handler)(struct protocol *)) | |||
| 240 | { | |||
| 241 | struct interface_info *intf; | |||
| 242 | ||||
| 243 | if ((intf = iflist_getbyname(ifname)) == NULL((void *)0)) | |||
| 244 | return NULL((void *)0); | |||
| 245 | ||||
| 246 | /* Don't register disabled interfaces. */ | |||
| 247 | if (intf->dead) | |||
| 248 | return NULL((void *)0); | |||
| 249 | ||||
| 250 | /* Check if we already registered the interface. */ | |||
| 251 | if (intf->ifr.ifr_name[0] != 0) | |||
| 252 | return intf; | |||
| 253 | ||||
| 254 | if (strlcpy(intf->ifr.ifr_name, ifname, | |||
| 255 | sizeof(intf->ifr.ifr_name)) >= sizeof(intf->ifr.ifr_name)) | |||
| 256 | fatalx("interface name '%s' too long", ifname); | |||
| 257 | ||||
| 258 | if_register_receive(intf); | |||
| 259 | if_register_send(intf); | |||
| 260 | add_protocol(intf->name, intf->rfdesc, handler, intf); | |||
| 261 | ||||
| 262 | return intf; | |||
| 263 | } | |||
| 264 | ||||
| 265 | /* | |||
| 266 | * Wait for packets to come in using poll(). When a packet comes in, | |||
| 267 | * call receive_packet to receive the packet and possibly strip hardware | |||
| 268 | * addressing information from it, and then call through the | |||
| 269 | * bootp_packet_handler hook to try to do something with it. | |||
| 270 | */ | |||
| 271 | void | |||
| 272 | dispatch(void) | |||
| 273 | { | |||
| 274 | int count, i, to_msec, nfds = 0; | |||
| 275 | struct protocol *l; | |||
| 276 | struct pollfd *fds; | |||
| 277 | time_t howlong; | |||
| 278 | ||||
| 279 | nfds = 0; | |||
| 280 | for (l = protocols; l; l = l->next) | |||
| ||||
| 281 | nfds++; | |||
| 282 | ||||
| 283 | fds = calloc(nfds, sizeof(struct pollfd)); | |||
| 284 | if (fds == NULL((void *)0)) | |||
| 285 | fatalx("Can't allocate poll structures."); | |||
| 286 | ||||
| 287 | do { | |||
| 288 | /* | |||
| 289 | * Call any expired timeouts, and then if there's still | |||
| 290 | * a timeout registered, time out the select call then. | |||
| 291 | */ | |||
| 292 | another: | |||
| 293 | if (timeouts) { | |||
| 294 | if (timeouts->when <= cur_time) { | |||
| 295 | struct timeout *t = timeouts; | |||
| 296 | ||||
| 297 | timeouts = timeouts->next; | |||
| 298 | (*(t->func))(t->what); | |||
| 299 | t->next = free_timeouts; | |||
| 300 | free_timeouts = t; | |||
| 301 | goto another; | |||
| 302 | } | |||
| 303 | ||||
| 304 | /* | |||
| 305 | * Figure timeout in milliseconds, and check for | |||
| 306 | * potential overflow, so we can cram into an | |||
| 307 | * int for poll, while not polling with a | |||
| 308 | * negative timeout and blocking indefinitely. | |||
| 309 | */ | |||
| 310 | howlong = timeouts->when - cur_time; | |||
| 311 | if (howlong > INT_MAX2147483647 / 1000) | |||
| 312 | howlong = INT_MAX2147483647 / 1000; | |||
| 313 | to_msec = howlong * 1000; | |||
| 314 | } else | |||
| 315 | to_msec = -1; | |||
| 316 | ||||
| 317 | /* Set up the descriptors to be polled. */ | |||
| 318 | i = 0; | |||
| 319 | ||||
| 320 | for (l = protocols; l; l = l->next) { | |||
| 321 | struct interface_info *ip = l->local; | |||
| 322 | ||||
| 323 | if (ip && (l->handler != got_one || !ip->dead)) { | |||
| 324 | fds[i].fd = l->fd; | |||
| ||||
| 325 | fds[i].events = POLLIN0x0001; | |||
| 326 | fds[i].revents = 0; | |||
| 327 | i++; | |||
| 328 | } | |||
| 329 | } | |||
| 330 | ||||
| 331 | if (i == 0) | |||
| 332 | fatalx("No live interfaces to poll on - exiting."); | |||
| 333 | ||||
| 334 | /* Wait for a packet or a timeout... XXX */ | |||
| 335 | count = poll(fds, nfds, to_msec); | |||
| 336 | ||||
| 337 | /* Not likely to be transitory... */ | |||
| 338 | if (count == -1) { | |||
| 339 | if (errno(*__errno()) == EAGAIN35 || errno(*__errno()) == EINTR4) { | |||
| 340 | time(&cur_time); | |||
| 341 | continue; | |||
| 342 | } | |||
| 343 | else | |||
| 344 | fatal("poll"); | |||
| 345 | } | |||
| 346 | ||||
| 347 | /* Get the current time... */ | |||
| 348 | time(&cur_time); | |||
| 349 | ||||
| 350 | i = 0; | |||
| 351 | for (l = protocols; l; l = l->next) { | |||
| 352 | struct interface_info *ip = l->local; | |||
| 353 | ||||
| 354 | if ((fds[i].revents & (POLLIN0x0001 | POLLHUP0x0010))) { | |||
| 355 | fds[i].revents = 0; | |||
| 356 | if (ip && (l->handler != got_one || | |||
| 357 | !ip->dead)) | |||
| 358 | (*(l->handler))(l); | |||
| 359 | if (interfaces_invalidated) | |||
| 360 | break; | |||
| 361 | } | |||
| 362 | i++; | |||
| 363 | } | |||
| 364 | interfaces_invalidated = 0; | |||
| 365 | } while (1); | |||
| 366 | } | |||
| 367 | ||||
| 368 | ||||
| 369 | void | |||
| 370 | got_one(struct protocol *l) | |||
| 371 | { | |||
| 372 | struct packet_ctx pc; | |||
| 373 | ssize_t result; | |||
| 374 | uint8_t buf[4096]; | |||
| 375 | struct interface_info *ip = l->local; | |||
| 376 | ||||
| 377 | memset(&pc, 0, sizeof(pc)); | |||
| 378 | ||||
| 379 | if ((result = receive_packet(ip, buf, sizeof(buf), &pc)) == -1) { | |||
| 380 | log_warn("receive_packet failed on %s", ip->name); | |||
| 381 | ip->errors++; | |||
| 382 | if ((!interface_status(ip)) || | |||
| 383 | (ip->noifmedia && ip->errors > 20)) { | |||
| 384 | /* our interface has gone away. */ | |||
| 385 | log_warnx("Interface %s no longer appears valid.", | |||
| 386 | ip->name); | |||
| 387 | ip->dead = 1; | |||
| 388 | interfaces_invalidated = 1; | |||
| 389 | close(l->fd); | |||
| 390 | remove_protocol(l); | |||
| 391 | free(ip); | |||
| 392 | } | |||
| 393 | return; | |||
| 394 | } | |||
| 395 | if (result == 0) | |||
| 396 | return; | |||
| 397 | ||||
| 398 | if (bootp_packet_handler) | |||
| 399 | (*bootp_packet_handler)(ip, buf, result, &pc); | |||
| 400 | } | |||
| 401 | ||||
| 402 | int | |||
| 403 | interface_status(struct interface_info *ifinfo) | |||
| 404 | { | |||
| 405 | char *ifname = ifinfo->name; | |||
| 406 | int ifsock = ifinfo->rfdesc; | |||
| 407 | struct ifreq ifr; | |||
| 408 | struct ifmediareq ifmr; | |||
| 409 | ||||
| 410 | /* get interface flags */ | |||
| 411 | memset(&ifr, 0, sizeof(ifr)); | |||
| 412 | strlcpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name)); | |||
| 413 | if (ioctl(ifsock, SIOCGIFFLAGS(((unsigned long)0x80000000|(unsigned long)0x40000000) | ((sizeof (struct ifreq) & 0x1fff) << 16) | ((('i')) << 8) | ((17))), &ifr) == -1) { | |||
| 414 | log_warn("ioctl(SIOCGIFFLAGS) on %s", ifname); | |||
| 415 | goto inactive; | |||
| 416 | } | |||
| 417 | /* | |||
| 418 | * if one of UP and RUNNING flags is dropped, | |||
| 419 | * the interface is not active. | |||
| 420 | */ | |||
| 421 | if ((ifr.ifr_flagsifr_ifru.ifru_flags & (IFF_UP0x1|IFF_RUNNING0x40)) != (IFF_UP0x1|IFF_RUNNING0x40)) { | |||
| 422 | goto inactive; | |||
| 423 | } | |||
| 424 | /* Next, check carrier on the interface, if possible */ | |||
| 425 | if (ifinfo->noifmedia) | |||
| 426 | goto active; | |||
| 427 | memset(&ifmr, 0, sizeof(ifmr)); | |||
| 428 | strlcpy(ifmr.ifm_name, ifname, sizeof(ifmr.ifm_name)); | |||
| 429 | if (ioctl(ifsock, SIOCGIFMEDIA(((unsigned long)0x80000000|(unsigned long)0x40000000) | ((sizeof (struct ifmediareq) & 0x1fff) << 16) | ((('i')) << 8) | ((56))), (caddr_t)&ifmr) == -1) { | |||
| 430 | if (errno(*__errno()) != EINVAL22) { | |||
| 431 | log_debug("ioctl(SIOCGIFMEDIA) on %s", ifname); | |||
| 432 | ifinfo->noifmedia = 1; | |||
| 433 | goto active; | |||
| 434 | } | |||
| 435 | /* | |||
| 436 | * EINVAL (or ENOTTY) simply means that the interface | |||
| 437 | * does not support the SIOCGIFMEDIA ioctl. We regard it alive. | |||
| 438 | */ | |||
| 439 | ifinfo->noifmedia = 1; | |||
| 440 | goto active; | |||
| 441 | } | |||
| 442 | if (ifmr.ifm_status & IFM_AVALID0x0000000000000001ULL) { | |||
| 443 | switch (ifmr.ifm_active & IFM_NMASK0x000000000000ff00ULL) { | |||
| 444 | case IFM_ETHER0x0000000000000100ULL: | |||
| 445 | if (ifmr.ifm_status & IFM_ACTIVE0x0000000000000002ULL) | |||
| 446 | goto active; | |||
| 447 | else | |||
| 448 | goto inactive; | |||
| 449 | break; | |||
| 450 | default: | |||
| 451 | goto inactive; | |||
| 452 | } | |||
| 453 | } | |||
| 454 | inactive: | |||
| 455 | return (0); | |||
| 456 | active: | |||
| 457 | return (1); | |||
| 458 | } | |||
| 459 | ||||
| 460 | /* Add a protocol to the list of protocols... */ | |||
| 461 | void | |||
| 462 | add_protocol(char *name, int fd, void (*handler)(struct protocol *), | |||
| 463 | void *local) | |||
| 464 | { | |||
| 465 | struct protocol *p; | |||
| 466 | ||||
| 467 | p = malloc(sizeof(*p)); | |||
| 468 | if (!p) | |||
| 469 | fatalx("can't allocate protocol struct for %s", name); | |||
| 470 | ||||
| 471 | p->fd = fd; | |||
| 472 | p->handler = handler; | |||
| 473 | p->local = local; | |||
| 474 | p->next = protocols; | |||
| 475 | protocols = p; | |||
| 476 | } | |||
| 477 | ||||
| 478 | void | |||
| 479 | remove_protocol(struct protocol *proto) | |||
| 480 | { | |||
| 481 | struct protocol *p, *next, *prev; | |||
| 482 | ||||
| 483 | prev = NULL((void *)0); | |||
| 484 | for (p = protocols; p; p = next) { | |||
| 485 | next = p->next; | |||
| 486 | if (p == proto) { | |||
| 487 | if (prev) | |||
| 488 | prev->next = p->next; | |||
| 489 | else | |||
| 490 | protocols = p->next; | |||
| 491 | free(p); | |||
| 492 | } | |||
| 493 | } | |||
| 494 | } |