/* $NetBSD: fsm.c,v 1.15.28.1 2023/08/04 13:26:17 martin Exp $ */ /*- * Copyright (c) 2010 The NetBSD Foundation, Inc. * All rights reserved. * * This code is derived from software contributed to The NetBSD Foundation * by Mihai Chelaru * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #include #include #include "ldp.h" #include "ldp_peer.h" #include "socketops.h" #include "ldp_errors.h" #include "fsm.h" char my_ldp_id[20]; struct sockaddr mplssockaddr; /* Process a hello */ void run_ldp_hello(const struct ldp_pdu * pduid, const struct hello_tlv * ht, const struct sockaddr * padd, const struct in_addr * ladd, int mysock, bool may_connect) { struct ldp_peer *peer = NULL; const struct transport_address_tlv *trtlv; struct hello_info *hi = NULL; union sockunion traddr; struct in_addr ldp_id; if ((!pduid) || (!ht)) return; debugp("Hello received for address: %s\n", inet_ntoa(*ladd)); debugp("Hello: Type: 0x%.4X Length: %.2d ID: %.8X\n", ht->type, ht->length, ht->messageid); if (ht->length <= 4) /* Common hello parameters */ return; debugp("Common hello Type: 0x%.4X Length: %.2d" " Hold time: %d\n", ntohs(ht->ch.type), ntohs(ht->ch.length), ht->ch.holdtime); memset(&traddr, 0, sizeof(traddr)); /* Check transport TLV */ if (pduid->length - PDU_PAYLOAD_LENGTH - sizeof(struct hello_tlv) >= 8) { trtlv = (const struct transport_address_tlv *)(ht + 1); if (trtlv->type == htons(TLV_IPV4_TRANSPORT)) { traddr.sin.sin_family = AF_INET; traddr.sin.sin_len = sizeof(struct sockaddr_in); memcpy(&traddr.sin.sin_addr, &trtlv->address, sizeof(struct in_addr)); } else if (trtlv->type == htons(TLV_IPV6_TRANSPORT)) { traddr.sin6.sin6_family = AF_INET6; traddr.sin6.sin6_len = sizeof(struct sockaddr_in6); memcpy(&traddr.sin6.sin6_addr, &trtlv->address, sizeof(struct in6_addr)); } else warnp("Unknown AF %x for transport address\n", ntohs(trtlv->type)); } else { /* Use LDP ID as transport address */ traddr.sin.sin_family = AF_INET; traddr.sin.sin_len = sizeof(struct sockaddr_in); memcpy(&traddr.sin.sin_addr, &pduid->ldp_id, sizeof(struct in_addr)); } /* Add it to hello list or just update timer */ SLIST_FOREACH(hi, &hello_info_head, infos) if (hi->ldp_id.s_addr == pduid->ldp_id.s_addr && sockaddr_cmp(&hi->transport_address.sa, &traddr.sa) == 0) break; if (hi == NULL) { hi = calloc(1, sizeof(*hi)); if (!hi) { fatalp("Cannot alloc a hello info structure"); return; } hi->ldp_id.s_addr = pduid->ldp_id.s_addr; memcpy(&hi->transport_address, &traddr, traddr.sa.sa_len); SLIST_INSERT_HEAD(&hello_info_head, hi, infos); may_connect = false; } /* Update expire timer */ if (ht->ch.holdtime != 0) hi->keepalive = ntohs(ht->ch.holdtime); else { if (ntohs(ht->ch.res) >> 15 == 0) hi->keepalive = LDP_HELLO_KEEP; else hi->keepalive = LDP_THELLO_KEEP; } ldp_id = pduid->ldp_id; if (!get_ldp_peer_by_id(&ldp_id)) { /* * RFC 5036 2.5.2: If A1 > A2, LSR1 plays the active role; * otherwise it is passive. */ if (may_connect == true && (hi->transport_address.sa.sa_family == AF_INET && ntohl(hi->transport_address.sin.sin_addr.s_addr) < ntohl(ladd->s_addr))) { peer = ldp_peer_new(&ldp_id, padd, &hi->transport_address.sa, ntohs(ht->ch.holdtime), 0); if (peer == NULL) return; if (peer->state == LDP_PEER_CONNECTED) send_initialize(peer); } } } struct address_list_tlv * build_address_list_tlv(void) { struct address_list_tlv *t; struct ifaddrs *ifa, *ifb; struct sockaddr_in *sa; char *ia; uint16_t adrcount = 0; if (getifaddrs(&ifa) == -1) return NULL; /* Find out the number of addresses */ /* Ignore loopback */ for (ifb = ifa; ifb; ifb = ifb->ifa_next) if ((ifb->ifa_addr->sa_family == AF_INET) && (ifb->ifa_flags & IFF_UP)) { sa = (struct sockaddr_in *) ifb->ifa_addr; if (ntohl(sa->sin_addr.s_addr) >> 24 != IN_LOOPBACKNET) adrcount++; } t = malloc(sizeof(*t) + (adrcount - 1) * sizeof(struct in_addr)); if (!t) { fatalp("build_address_list_tlv: malloc problem\n"); freeifaddrs(ifa); return NULL; } t->type = htons(LDP_ADDRESS); t->length = htons(sizeof(struct address_list_tlv) - TLV_TYPE_LENGTH + (adrcount - 1) * sizeof(struct in_addr)); t->messageid = htonl(get_message_id()); t->a_type = htons(TLV_ADDRESS_LIST); t->a_length = htons(sizeof(t->a_af) + adrcount * sizeof(struct in_addr)); t->a_af = htons(LDP_AF_INET); ia = (void *)&t->a_address; for (adrcount = 0, ifb = ifa; ifb; ifb = ifb->ifa_next) { if ((ifb->ifa_addr->sa_family != AF_INET) || (!(ifb->ifa_flags & IFF_UP))) continue; sa = (struct sockaddr_in *) ifb->ifa_addr; if (ntohl(sa->sin_addr.s_addr) >> 24 == IN_LOOPBACKNET) continue; memcpy(ia + adrcount*sizeof(struct in_addr), &sa->sin_addr, sizeof(struct in_addr)); adrcount++; } freeifaddrs(ifa); return t; } /* * Calculate LDP ID * Get also mpls pseudo-interface address */ int set_my_ldp_id() { struct ifaddrs *ifa, *ifb; struct in_addr a; struct sockaddr_in *sa; a.s_addr = 0; my_ldp_id[0] = '\0'; mplssockaddr.sa_len = 0; if (getifaddrs(&ifa) == -1) return LDP_E_GENERIC; for (ifb = ifa; ifb; ifb = ifb->ifa_next) if(ifb->ifa_flags & IFF_UP) { if (strncmp("mpls", ifb->ifa_name, 4) == 0 && ifb->ifa_addr->sa_family == AF_LINK) memcpy(&mplssockaddr, ifb->ifa_addr, ifb->ifa_addr->sa_len); if (ifb->ifa_addr->sa_family != AF_INET) continue; sa = (struct sockaddr_in *) ifb->ifa_addr; if (ntohl(sa->sin_addr.s_addr) >> 24 == IN_LOOPBACKNET) continue; /* No 127/8 */ if (ntohl(sa->sin_addr.s_addr) > ntohl(a.s_addr)) a.s_addr = sa->sin_addr.s_addr; } freeifaddrs(ifa); debugp("LDP ID: %s\n", inet_ntoa(a)); strlcpy(my_ldp_id, inet_ntoa(a), INET_ADDRSTRLEN); setproctitle("LDP ID: %s", my_ldp_id); return LDP_E_OK; }