fsm.c revision 1.11
1 /* $NetBSD: fsm.c,v 1.11 2013/07/11 05:45:23 kefren Exp $ */ 2 3 /*- 4 * Copyright (c) 2010 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Mihai Chelaru <kefren (at) NetBSD.org> 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 #include <sys/types.h> 33 #include <sys/socket.h> 34 #include <arpa/inet.h> 35 #include <netinet/in.h> 36 #include <net/if.h> 37 38 #include <ifaddrs.h> 39 #include <stdio.h> 40 #include <stdlib.h> 41 #include <strings.h> 42 43 #include "ldp.h" 44 #include "ldp_peer.h" 45 #include "socketops.h" 46 #include "ldp_errors.h" 47 #include "fsm.h" 48 49 char my_ldp_id[20]; 50 struct sockaddr mplssockaddr; 51 52 /* Process a hello */ 53 void 54 run_ldp_hello(const struct ldp_pdu * pduid, const struct hello_tlv * ht, 55 const struct sockaddr * padd, const struct in_addr * ladd, int mysock, 56 bool may_connect) 57 { 58 struct ldp_peer *peer = NULL; 59 const struct transport_address_tlv *trtlv; 60 struct hello_info *hi = NULL; 61 union sockunion traddr; 62 63 if ((!pduid) || (!ht)) 64 return; 65 66 debugp("Hello received for address: %s\n", inet_ntoa(*ladd)); 67 debugp("Hello: Type: 0x%.4X Length: %.2d ID: %.8X\n", ht->type, 68 ht->length, ht->messageid); 69 70 if (ht->length <= 4) /* Common hello parameters */ 71 return; 72 debugp("Common hello Type: 0x%.4X Length: %.2d" 73 " Hold time: %d\n", ntohs(ht->ch.type), ntohs(ht->ch.length), 74 ht->ch.holdtime); 75 76 memset(&traddr, 0, sizeof(traddr)); 77 /* Check transport TLV */ 78 if (pduid->length - PDU_PAYLOAD_LENGTH - 79 sizeof(struct hello_tlv) >= 8) { 80 trtlv = (const struct transport_address_tlv *)(ht + 1); 81 if (trtlv->type == htons(TLV_IPV4_TRANSPORT)) { 82 traddr.sin.sin_family = AF_INET; 83 traddr.sin.sin_len = sizeof(struct sockaddr_in); 84 memcpy(&traddr.sin.sin_addr, 85 &trtlv->address, sizeof(struct in_addr)); 86 } else if (trtlv->type == htons(TLV_IPV6_TRANSPORT)) { 87 traddr.sin6.sin6_family = AF_INET6; 88 traddr.sin6.sin6_len = sizeof(struct sockaddr_in6); 89 memcpy(&traddr.sin6.sin6_addr, 90 &trtlv->address, sizeof(struct in6_addr)); 91 } else 92 warnp("Unknown AF %x for transport address\n", 93 ntohs(trtlv->type)); 94 } else { 95 /* Use LDP ID as transport address */ 96 traddr.sin.sin_family = AF_INET; 97 traddr.sin.sin_len = sizeof(struct sockaddr_in); 98 memcpy(&traddr.sin.sin_addr, 99 &pduid->ldp_id, sizeof(struct in_addr)); 100 } 101 /* Add it to hello list or just update timer */ 102 SLIST_FOREACH(hi, &hello_info_head, infos) 103 if (hi->ldp_id.s_addr == pduid->ldp_id.s_addr && 104 sockaddr_cmp(&hi->transport_address.sa, &traddr.sa) == 0) 105 break; 106 if (hi == NULL) { 107 hi = calloc(1, sizeof(*hi)); 108 if (!hi) { 109 fatalp("Cannot alloc a hello info structure"); 110 return; 111 } 112 hi->ldp_id.s_addr = pduid->ldp_id.s_addr; 113 memcpy(&hi->transport_address, &traddr, traddr.sa.sa_len); 114 SLIST_INSERT_HEAD(&hello_info_head, hi, infos); 115 } 116 117 /* Update expire timer */ 118 if (ht->ch.holdtime != 0) 119 hi->keepalive = ntohs(ht->ch.holdtime); 120 else { 121 if (ntohs(ht->ch.res) >> 15 == 0) 122 hi->keepalive = LDP_HELLO_KEEP; 123 else 124 hi->keepalive = LDP_THELLO_KEEP; 125 } 126 127 if (!get_ldp_peer_by_id(&pduid->ldp_id)) { 128 /* 129 * RFC 5036 2.5.2: If A1 > A2, LSR1 plays the active role; 130 * otherwise it is passive. 131 */ 132 if (may_connect == true && 133 (hi->transport_address.sa.sa_family == AF_INET && 134 ntohl(hi->transport_address.sin.sin_addr.s_addr) < 135 ntohl(ladd->s_addr))) { 136 peer = ldp_peer_new(&pduid->ldp_id, padd, 137 &hi->transport_address.sa, 138 ntohs(ht->ch.holdtime), 0); 139 if (peer == NULL) 140 return; 141 if (peer->state == LDP_PEER_CONNECTED) 142 send_initialize(peer); 143 } 144 } 145 } 146 147 struct address_list_tlv * 148 build_address_list_tlv(void) 149 { 150 struct address_list_tlv *t; 151 struct ifaddrs *ifa, *ifb; 152 struct sockaddr_in *sa; 153 struct in_addr *ia; 154 uint16_t adrcount = 0; 155 156 if (getifaddrs(&ifa) == -1) 157 return NULL; 158 159 /* Find out the number of addresses */ 160 /* Ignore loopback */ 161 for (ifb = ifa; ifb; ifb = ifb->ifa_next) 162 if ((ifb->ifa_addr->sa_family == AF_INET) && 163 (ifb->ifa_flags & IFF_UP)) { 164 sa = (struct sockaddr_in *) ifb->ifa_addr; 165 if (ntohl(sa->sin_addr.s_addr) >> 24 != IN_LOOPBACKNET) 166 adrcount++; 167 } 168 t = malloc(sizeof(*t) + (adrcount - 1) * sizeof(struct in_addr)); 169 170 if (!t) { 171 fatalp("build_address_list_tlv: malloc problem\n"); 172 freeifaddrs(ifa); 173 return NULL; 174 } 175 176 t->type = htons(LDP_ADDRESS); 177 t->length = htons(sizeof(struct address_list_tlv) - TLV_TYPE_LENGTH 178 + (adrcount - 1) * sizeof(struct in_addr)); 179 t->messageid = htonl(get_message_id()); 180 181 t->a_type = htons(TLV_ADDRESS_LIST); 182 t->a_length = htons(sizeof(t->a_af) + 183 adrcount * sizeof(struct in_addr)); 184 t->a_af = htons(LDP_AF_INET); 185 186 ia = &t->a_address; 187 for (adrcount = 0, ifb = ifa; ifb; ifb = ifb->ifa_next) { 188 if ((ifb->ifa_addr->sa_family != AF_INET) || 189 (!(ifb->ifa_flags & IFF_UP)) || 190 (ifb->ifa_flags & IFF_LOOPBACK)) 191 continue; 192 sa = (struct sockaddr_in *) ifb->ifa_addr; 193 memcpy(&ia[adrcount], &sa->sin_addr, sizeof(struct in_addr)); 194 adrcount++; 195 } 196 freeifaddrs(ifa); 197 198 add_my_if_addrs(ia, adrcount); 199 return t; 200 } 201 202 /* 203 * Calculate LDP ID 204 * Get also mpls pseudo-interface address 205 */ 206 int 207 set_my_ldp_id() 208 { 209 struct ifaddrs *ifa, *ifb; 210 struct in_addr a; 211 struct sockaddr_in *sa; 212 213 a.s_addr = 0; 214 my_ldp_id[0] = '\0'; 215 mplssockaddr.sa_len = 0; 216 217 if (getifaddrs(&ifa) == -1) 218 return LDP_E_GENERIC; 219 220 for (ifb = ifa; ifb; ifb = ifb->ifa_next) 221 if(ifb->ifa_flags & IFF_UP) { 222 if (strncmp("mpls", ifb->ifa_name, 4) == 0 && 223 ifb->ifa_addr->sa_family == AF_LINK) 224 memcpy(&mplssockaddr, ifb->ifa_addr, 225 ifb->ifa_addr->sa_len); 226 227 if (ifb->ifa_addr->sa_family != AF_INET) 228 continue; 229 230 sa = (struct sockaddr_in *) ifb->ifa_addr; 231 if (ntohl(sa->sin_addr.s_addr) >> 24 == IN_LOOPBACKNET) 232 continue; /* No 127/8 */ 233 if (ntohl(sa->sin_addr.s_addr) > ntohl(a.s_addr)) 234 a.s_addr = sa->sin_addr.s_addr; 235 } 236 freeifaddrs(ifa); 237 debugp("LDP ID: %s\n", inet_ntoa(a)); 238 strlcpy(my_ldp_id, inet_ntoa(a), INET_ADDRSTRLEN); 239 return LDP_E_OK; 240 } 241
Indexes created Tue Sep 23 14:10:03 GMT 2025