socketops.c revision 1.31 1 1.31 kefren /* $NetBSD: socketops.c,v 1.31 2013/07/27 14:35:41 kefren Exp $ */
2 1.1 kefren
3 1.17 kefren /*
4 1.1 kefren * Copyright (c) 2010 The NetBSD Foundation, Inc.
5 1.1 kefren * All rights reserved.
6 1.1 kefren *
7 1.1 kefren * This code is derived from software contributed to The NetBSD Foundation
8 1.1 kefren * by Mihai Chelaru <kefren (at) NetBSD.org>
9 1.1 kefren *
10 1.1 kefren * Redistribution and use in source and binary forms, with or without
11 1.1 kefren * modification, are permitted provided that the following conditions
12 1.1 kefren * are met:
13 1.1 kefren * 1. Redistributions of source code must retain the above copyright
14 1.1 kefren * notice, this list of conditions and the following disclaimer.
15 1.1 kefren * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 kefren * notice, this list of conditions and the following disclaimer in the
17 1.1 kefren * documentation and/or other materials provided with the distribution.
18 1.1 kefren *
19 1.1 kefren * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 kefren * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 kefren * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 kefren * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 kefren * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 kefren * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 kefren * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 kefren * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 kefren * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 kefren * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 kefren * POSSIBILITY OF SUCH DAMAGE.
30 1.1 kefren */
31 1.1 kefren
32 1.1 kefren #include <sys/types.h>
33 1.1 kefren #include <sys/stat.h>
34 1.1 kefren #include <sys/socket.h>
35 1.1 kefren #include <sys/ioctl.h>
36 1.1 kefren #include <net/if.h>
37 1.1 kefren #include <netinet/in.h>
38 1.1 kefren #include <arpa/inet.h>
39 1.1 kefren
40 1.7 kefren #include <assert.h>
41 1.1 kefren #include <errno.h>
42 1.7 kefren #include <ifaddrs.h>
43 1.7 kefren #include <poll.h>
44 1.1 kefren #include <signal.h>
45 1.7 kefren #include <stdio.h>
46 1.1 kefren #include <stdlib.h>
47 1.7 kefren #include <strings.h>
48 1.1 kefren #include <unistd.h>
49 1.1 kefren
50 1.20 kefren #include "conffile.h"
51 1.1 kefren #include "fsm.h"
52 1.1 kefren #include "ldp.h"
53 1.1 kefren #include "ldp_command.h"
54 1.1 kefren #include "tlv.h"
55 1.1 kefren #include "ldp_peer.h"
56 1.1 kefren #include "notifications.h"
57 1.1 kefren #include "tlv_stack.h"
58 1.1 kefren #include "mpls_interface.h"
59 1.1 kefren #include "label.h"
60 1.1 kefren #include "mpls_routes.h"
61 1.1 kefren #include "ldp_errors.h"
62 1.1 kefren #include "socketops.h"
63 1.1 kefren
64 1.12 kefren int ls; /* TCP listening socket on port 646 */
65 1.12 kefren int route_socket; /* used to see when a route is added/deleted */
66 1.12 kefren int command_socket; /* Listening socket for interface command */
67 1.12 kefren int current_msg_id = 0x233;
68 1.12 kefren int command_port = LDP_COMMAND_PORT;
69 1.1 kefren extern int replay_index;
70 1.1 kefren extern struct rt_msg replay_rt[REPLAY_MAX];
71 1.1 kefren extern struct com_sock csockets[MAX_COMMAND_SOCKETS];
72 1.1 kefren
73 1.1 kefren int ldp_hello_time = LDP_HELLO_TIME;
74 1.3 kefren int ldp_keepalive_time = LDP_KEEPALIVE_TIME;
75 1.3 kefren int ldp_holddown_time = LDP_HOLDTIME;
76 1.7 kefren int no_default_route = 1;
77 1.12 kefren int loop_detection = 0;
78 1.24 kefren bool may_connect;
79 1.1 kefren
80 1.1 kefren void recv_pdu(int);
81 1.1 kefren void send_hello_alarm(int);
82 1.11 joerg __dead static void bail_out(int);
83 1.29 kefren static void print_info(int);
84 1.17 kefren static int bind_socket(int s, int stype);
85 1.12 kefren static int set_tos(int);
86 1.12 kefren static int socket_reuse_port(int);
87 1.1 kefren static int get_local_addr(struct sockaddr_dl *, struct in_addr *);
88 1.17 kefren static int is_hello_socket(int);
89 1.28 kefren static int is_passive_if(const char *if_name);
90 1.1 kefren
91 1.1 kefren int
92 1.12 kefren create_hello_sockets()
93 1.1 kefren {
94 1.1 kefren struct ip_mreq mcast_addr;
95 1.17 kefren int s, joined_groups;
96 1.18 kefren struct ifaddrs *ifa, *ifb;
97 1.18 kefren uint lastifindex;
98 1.12 kefren #ifdef INET6
99 1.12 kefren struct ipv6_mreq mcast_addr6;
100 1.17 kefren struct sockaddr_in6 *if_sa6;
101 1.12 kefren #endif
102 1.17 kefren struct hello_socket *hs;
103 1.17 kefren
104 1.17 kefren SLIST_INIT(&hello_socket_head);
105 1.1 kefren
106 1.12 kefren s = socket(PF_INET, SOCK_DGRAM, IPPROTO_UDP);
107 1.1 kefren if (s < 0)
108 1.1 kefren return s;
109 1.17 kefren debugp("INET4 socket created (%d)\n", s);
110 1.1 kefren /*
111 1.12 kefren * RFC5036 specifies we should listen to all subnet routers multicast
112 1.1 kefren * group
113 1.1 kefren */
114 1.19 kefren mcast_addr.imr_multiaddr.s_addr = htonl(INADDR_ALLRTRS_GROUP);
115 1.12 kefren
116 1.12 kefren if (socket_reuse_port(s) < 0)
117 1.12 kefren goto chs_error;
118 1.17 kefren /* Bind it to port 646 */
119 1.17 kefren if (bind_socket(s, AF_INET) == -1) {
120 1.12 kefren warnp("Cannot bind INET hello socket\n");
121 1.12 kefren goto chs_error;
122 1.12 kefren }
123 1.12 kefren
124 1.1 kefren /* We don't need to receive back our messages */
125 1.16 kefren if (setsockopt(s, IPPROTO_IP, IP_MULTICAST_LOOP, &(u_char){0},
126 1.16 kefren sizeof(u_char)) == -1) {
127 1.12 kefren fatalp("INET setsockopt IP_MCAST_LOOP: %s\n", strerror(errno));
128 1.12 kefren goto chs_error;
129 1.12 kefren }
130 1.17 kefren /* Finally join the group on all interfaces */
131 1.17 kefren if (getifaddrs(&ifa) == -1) {
132 1.17 kefren fatalp("Cannot iterate interfaces\n");
133 1.17 kefren return -1;
134 1.17 kefren }
135 1.17 kefren lastifindex = UINT_MAX;
136 1.17 kefren joined_groups = 0;
137 1.17 kefren for (ifb = ifa; ifb; ifb = ifb->ifa_next) {
138 1.17 kefren struct sockaddr_in *if_sa = (struct sockaddr_in *) ifb->ifa_addr;
139 1.17 kefren if (if_sa->sin_family != AF_INET || (!(ifb->ifa_flags & IFF_UP)) ||
140 1.17 kefren (ifb->ifa_flags & IFF_LOOPBACK) ||
141 1.20 kefren (!(ifb->ifa_flags & IFF_MULTICAST)) ||
142 1.17 kefren (ntohl(if_sa->sin_addr.s_addr) >> 24 == IN_LOOPBACKNET) ||
143 1.20 kefren is_passive_if(ifb->ifa_name) ||
144 1.17 kefren lastifindex == if_nametoindex(ifb->ifa_name))
145 1.17 kefren continue;
146 1.17 kefren lastifindex = if_nametoindex(ifb->ifa_name);
147 1.17 kefren
148 1.17 kefren mcast_addr.imr_interface.s_addr = if_sa->sin_addr.s_addr;
149 1.17 kefren debugp("Join IPv4 mcast on %s\n", ifb->ifa_name);
150 1.17 kefren if (setsockopt(s, IPPROTO_IP, IP_ADD_MEMBERSHIP, (char *) &mcast_addr,
151 1.17 kefren sizeof(mcast_addr)) == -1) {
152 1.17 kefren fatalp("setsockopt ADD_MEMBER: %s\n", strerror(errno));
153 1.17 kefren goto chs_error;
154 1.17 kefren }
155 1.17 kefren joined_groups++;
156 1.17 kefren if (joined_groups == IP_MAX_MEMBERSHIPS) {
157 1.17 kefren warnp("Maximum group memberships reached for INET socket\n");
158 1.17 kefren break;
159 1.17 kefren }
160 1.17 kefren }
161 1.17 kefren /* TTL:1 for IPv4 */
162 1.17 kefren if (setsockopt(s, IPPROTO_IP, IP_MULTICAST_TTL, &(int){1},
163 1.17 kefren sizeof(int)) == -1) {
164 1.17 kefren fatalp("set mcast ttl: %s\n", strerror(errno));
165 1.17 kefren goto chs_error;
166 1.17 kefren }
167 1.17 kefren /* TOS :0xc0 for IPv4 */
168 1.17 kefren if (set_tos(s) == -1) {
169 1.17 kefren fatalp("set_tos: %s", strerror(errno));
170 1.17 kefren goto chs_error;
171 1.17 kefren }
172 1.17 kefren /* we need to get the input interface for message processing */
173 1.17 kefren if (setsockopt(s, IPPROTO_IP, IP_RECVIF, &(uint32_t){1},
174 1.12 kefren sizeof(uint32_t)) == -1) {
175 1.17 kefren fatalp("Cannot set IP_RECVIF\n");
176 1.12 kefren goto chs_error;
177 1.1 kefren }
178 1.12 kefren
179 1.17 kefren hs = (struct hello_socket *)malloc(sizeof(*hs));
180 1.17 kefren if (hs == NULL) {
181 1.17 kefren fatalp("Cannot alloc hello_socket structure\n");
182 1.12 kefren goto chs_error;
183 1.17 kefren }
184 1.17 kefren hs->type = AF_INET;
185 1.17 kefren hs->socket = s;
186 1.17 kefren SLIST_INSERT_HEAD(&hello_socket_head, hs, listentry);
187 1.17 kefren
188 1.12 kefren #ifdef INET6
189 1.17 kefren /*
190 1.17 kefren * Now we do the same for IPv6
191 1.17 kefren */
192 1.17 kefren s = socket(PF_INET6, SOCK_DGRAM, IPPROTO_UDP);
193 1.17 kefren if (s < 0) {
194 1.17 kefren fatalp("Cannot create INET6 socket\n");
195 1.17 kefren return -1;
196 1.12 kefren }
197 1.17 kefren debugp("INET6 socket created (%d)\n", s);
198 1.17 kefren
199 1.17 kefren if (socket_reuse_port(s) < 0)
200 1.12 kefren goto chs_error;
201 1.17 kefren
202 1.17 kefren if (bind_socket(s, AF_INET6) == -1) {
203 1.17 kefren fatalp("Cannot bind INET6 hello socket\n");
204 1.12 kefren goto chs_error;
205 1.17 kefren }
206 1.17 kefren
207 1.17 kefren if (setsockopt(s, IPPROTO_IPV6, IPV6_MULTICAST_LOOP,
208 1.17 kefren &(uint){0}, sizeof(uint)) == -1) {
209 1.17 kefren fatalp("INET6 setsocketopt IP_MCAST_LOOP: %s\n",
210 1.17 kefren strerror(errno));
211 1.12 kefren goto chs_error;
212 1.1 kefren }
213 1.12 kefren
214 1.17 kefren lastifindex = UINT_MAX;
215 1.19 kefren mcast_addr6.ipv6mr_multiaddr = in6addr_linklocal_allrouters;
216 1.17 kefren for (ifb = ifa; ifb; ifb = ifb->ifa_next) {
217 1.17 kefren if_sa6 = (struct sockaddr_in6 *) ifb->ifa_addr;
218 1.17 kefren if (if_sa6->sin6_family != AF_INET6 ||
219 1.17 kefren (!(ifb->ifa_flags & IFF_UP)) ||
220 1.20 kefren (!(ifb->ifa_flags & IFF_MULTICAST)) ||
221 1.17 kefren (ifb->ifa_flags & IFF_LOOPBACK) ||
222 1.20 kefren is_passive_if(ifb->ifa_name) ||
223 1.17 kefren IN6_IS_ADDR_LOOPBACK(&if_sa6->sin6_addr))
224 1.17 kefren continue;
225 1.17 kefren /*
226 1.17 kefren * draft-ietf-mpls-ldp-ipv6-07 Section 5.1:
227 1.17 kefren * Additionally, the link-local
228 1.17 kefren * IPv6 address MUST be used as the source IP address in IPv6
229 1.17 kefren * LDP Link Hellos.
230 1.17 kefren */
231 1.17 kefren if (IN6_IS_ADDR_LINKLOCAL(&if_sa6->sin6_addr) == 0)
232 1.17 kefren continue;
233 1.17 kefren /* We should have only one LLADDR per interface, but... */
234 1.17 kefren if (lastifindex == if_nametoindex(ifb->ifa_name))
235 1.17 kefren continue;
236 1.17 kefren mcast_addr6.ipv6mr_interface = lastifindex =
237 1.17 kefren if_nametoindex(ifb->ifa_name);
238 1.17 kefren
239 1.17 kefren debugp("Join IPv6 mcast on %s\n", ifb->ifa_name);
240 1.17 kefren if (setsockopt(s, IPPROTO_IPV6, IPV6_JOIN_GROUP,
241 1.17 kefren (char *)&mcast_addr6, sizeof(mcast_addr6)) == -1) {
242 1.17 kefren fatalp("INET6 setsockopt JOIN: %s\n", strerror(errno));
243 1.17 kefren goto chs_error;
244 1.17 kefren }
245 1.17 kefren }
246 1.17 kefren freeifaddrs(ifa);
247 1.17 kefren
248 1.17 kefren /* TTL: 255 for IPv6 - draft-ietf-mpls-ldp-ipv6-07 Section 9 */
249 1.17 kefren if (setsockopt(s, IPPROTO_IPV6, IPV6_MULTICAST_HOPS,
250 1.17 kefren &(int){255}, sizeof(int)) == -1) {
251 1.17 kefren fatalp("set mcast hops: %s\n", strerror(errno));
252 1.12 kefren goto chs_error;
253 1.1 kefren }
254 1.17 kefren if (setsockopt(s, IPPROTO_IPV6, IPV6_RECVPKTINFO,
255 1.17 kefren &(uint32_t){1}, sizeof(uint32_t)) == -1)
256 1.17 kefren goto chs_error;
257 1.17 kefren
258 1.17 kefren hs = (struct hello_socket *)malloc(sizeof(*hs));
259 1.17 kefren if (hs == NULL) {
260 1.17 kefren fatalp("Memory alloc problem: hs\n");
261 1.12 kefren goto chs_error;
262 1.17 kefren }
263 1.17 kefren
264 1.17 kefren hs->type = AF_INET6;
265 1.17 kefren hs->socket = s;
266 1.17 kefren SLIST_INSERT_HEAD(&hello_socket_head, hs, listentry);
267 1.12 kefren #endif
268 1.12 kefren return 0;
269 1.12 kefren chs_error:
270 1.12 kefren close(s);
271 1.12 kefren return -1;
272 1.1 kefren }
273 1.1 kefren
274 1.17 kefren /* Check if parameter is a hello socket */
275 1.17 kefren int
276 1.17 kefren is_hello_socket(int s)
277 1.17 kefren {
278 1.17 kefren struct hello_socket *hs;
279 1.17 kefren
280 1.17 kefren SLIST_FOREACH(hs, &hello_socket_head, listentry)
281 1.17 kefren if (hs->socket == s)
282 1.17 kefren return 1;
283 1.17 kefren return 0;
284 1.17 kefren }
285 1.17 kefren
286 1.20 kefren /* Check if interface is passive */
287 1.20 kefren static int
288 1.28 kefren is_passive_if(const char *if_name)
289 1.20 kefren {
290 1.20 kefren struct passive_if *pif;
291 1.20 kefren
292 1.20 kefren SLIST_FOREACH(pif, &passifs_head, listentry)
293 1.20 kefren if (strncasecmp(if_name, pif->if_name, IF_NAMESIZE) == 0)
294 1.20 kefren return 1;
295 1.20 kefren return 0;
296 1.20 kefren }
297 1.20 kefren
298 1.1 kefren /* Sets the TTL to 1 as we don't want to transmit outside this subnet */
299 1.12 kefren int
300 1.1 kefren set_ttl(int s)
301 1.1 kefren {
302 1.1 kefren int ret;
303 1.1 kefren if ((ret = setsockopt(s, IPPROTO_IP, IP_TTL, &(int){1}, sizeof(int)))
304 1.1 kefren == -1)
305 1.1 kefren fatalp("set_ttl: %s", strerror(errno));
306 1.1 kefren return ret;
307 1.1 kefren }
308 1.1 kefren
309 1.1 kefren /* Sets TOS to 0xc0 aka IP Precedence 6 */
310 1.12 kefren static int
311 1.1 kefren set_tos(int s)
312 1.1 kefren {
313 1.1 kefren int ret;
314 1.1 kefren if ((ret = setsockopt(s, IPPROTO_IP, IP_TOS, &(int){0xc0},
315 1.1 kefren sizeof(int))) == -1)
316 1.1 kefren fatalp("set_tos: %s", strerror(errno));
317 1.1 kefren return ret;
318 1.1 kefren }
319 1.1 kefren
320 1.12 kefren static int
321 1.1 kefren socket_reuse_port(int s)
322 1.1 kefren {
323 1.12 kefren int ret;
324 1.1 kefren if ((ret = setsockopt(s, SOL_SOCKET, SO_REUSEPORT, &(int){1},
325 1.1 kefren sizeof(int))) == -1)
326 1.1 kefren fatalp("socket_reuse_port: %s", strerror(errno));
327 1.1 kefren return ret;
328 1.1 kefren }
329 1.1 kefren
330 1.1 kefren /* binds an UDP socket */
331 1.12 kefren static int
332 1.17 kefren bind_socket(int s, int stype)
333 1.1 kefren {
334 1.16 kefren union sockunion su;
335 1.12 kefren
336 1.17 kefren assert (stype == AF_INET || stype == AF_INET6);
337 1.1 kefren
338 1.17 kefren if (stype == AF_INET) {
339 1.16 kefren su.sin.sin_len = sizeof(su.sin);
340 1.16 kefren su.sin.sin_family = AF_INET;
341 1.17 kefren su.sin.sin_addr.s_addr = htonl(INADDR_ANY);
342 1.16 kefren su.sin.sin_port = htons(LDP_PORT);
343 1.12 kefren }
344 1.12 kefren #ifdef INET6
345 1.17 kefren else if (stype == AF_INET6) {
346 1.16 kefren su.sin6.sin6_len = sizeof(su.sin6);
347 1.16 kefren su.sin6.sin6_family = AF_INET6;
348 1.16 kefren su.sin6.sin6_addr = in6addr_any;
349 1.16 kefren su.sin6.sin6_port = htons(LDP_PORT);
350 1.12 kefren }
351 1.12 kefren #endif
352 1.16 kefren if (bind(s, &su.sa, su.sa.sa_len)) {
353 1.12 kefren fatalp("bind_socket: %s\n", strerror(errno));
354 1.1 kefren return -1;
355 1.1 kefren }
356 1.1 kefren return 0;
357 1.1 kefren }
358 1.1 kefren
359 1.1 kefren /* Create / bind the TCP socket */
360 1.12 kefren int
361 1.1 kefren create_listening_socket(void)
362 1.1 kefren {
363 1.1 kefren struct sockaddr_in sa;
364 1.1 kefren int s;
365 1.1 kefren
366 1.1 kefren sa.sin_len = sizeof(sa);
367 1.1 kefren sa.sin_family = AF_INET;
368 1.1 kefren sa.sin_port = htons(LDP_PORT);
369 1.1 kefren sa.sin_addr.s_addr = htonl(INADDR_ANY);
370 1.1 kefren
371 1.12 kefren s = socket(PF_INET, SOCK_STREAM, IPPROTO_TCP);
372 1.1 kefren if (s < 0)
373 1.1 kefren return s;
374 1.1 kefren if (bind(s, (struct sockaddr *) & sa, sizeof(sa))) {
375 1.1 kefren fatalp("bind: %s", strerror(errno));
376 1.1 kefren close(s);
377 1.1 kefren return -1;
378 1.1 kefren }
379 1.1 kefren if (listen(s, 10) == -1) {
380 1.1 kefren fatalp("listen: %s", strerror(errno));
381 1.1 kefren close(s);
382 1.1 kefren return -1;
383 1.1 kefren }
384 1.1 kefren /* if (set_tos(s) == -1) {
385 1.1 kefren fatalp("set_tos: %s", strerror(errno));
386 1.1 kefren close(s);
387 1.1 kefren return -1;
388 1.1 kefren }
389 1.1 kefren */ return s;
390 1.1 kefren }
391 1.1 kefren
392 1.1 kefren /*
393 1.1 kefren * It's ugly. We need a function to pass all tlvs and create pdu but since I
394 1.1 kefren * use UDP socket only to send hellos, I didn't bother
395 1.1 kefren */
396 1.1 kefren void
397 1.1 kefren send_hello(void)
398 1.1 kefren {
399 1.1 kefren struct hello_tlv *t;
400 1.1 kefren struct common_hello_tlv *cht;
401 1.1 kefren struct ldp_pdu *spdu;
402 1.1 kefren struct transport_address_tlv *trtlv;
403 1.1 kefren void *v;
404 1.1 kefren struct sockaddr_in sadest; /* Destination ALL_ROUTERS */
405 1.12 kefren ssize_t sb = 0; /* sent bytes */
406 1.1 kefren struct ifaddrs *ifa, *ifb;
407 1.1 kefren struct sockaddr_in *if_sa;
408 1.17 kefren int ip4socket = -1;
409 1.17 kefren uint lastifindex;
410 1.17 kefren struct hello_socket *hs;
411 1.12 kefren #ifdef INET6
412 1.12 kefren struct sockaddr_in6 sadest6;
413 1.17 kefren int ip6socket = -1;
414 1.12 kefren #endif
415 1.1 kefren
416 1.12 kefren #define BASIC_HELLO_MSG_SIZE (sizeof(struct ldp_pdu) + /* PDU */ \
417 1.1 kefren TLV_TYPE_LENGTH + MSGID_SIZE + /* Hello TLV */ \
418 1.1 kefren /* Common Hello TLV */ \
419 1.12 kefren sizeof(struct common_hello_tlv))
420 1.12 kefren #define GENERAL_HELLO_MSG_SIZE BASIC_HELLO_MSG_SIZE + \
421 1.12 kefren /* Transport Address */ \
422 1.12 kefren sizeof(struct transport_address_tlv)
423 1.12 kefren #define IPV4_HELLO_MSG_SIZE BASIC_HELLO_MSG_SIZE + 4 + sizeof(struct in_addr)
424 1.12 kefren #define IPV6_HELLO_MSG_SIZE BASIC_HELLO_MSG_SIZE + 4 + sizeof(struct in6_addr)
425 1.1 kefren
426 1.12 kefren if ((v = calloc(1, GENERAL_HELLO_MSG_SIZE)) == NULL) {
427 1.12 kefren fatalp("alloc problem in send_hello()\n");
428 1.1 kefren return;
429 1.1 kefren }
430 1.1 kefren
431 1.1 kefren spdu = (struct ldp_pdu *)((char *)v);
432 1.1 kefren t = (struct hello_tlv *)(spdu + 1);
433 1.1 kefren cht = &t->ch; /* Hello tlv struct includes CHT */
434 1.1 kefren trtlv = (struct transport_address_tlv *)(t + 1);
435 1.1 kefren
436 1.1 kefren /* Prepare PDU envelope */
437 1.1 kefren spdu->version = htons(LDP_VERSION);
438 1.12 kefren spdu->length = htons(IPV4_HELLO_MSG_SIZE - PDU_VER_LENGTH);
439 1.1 kefren inet_aton(LDP_ID, &spdu->ldp_id);
440 1.1 kefren
441 1.1 kefren /* Prepare Hello TLV */
442 1.1 kefren t->type = htons(LDP_HELLO);
443 1.1 kefren t->length = htons(MSGID_SIZE +
444 1.1 kefren sizeof(struct common_hello_tlv) +
445 1.12 kefren IPV4_HELLO_MSG_SIZE - BASIC_HELLO_MSG_SIZE);
446 1.1 kefren /*
447 1.28 kefren * We used ID 0 instead of htonl(get_message_id()) because we've
448 1.12 kefren * seen hellos from Cisco routers doing the same thing
449 1.1 kefren */
450 1.1 kefren t->messageid = 0;
451 1.1 kefren
452 1.1 kefren /* Prepare Common Hello attributes */
453 1.1 kefren cht->type = htons(TLV_COMMON_HELLO);
454 1.1 kefren cht->length = htons(sizeof(cht->holdtime) + sizeof(cht->res));
455 1.3 kefren cht->holdtime = htons(ldp_holddown_time);
456 1.1 kefren cht->res = 0;
457 1.1 kefren
458 1.1 kefren /*
459 1.12 kefren * Prepare Transport Address TLV RFC5036 says: "If this optional TLV
460 1.1 kefren * is not present the IPv4 source address for the UDP packet carrying
461 1.1 kefren * the Hello should be used." But we send it because everybody seems
462 1.1 kefren * to do so
463 1.1 kefren */
464 1.1 kefren trtlv->type = htons(TLV_IPV4_TRANSPORT);
465 1.1 kefren trtlv->length = htons(sizeof(struct in_addr));
466 1.1 kefren /* trtlv->address will be set for each socket */
467 1.1 kefren
468 1.1 kefren /* Destination sockaddr */
469 1.1 kefren memset(&sadest, 0, sizeof(sadest));
470 1.1 kefren sadest.sin_len = sizeof(sadest);
471 1.1 kefren sadest.sin_family = AF_INET;
472 1.1 kefren sadest.sin_port = htons(LDP_PORT);
473 1.19 kefren sadest.sin_addr.s_addr = htonl(INADDR_ALLRTRS_GROUP);
474 1.1 kefren
475 1.17 kefren /* Find our socket */
476 1.17 kefren SLIST_FOREACH(hs, &hello_socket_head, listentry)
477 1.17 kefren if (hs->type == AF_INET) {
478 1.17 kefren ip4socket = hs->socket;
479 1.17 kefren break;
480 1.17 kefren }
481 1.17 kefren assert(ip4socket >= 0);
482 1.17 kefren
483 1.1 kefren if (getifaddrs(&ifa) == -1) {
484 1.1 kefren free(v);
485 1.17 kefren fatalp("Cannot enumerate interfaces\n");
486 1.1 kefren return;
487 1.1 kefren }
488 1.1 kefren
489 1.17 kefren lastifindex = UINT_MAX;
490 1.12 kefren /* Loop all interfaces in order to send IPv4 hellos */
491 1.1 kefren for (ifb = ifa; ifb; ifb = ifb->ifa_next) {
492 1.1 kefren if_sa = (struct sockaddr_in *) ifb->ifa_addr;
493 1.20 kefren if (if_sa->sin_family != AF_INET ||
494 1.20 kefren (!(ifb->ifa_flags & IFF_UP)) ||
495 1.20 kefren (ifb->ifa_flags & IFF_LOOPBACK) ||
496 1.20 kefren (!(ifb->ifa_flags & IFF_MULTICAST)) ||
497 1.20 kefren is_passive_if(ifb->ifa_name) ||
498 1.20 kefren (ntohl(if_sa->sin_addr.s_addr) >> 24 == IN_LOOPBACKNET) ||
499 1.20 kefren lastifindex == if_nametoindex(ifb->ifa_name))
500 1.1 kefren continue;
501 1.12 kefren
502 1.12 kefren /* Send only once per interface, using primary address */
503 1.17 kefren if (lastifindex == if_nametoindex(ifb->ifa_name))
504 1.1 kefren continue;
505 1.17 kefren lastifindex = if_nametoindex(ifb->ifa_name);
506 1.17 kefren
507 1.17 kefren if (setsockopt(ip4socket, IPPROTO_IP, IP_MULTICAST_IF,
508 1.1 kefren &if_sa->sin_addr, sizeof(struct in_addr)) == -1) {
509 1.1 kefren warnp("setsockopt failed: %s\n", strerror(errno));
510 1.1 kefren continue;
511 1.1 kefren }
512 1.12 kefren trtlv->address.ip4addr.s_addr = if_sa->sin_addr.s_addr;
513 1.1 kefren
514 1.17 kefren /* Put it on the wire */
515 1.17 kefren sb = sendto(ip4socket, v, IPV4_HELLO_MSG_SIZE, 0,
516 1.17 kefren (struct sockaddr *) & sadest, sizeof(sadest));
517 1.12 kefren if (sb < (ssize_t)(IPV4_HELLO_MSG_SIZE))
518 1.1 kefren fatalp("send: %s", strerror(errno));
519 1.1 kefren else
520 1.17 kefren debugp("Sent (IPv4) %zd bytes on %s"
521 1.17 kefren " (PDU: %d, Hello TLV: %d, CH: %d, TR: %d)\n",
522 1.12 kefren sb, ifb->ifa_name,
523 1.12 kefren ntohs(spdu->length), ntohs(t->length),
524 1.12 kefren ntohs(cht->length), ntohs(trtlv->length));
525 1.12 kefren }
526 1.12 kefren #ifdef INET6
527 1.12 kefren /* Adjust lengths */
528 1.12 kefren spdu->length = htons(IPV6_HELLO_MSG_SIZE - PDU_VER_LENGTH);
529 1.12 kefren t->length = htons(MSGID_SIZE +
530 1.12 kefren sizeof(struct common_hello_tlv) +
531 1.12 kefren IPV6_HELLO_MSG_SIZE - BASIC_HELLO_MSG_SIZE);
532 1.12 kefren trtlv->length = htons(sizeof(struct in6_addr));
533 1.12 kefren trtlv->type = htons(TLV_IPV6_TRANSPORT);
534 1.12 kefren
535 1.12 kefren /* Prepare destination sockaddr */
536 1.12 kefren memset(&sadest6, 0, sizeof(sadest6));
537 1.12 kefren sadest6.sin6_len = sizeof(sadest6);
538 1.12 kefren sadest6.sin6_family = AF_INET6;
539 1.12 kefren sadest6.sin6_port = htons(LDP_PORT);
540 1.19 kefren sadest6.sin6_addr = in6addr_linklocal_allrouters;
541 1.12 kefren
542 1.17 kefren SLIST_FOREACH(hs, &hello_socket_head, listentry)
543 1.17 kefren if (hs->type == AF_INET6) {
544 1.17 kefren ip6socket = hs->socket;
545 1.17 kefren break;
546 1.17 kefren }
547 1.17 kefren
548 1.17 kefren lastifindex = UINT_MAX;
549 1.12 kefren for (ifb = ifa; ifb; ifb = ifb->ifa_next) {
550 1.17 kefren struct sockaddr_in6 * if_sa6 =
551 1.17 kefren (struct sockaddr_in6 *) ifb->ifa_addr;
552 1.17 kefren if (if_sa6->sin6_family != AF_INET6 ||
553 1.17 kefren (!(ifb->ifa_flags & IFF_UP)) ||
554 1.20 kefren (!(ifb->ifa_flags & IFF_MULTICAST)) ||
555 1.17 kefren (ifb->ifa_flags & IFF_LOOPBACK) ||
556 1.20 kefren is_passive_if(ifb->ifa_name) ||
557 1.17 kefren IN6_IS_ADDR_LOOPBACK(&if_sa6->sin6_addr))
558 1.12 kefren continue;
559 1.15 kefren /*
560 1.15 kefren * draft-ietf-mpls-ldp-ipv6-07 Section 5.1:
561 1.15 kefren * Additionally, the link-local
562 1.15 kefren * IPv6 address MUST be used as the source IP address in IPv6
563 1.15 kefren * LDP Link Hellos.
564 1.15 kefren */
565 1.15 kefren if (IN6_IS_ADDR_LINKLOCAL(&if_sa6->sin6_addr) == 0)
566 1.15 kefren continue;
567 1.17 kefren /* We should have only one LLADDR per interface, but... */
568 1.17 kefren if (lastifindex == if_nametoindex(ifb->ifa_name))
569 1.17 kefren continue;
570 1.17 kefren lastifindex = if_nametoindex(ifb->ifa_name);
571 1.12 kefren
572 1.17 kefren if (setsockopt(ip6socket, IPPROTO_IPV6, IPV6_MULTICAST_IF,
573 1.17 kefren &lastifindex, sizeof(int)) == -1) {
574 1.17 kefren fatalp("ssopt6 IPV6_MULTICAST_IF failed: %s for %s\n",
575 1.17 kefren strerror(errno), ifb->ifa_name);
576 1.12 kefren continue;
577 1.12 kefren }
578 1.17 kefren
579 1.12 kefren memcpy(&trtlv->address.ip6addr, &if_sa6->sin6_addr,
580 1.12 kefren sizeof(struct in6_addr));
581 1.12 kefren
582 1.12 kefren /* Put it on the wire */
583 1.17 kefren sb = sendto(ip6socket, v, IPV6_HELLO_MSG_SIZE,
584 1.12 kefren 0, (struct sockaddr *)&sadest6, sizeof(sadest6));
585 1.12 kefren if (sb < (ssize_t)(IPV6_HELLO_MSG_SIZE))
586 1.17 kefren fatalp("send6: %s", strerror(errno));
587 1.12 kefren else
588 1.17 kefren debugp("Sent (IPv6) %zd bytes on %s "
589 1.12 kefren "(PDU: %d, Hello TLV: %d, CH: %d TR: %d)\n",
590 1.17 kefren sb, ifb->ifa_name, htons(spdu->length),
591 1.17 kefren htons(t->length), htons(cht->length),
592 1.17 kefren htons(trtlv->length));
593 1.1 kefren }
594 1.12 kefren #endif
595 1.1 kefren freeifaddrs(ifa);
596 1.1 kefren free(v);
597 1.1 kefren }
598 1.1 kefren
599 1.1 kefren int
600 1.1 kefren get_message_id(void)
601 1.1 kefren {
602 1.1 kefren current_msg_id++;
603 1.1 kefren return current_msg_id;
604 1.1 kefren }
605 1.1 kefren
606 1.1 kefren static int
607 1.1 kefren get_local_addr(struct sockaddr_dl *sdl, struct in_addr *sin)
608 1.1 kefren {
609 1.1 kefren struct ifaddrs *ifa, *ifb;
610 1.1 kefren struct sockaddr_in *sinet;
611 1.1 kefren
612 1.1 kefren if (sdl == NULL)
613 1.1 kefren return -1;
614 1.1 kefren
615 1.1 kefren if (getifaddrs(&ifa) == -1)
616 1.1 kefren return -1;
617 1.1 kefren for (ifb = ifa; ifb; ifb = ifb->ifa_next)
618 1.1 kefren if (ifb->ifa_addr->sa_family == AF_INET) {
619 1.1 kefren if (if_nametoindex(ifb->ifa_name) != sdl->sdl_index)
620 1.1 kefren continue;
621 1.1 kefren sinet = (struct sockaddr_in*) ifb->ifa_addr;
622 1.1 kefren sin->s_addr = sinet->sin_addr.s_addr;
623 1.1 kefren freeifaddrs(ifa);
624 1.1 kefren return 0;
625 1.1 kefren }
626 1.1 kefren freeifaddrs(ifa);
627 1.1 kefren return -1;
628 1.1 kefren }
629 1.1 kefren
630 1.1 kefren /* Receive PDUs on Multicast UDP socket */
631 1.1 kefren void
632 1.1 kefren recv_pdu(int sock)
633 1.1 kefren {
634 1.1 kefren struct ldp_pdu rpdu;
635 1.1 kefren int c, i;
636 1.1 kefren struct msghdr msg;
637 1.1 kefren struct iovec iov[1];
638 1.1 kefren unsigned char recvspace[MAX_PDU_SIZE];
639 1.1 kefren struct hello_tlv *t;
640 1.17 kefren union sockunion sender;
641 1.1 kefren struct sockaddr_dl *sdl = NULL;
642 1.1 kefren struct in_addr my_ldp_addr, local_addr;
643 1.1 kefren struct cmsghdr *cmptr;
644 1.1 kefren union {
645 1.1 kefren struct cmsghdr cm;
646 1.1 kefren char control[1024];
647 1.1 kefren } control_un;
648 1.1 kefren
649 1.1 kefren memset(&msg, 0, sizeof(msg));
650 1.1 kefren msg.msg_control = control_un.control;
651 1.1 kefren msg.msg_controllen = sizeof(control_un.control);
652 1.1 kefren msg.msg_flags = 0;
653 1.17 kefren msg.msg_name = &sender;
654 1.17 kefren msg.msg_namelen = sizeof(sender);
655 1.1 kefren iov[0].iov_base = recvspace;
656 1.1 kefren iov[0].iov_len = sizeof(recvspace);
657 1.1 kefren msg.msg_iov = iov;
658 1.1 kefren msg.msg_iovlen = 1;
659 1.1 kefren
660 1.1 kefren c = recvmsg(sock, &msg, MSG_WAITALL);
661 1.1 kefren
662 1.1 kefren /* Check to see if this is larger than MIN_PDU_SIZE */
663 1.1 kefren if (c < MIN_PDU_SIZE)
664 1.1 kefren return;
665 1.1 kefren
666 1.1 kefren /* Read the PDU */
667 1.1 kefren i = get_pdu(recvspace, &rpdu);
668 1.1 kefren
669 1.17 kefren debugp("recv_pdu(%d): PDU(size: %d) from: %s\n", sock,
670 1.17 kefren c, satos(&sender.sa));
671 1.17 kefren
672 1.1 kefren /* We currently understand Version 1 */
673 1.1 kefren if (rpdu.version != LDP_VERSION) {
674 1.17 kefren warnp("recv_pdu: Version mismatch\n");
675 1.1 kefren return;
676 1.1 kefren }
677 1.1 kefren
678 1.17 kefren /* Check if it's our hello */
679 1.1 kefren inet_aton(LDP_ID, &my_ldp_addr);
680 1.1 kefren if (rpdu.ldp_id.s_addr == my_ldp_addr.s_addr) {
681 1.17 kefren /* It should not be looped. We set MULTICAST_LOOP 0 */
682 1.17 kefren fatalp("Received our PDU. Ignoring it\n");
683 1.1 kefren return;
684 1.1 kefren }
685 1.1 kefren
686 1.1 kefren if (msg.msg_controllen < (socklen_t)sizeof(struct cmsghdr) ||
687 1.1 kefren (msg.msg_flags & MSG_CTRUNC))
688 1.1 kefren local_addr.s_addr = my_ldp_addr.s_addr;
689 1.1 kefren else {
690 1.1 kefren for (cmptr = CMSG_FIRSTHDR(&msg); cmptr != NULL;
691 1.1 kefren cmptr = CMSG_NXTHDR(&msg, cmptr))
692 1.1 kefren if (cmptr->cmsg_level == IPPROTO_IP &&
693 1.1 kefren cmptr->cmsg_type == IP_RECVIF) {
694 1.1 kefren sdl = (struct sockaddr_dl *) CMSG_DATA(cmptr);
695 1.1 kefren break;
696 1.1 kefren }
697 1.1 kefren if (get_local_addr(sdl, &local_addr) != 0)
698 1.1 kefren local_addr.s_addr = my_ldp_addr.s_addr;
699 1.1 kefren }
700 1.1 kefren
701 1.1 kefren
702 1.1 kefren debugp("Read %d bytes from address %s Length: %.4d Version: %d\n",
703 1.1 kefren c, inet_ntoa(rpdu.ldp_id), rpdu.length, rpdu.version);
704 1.1 kefren
705 1.1 kefren /* Fill the TLV messages */
706 1.1 kefren t = get_hello_tlv(recvspace + i, c - i);
707 1.24 kefren run_ldp_hello(&rpdu, t, &sender.sa, &local_addr, sock, may_connect);
708 1.1 kefren }
709 1.1 kefren
710 1.1 kefren void
711 1.1 kefren send_hello_alarm(int unused)
712 1.1 kefren {
713 1.4 kefren struct ldp_peer *p, *ptmp;
714 1.3 kefren struct hello_info *hi, *hinext;
715 1.1 kefren time_t t = time(NULL);
716 1.1 kefren int olderrno = errno;
717 1.1 kefren
718 1.24 kefren if (may_connect == false)
719 1.24 kefren may_connect = true;
720 1.1 kefren /* Send hellos */
721 1.1 kefren if (!(t % ldp_hello_time))
722 1.1 kefren send_hello();
723 1.1 kefren
724 1.1 kefren /* Timeout -- */
725 1.1 kefren SLIST_FOREACH(p, &ldp_peer_head, peers)
726 1.1 kefren p->timeout--;
727 1.1 kefren
728 1.1 kefren /* Check for timeout */
729 1.4 kefren SLIST_FOREACH_SAFE(p, &ldp_peer_head, peers, ptmp)
730 1.1 kefren if (p->timeout < 1)
731 1.1 kefren switch (p->state) {
732 1.1 kefren case LDP_PEER_HOLDDOWN:
733 1.1 kefren debugp("LDP holddown expired for peer %s\n",
734 1.1 kefren inet_ntoa(p->ldp_id));
735 1.1 kefren ldp_peer_delete(p);
736 1.4 kefren break;
737 1.1 kefren case LDP_PEER_ESTABLISHED:
738 1.1 kefren case LDP_PEER_CONNECTED:
739 1.1 kefren send_notification(p, 0,
740 1.23 kefren NOTIF_FATAL|NOTIF_KEEP_ALIVE_TIMER_EXPIRED);
741 1.1 kefren warnp("Keepalive expired for %s\n",
742 1.1 kefren inet_ntoa(p->ldp_id));
743 1.1 kefren ldp_peer_holddown(p);
744 1.1 kefren break;
745 1.1 kefren } /* switch */
746 1.1 kefren
747 1.1 kefren /* send keepalives */
748 1.3 kefren if (!(t % ldp_keepalive_time)) {
749 1.1 kefren SLIST_FOREACH(p, &ldp_peer_head, peers)
750 1.1 kefren if (p->state == LDP_PEER_ESTABLISHED) {
751 1.1 kefren debugp("Sending KeepAlive to %s\n",
752 1.1 kefren inet_ntoa(p->ldp_id));
753 1.1 kefren keep_alive(p);
754 1.1 kefren }
755 1.1 kefren }
756 1.1 kefren
757 1.21 kefren /* Decrement and Check hello keepalives */
758 1.21 kefren SLIST_FOREACH_SAFE(hi, &hello_info_head, infos, hinext) {
759 1.10 kefren if (hi->keepalive != 0xFFFF)
760 1.10 kefren hi->keepalive--;
761 1.3 kefren if (hi->keepalive < 1)
762 1.1 kefren SLIST_REMOVE(&hello_info_head, hi, hello_info, infos);
763 1.21 kefren }
764 1.1 kefren
765 1.1 kefren /* Set the alarm again and bail out */
766 1.1 kefren alarm(1);
767 1.1 kefren errno = olderrno;
768 1.1 kefren }
769 1.1 kefren
770 1.11 joerg static void
771 1.1 kefren bail_out(int x)
772 1.1 kefren {
773 1.1 kefren ldp_peer_holddown_all();
774 1.1 kefren flush_mpls_routes();
775 1.1 kefren exit(0);
776 1.1 kefren }
777 1.1 kefren
778 1.29 kefren static void
779 1.29 kefren print_info(int x)
780 1.29 kefren {
781 1.29 kefren printf("Info for %s\n-------\n", LDP_ID);
782 1.29 kefren printf("Neighbours:\n");
783 1.29 kefren show_neighbours(1, NULL);
784 1.29 kefren printf("Bindings:\n");
785 1.29 kefren show_bindings(1, NULL);
786 1.29 kefren printf("Labels:\n");
787 1.29 kefren show_labels(1, NULL);
788 1.29 kefren printf("--------\n");
789 1.29 kefren }
790 1.29 kefren
791 1.1 kefren /*
792 1.1 kefren * The big poll that catches every single event
793 1.1 kefren * on every socket.
794 1.1 kefren */
795 1.7 kefren int
796 1.1 kefren the_big_loop(void)
797 1.1 kefren {
798 1.1 kefren int sock_error;
799 1.1 kefren uint32_t i;
800 1.1 kefren socklen_t sock_error_size = sizeof(int);
801 1.1 kefren struct ldp_peer *p;
802 1.1 kefren struct com_sock *cs;
803 1.1 kefren struct pollfd pfd[MAX_POLL_FDS];
804 1.17 kefren struct hello_socket *hs;
805 1.17 kefren nfds_t pollsum;
806 1.1 kefren
807 1.17 kefren assert(MAX_POLL_FDS > 5);
808 1.7 kefren
809 1.1 kefren SLIST_INIT(&hello_info_head);
810 1.1 kefren
811 1.1 kefren signal(SIGALRM, send_hello_alarm);
812 1.1 kefren signal(SIGPIPE, SIG_IGN);
813 1.10 kefren signal(SIGINT, bail_out);
814 1.1 kefren signal(SIGTERM, bail_out);
815 1.29 kefren signal(SIGINFO, print_info);
816 1.17 kefren
817 1.17 kefren /* Send first hellos in 5 seconds. Avoid No hello notifications */
818 1.24 kefren may_connect = false;
819 1.17 kefren alarm(5);
820 1.1 kefren
821 1.1 kefren route_socket = socket(PF_ROUTE, SOCK_RAW, AF_UNSPEC);
822 1.29 kefren setsockopt(route_socket, SOL_SOCKET, SO_USELOOPBACK, &(int){0},
823 1.29 kefren sizeof(int));
824 1.1 kefren
825 1.7 kefren sock_error = bind_current_routes();
826 1.7 kefren if (sock_error != LDP_E_OK) {
827 1.1 kefren fatalp("Cannot get current routes\n");
828 1.7 kefren return sock_error;
829 1.7 kefren }
830 1.1 kefren
831 1.1 kefren for (;;) {
832 1.1 kefren pfd[0].fd = ls;
833 1.1 kefren pfd[0].events = POLLRDNORM;
834 1.1 kefren pfd[0].revents = 0;
835 1.1 kefren
836 1.1 kefren pfd[1].fd = route_socket;
837 1.1 kefren pfd[1].events = POLLRDNORM;
838 1.1 kefren pfd[1].revents = 0;
839 1.1 kefren
840 1.1 kefren pfd[2].fd = command_socket;
841 1.1 kefren pfd[2].events = POLLRDNORM;
842 1.1 kefren pfd[2].revents = 0;
843 1.1 kefren
844 1.17 kefren /* Hello sockets */
845 1.17 kefren pollsum = 3;
846 1.17 kefren SLIST_FOREACH(hs, &hello_socket_head, listentry) {
847 1.17 kefren pfd[pollsum].fd = hs->socket;
848 1.17 kefren pfd[pollsum].events = POLLIN;
849 1.17 kefren pfd[pollsum].revents = 0;
850 1.17 kefren pollsum++;
851 1.17 kefren }
852 1.1 kefren
853 1.1 kefren /* Command sockets */
854 1.1 kefren for (i=0; i < MAX_COMMAND_SOCKETS; i++)
855 1.1 kefren if (csockets[i].socket != -1) {
856 1.7 kefren if (pollsum >= MAX_POLL_FDS)
857 1.7 kefren break;
858 1.1 kefren pfd[pollsum].fd = csockets[i].socket;
859 1.1 kefren pfd[pollsum].events = POLLIN;
860 1.1 kefren pfd[pollsum].revents = 0;
861 1.1 kefren pollsum++;
862 1.1 kefren }
863 1.1 kefren
864 1.1 kefren /* LDP Peer sockets */
865 1.1 kefren SLIST_FOREACH(p, &ldp_peer_head, peers) {
866 1.1 kefren if (p->socket < 1)
867 1.1 kefren continue;
868 1.1 kefren switch (p->state) {
869 1.1 kefren case LDP_PEER_CONNECTED:
870 1.1 kefren case LDP_PEER_ESTABLISHED:
871 1.7 kefren if (pollsum >= MAX_POLL_FDS)
872 1.7 kefren break;
873 1.1 kefren pfd[pollsum].fd = p->socket;
874 1.1 kefren pfd[pollsum].events = POLLRDNORM;
875 1.1 kefren pfd[pollsum].revents = 0;
876 1.1 kefren pollsum++;
877 1.1 kefren break;
878 1.1 kefren case LDP_PEER_CONNECTING:
879 1.7 kefren if (pollsum >= MAX_POLL_FDS)
880 1.7 kefren break;
881 1.1 kefren pfd[pollsum].fd = p->socket;
882 1.1 kefren pfd[pollsum].events = POLLWRNORM;
883 1.1 kefren pfd[pollsum].revents = 0;
884 1.1 kefren pollsum++;
885 1.1 kefren break;
886 1.1 kefren }
887 1.1 kefren }
888 1.1 kefren
889 1.1 kefren if (pollsum >= MAX_POLL_FDS) {
890 1.1 kefren fatalp("Too many sockets. Increase MAX_POLL_FDS\n");
891 1.7 kefren return LDP_E_TOO_MANY_FDS;
892 1.8 kefren }
893 1.1 kefren if (poll(pfd, pollsum, INFTIM) < 0) {
894 1.1 kefren if (errno != EINTR)
895 1.1 kefren fatalp("poll: %s", strerror(errno));
896 1.1 kefren continue;
897 1.8 kefren }
898 1.1 kefren
899 1.1 kefren for (i = 0; i < pollsum; i++) {
900 1.1 kefren if ((pfd[i].revents & POLLRDNORM) ||
901 1.1 kefren (pfd[i].revents & POLLIN)) {
902 1.8 kefren if(pfd[i].fd == ls)
903 1.1 kefren new_peer_connection();
904 1.8 kefren else if (pfd[i].fd == route_socket) {
905 1.1 kefren struct rt_msg xbuf;
906 1.31 kefren int l, rtmlen = sizeof(xbuf);
907 1.31 kefren /* Read at least rtm_msglen */
908 1.31 kefren l = recv(route_socket, &xbuf,
909 1.31 kefren sizeof(u_short), MSG_PEEK);
910 1.31 kefren if (l == sizeof(u_short))
911 1.31 kefren rtmlen = xbuf.m_rtm.rtm_msglen;
912 1.1 kefren do {
913 1.31 kefren l = recv(route_socket, &xbuf,
914 1.31 kefren rtmlen, MSG_WAITALL);
915 1.1 kefren } while ((l == -1) && (errno == EINTR));
916 1.1 kefren
917 1.1 kefren if (l == -1)
918 1.1 kefren break;
919 1.1 kefren
920 1.8 kefren check_route(&xbuf, l);
921 1.1 kefren
922 1.17 kefren } else if (is_hello_socket(pfd[i].fd) == 1) {
923 1.1 kefren /* Receiving hello socket */
924 1.1 kefren recv_pdu(pfd[i].fd);
925 1.1 kefren } else if (pfd[i].fd == command_socket) {
926 1.1 kefren command_accept(command_socket);
927 1.1 kefren } else if ((cs = is_command_socket(pfd[i].fd))
928 1.1 kefren != NULL) {
929 1.1 kefren command_dispatch(cs);
930 1.1 kefren } else {
931 1.1 kefren /* ldp peer socket */
932 1.1 kefren p = get_ldp_peer_by_socket(pfd[i].fd);
933 1.1 kefren if (p)
934 1.1 kefren recv_session_pdu(p);
935 1.1 kefren }
936 1.1 kefren } else if(pfd[i].revents & POLLWRNORM) {
937 1.1 kefren p = get_ldp_peer_by_socket(pfd[i].fd);
938 1.1 kefren if (!p)
939 1.1 kefren continue;
940 1.30 kefren assert(p->state == LDP_PEER_CONNECTING);
941 1.9 kefren if (getsockopt(pfd[i].fd, SOL_SOCKET, SO_ERROR,
942 1.9 kefren &sock_error, &sock_error_size) != 0 ||
943 1.9 kefren sock_error != 0) {
944 1.9 kefren ldp_peer_holddown(p);
945 1.9 kefren sock_error = 0;
946 1.9 kefren } else {
947 1.9 kefren p->state = LDP_PEER_CONNECTED;
948 1.9 kefren send_initialize(p);
949 1.1 kefren }
950 1.1 kefren }
951 1.1 kefren }
952 1.1 kefren
953 1.1 kefren for (int ri = 0; ri < replay_index; ri++) {
954 1.1 kefren debugp("Replaying: PID %d, SEQ %d\n",
955 1.1 kefren replay_rt[ri].m_rtm.rtm_pid,
956 1.1 kefren replay_rt[ri].m_rtm.rtm_seq);
957 1.1 kefren check_route(&replay_rt[ri], sizeof(struct rt_msg));
958 1.1 kefren }
959 1.1 kefren replay_index = 0;
960 1.1 kefren } /* for (;;) */
961 1.1 kefren }
962 1.1 kefren
963 1.1 kefren void
964 1.1 kefren new_peer_connection()
965 1.1 kefren {
966 1.25 kefren union sockunion peer_address, my_address;
967 1.25 kefren struct in_addr *peer_ldp_id = NULL;
968 1.25 kefren struct hello_info *hi;
969 1.28 kefren int s;
970 1.1 kefren
971 1.25 kefren s = accept(ls, &peer_address.sa,
972 1.25 kefren & (socklen_t) { sizeof(union sockunion) } );
973 1.1 kefren if (s < 0) {
974 1.1 kefren fatalp("accept: %s", strerror(errno));
975 1.1 kefren return;
976 1.1 kefren }
977 1.1 kefren
978 1.25 kefren if (getsockname(s, &my_address.sa,
979 1.25 kefren & (socklen_t) { sizeof(union sockunion) } )) {
980 1.1 kefren fatalp("new_peer_connection(): cannot getsockname\n");
981 1.1 kefren close(s);
982 1.1 kefren return;
983 1.1 kefren }
984 1.26 kefren
985 1.25 kefren if (peer_address.sa.sa_family == AF_INET)
986 1.25 kefren peer_address.sin.sin_port = 0;
987 1.25 kefren else if (peer_address.sa.sa_family == AF_INET6)
988 1.25 kefren peer_address.sin6.sin6_port = 0;
989 1.25 kefren else {
990 1.25 kefren fatalp("Unknown peer address family\n");
991 1.25 kefren close(s);
992 1.25 kefren return;
993 1.25 kefren }
994 1.1 kefren
995 1.26 kefren /* Already peered or in holddown ? */
996 1.26 kefren if (get_ldp_peer(&peer_address.sa) != NULL) {
997 1.26 kefren close(s);
998 1.26 kefren return;
999 1.26 kefren }
1000 1.26 kefren
1001 1.26 kefren warnp("Accepted a connection from %s\n", satos(&peer_address.sa));
1002 1.26 kefren
1003 1.25 kefren /* Verify if it should connect - XXX: no check for INET6 */
1004 1.25 kefren if (peer_address.sa.sa_family == AF_INET &&
1005 1.25 kefren ntohl(peer_address.sin.sin_addr.s_addr) <
1006 1.25 kefren ntohl(my_address.sin.sin_addr.s_addr)) {
1007 1.1 kefren fatalp("Peer %s: connect from lower ID\n",
1008 1.25 kefren satos(&peer_address.sa));
1009 1.1 kefren close(s);
1010 1.1 kefren return;
1011 1.1 kefren }
1012 1.25 kefren
1013 1.25 kefren /* Match hello info in order to get ldp_id */
1014 1.25 kefren SLIST_FOREACH(hi, &hello_info_head, infos) {
1015 1.25 kefren if (sockaddr_cmp(&peer_address.sa,
1016 1.25 kefren &hi->transport_address.sa) == 0) {
1017 1.25 kefren peer_ldp_id = &hi->ldp_id;
1018 1.25 kefren break;
1019 1.25 kefren }
1020 1.25 kefren }
1021 1.25 kefren if (peer_ldp_id == NULL) {
1022 1.29 kefren warnp("Got connection from %s, but no hello info exists\n",
1023 1.25 kefren satos(&peer_address.sa));
1024 1.25 kefren close(s);
1025 1.25 kefren return;
1026 1.25 kefren } else
1027 1.25 kefren ldp_peer_new(peer_ldp_id, &peer_address.sa, NULL,
1028 1.25 kefren ldp_holddown_time, s);
1029 1.1 kefren
1030 1.1 kefren }
1031 1.1 kefren
1032 1.1 kefren void
1033 1.28 kefren send_initialize(const struct ldp_peer * p)
1034 1.1 kefren {
1035 1.1 kefren struct init_tlv ti;
1036 1.1 kefren
1037 1.1 kefren ti.type = htons(LDP_INITIALIZE);
1038 1.1 kefren ti.length = htons(sizeof(struct init_tlv) - TLV_TYPE_LENGTH);
1039 1.1 kefren ti.messageid = htonl(get_message_id());
1040 1.1 kefren ti.cs_type = htons(TLV_COMMON_SESSION);
1041 1.1 kefren ti.cs_len = htons(CS_LEN);
1042 1.1 kefren ti.cs_version = htons(LDP_VERSION);
1043 1.3 kefren ti.cs_keepalive = htons(2 * ldp_keepalive_time);
1044 1.1 kefren ti.cs_adpvlim = 0;
1045 1.1 kefren ti.cs_maxpdulen = htons(MAX_PDU_SIZE);
1046 1.1 kefren ti.cs_peeraddress.s_addr = p->ldp_id.s_addr;
1047 1.1 kefren ti.cs_peeraddrspace = 0;
1048 1.1 kefren
1049 1.1 kefren send_tlv(p, (struct tlv *) (void *) &ti);
1050 1.1 kefren }
1051 1.1 kefren
1052 1.1 kefren void
1053 1.28 kefren keep_alive(const struct ldp_peer * p)
1054 1.1 kefren {
1055 1.1 kefren struct ka_tlv kt;
1056 1.1 kefren
1057 1.1 kefren kt.type = htons(LDP_KEEPALIVE);
1058 1.1 kefren kt.length = htons(sizeof(kt.messageid));
1059 1.1 kefren kt.messageid = htonl(get_message_id());
1060 1.1 kefren
1061 1.1 kefren send_tlv(p, (struct tlv *) (void *) &kt);
1062 1.1 kefren }
1063 1.1 kefren
1064 1.29 kefren /*
1065 1.29 kefren * Process a message received from a peer
1066 1.29 kefren */
1067 1.29 kefren void
1068 1.1 kefren recv_session_pdu(struct ldp_peer * p)
1069 1.1 kefren {
1070 1.1 kefren struct ldp_pdu *rpdu;
1071 1.1 kefren struct address_tlv *atlv;
1072 1.1 kefren struct al_tlv *altlv;
1073 1.1 kefren struct init_tlv *itlv;
1074 1.1 kefren struct label_map_tlv *lmtlv;
1075 1.1 kefren struct fec_tlv *fectlv;
1076 1.6 joerg struct label_tlv *labeltlv;
1077 1.1 kefren struct notification_tlv *nottlv;
1078 1.1 kefren struct hello_info *hi;
1079 1.1 kefren
1080 1.1 kefren int c;
1081 1.1 kefren int32_t wo = 0;
1082 1.1 kefren struct tlv *ttmp;
1083 1.1 kefren unsigned char recvspace[MAX_PDU_SIZE];
1084 1.1 kefren
1085 1.1 kefren memset(recvspace, 0, MAX_PDU_SIZE);
1086 1.1 kefren
1087 1.30 kefren do {
1088 1.30 kefren c = recv(p->socket, (void *) recvspace, MAX_PDU_SIZE, MSG_PEEK);
1089 1.30 kefren } while (c == -1 && errno == EINTR);
1090 1.1 kefren
1091 1.1 kefren debugp("Ready to read %d bytes\n", c);
1092 1.1 kefren
1093 1.1 kefren if (c < 1) { /* Session closed */
1094 1.1 kefren warnp("Error in connection with %s\n", inet_ntoa(p->ldp_id));
1095 1.1 kefren ldp_peer_holddown(p);
1096 1.1 kefren return;
1097 1.1 kefren }
1098 1.1 kefren if (c > MAX_PDU_SIZE) {
1099 1.1 kefren debugp("Incoming PDU size exceeds MAX_PDU_SIZE !\n");
1100 1.1 kefren return;
1101 1.1 kefren }
1102 1.1 kefren if (c < MIN_PDU_SIZE) {
1103 1.28 kefren debugp("PDU too small received from peer %s\n",
1104 1.28 kefren inet_ntoa(p->ldp_id));
1105 1.1 kefren return;
1106 1.1 kefren }
1107 1.1 kefren rpdu = (struct ldp_pdu *) recvspace;
1108 1.30 kefren do {
1109 1.30 kefren c = recv(p->socket, (void *) recvspace,
1110 1.30 kefren ntohs(rpdu->length) + PDU_VER_LENGTH, MSG_WAITALL);
1111 1.30 kefren } while (c == -1 && errno == EINTR);
1112 1.1 kefren
1113 1.30 kefren /* sanity check */
1114 1.1 kefren if (check_recv_pdu(p, rpdu, c) != 0)
1115 1.1 kefren return;
1116 1.1 kefren
1117 1.1 kefren debugp("Read %d bytes, PDU size: %d bytes\n", c, ntohs(rpdu->length));
1118 1.1 kefren wo = sizeof(struct ldp_pdu);
1119 1.1 kefren
1120 1.1 kefren while (wo + TLV_TYPE_LENGTH < (uint)c) {
1121 1.1 kefren
1122 1.1 kefren ttmp = (struct tlv *) (&recvspace[wo]);
1123 1.1 kefren
1124 1.1 kefren if ((ntohs(ttmp->type) != LDP_KEEPALIVE) &&
1125 1.1 kefren (ntohs(ttmp->type) != LDP_LABEL_MAPPING)) {
1126 1.1 kefren debugp("Got Type: 0x%.4X (Length: %d) from %s\n",
1127 1.1 kefren ntohs(ttmp->type), ntohs(ttmp->length),
1128 1.1 kefren inet_ntoa(p->ldp_id));
1129 1.1 kefren } else
1130 1.1 kefren debugp("Got Type: 0x%.4X (Length: %d) from %s\n",
1131 1.1 kefren ntohs(ttmp->type), ntohs(ttmp->length),
1132 1.1 kefren inet_ntoa(p->ldp_id));
1133 1.1 kefren
1134 1.1 kefren /* Should we get the message ? */
1135 1.1 kefren if (p->state != LDP_PEER_ESTABLISHED &&
1136 1.1 kefren ntohs(ttmp->type) != LDP_INITIALIZE &&
1137 1.22 kefren ntohs(ttmp->type) != LDP_KEEPALIVE &&
1138 1.22 kefren ntohs(ttmp->type) != LDP_NOTIFICATION)
1139 1.1 kefren break;
1140 1.1 kefren /* The big switch */
1141 1.1 kefren switch (ntohs(ttmp->type)) {
1142 1.1 kefren case LDP_INITIALIZE:
1143 1.1 kefren itlv = (struct init_tlv *)ttmp;
1144 1.1 kefren /* Check size */
1145 1.1 kefren if (ntohs(itlv->length) <
1146 1.1 kefren sizeof(struct init_tlv) - TLV_TYPE_LENGTH) {
1147 1.17 kefren debugp("Bad size\n");
1148 1.1 kefren send_notification(p, 0,
1149 1.1 kefren NOTIF_BAD_PDU_LEN | NOTIF_FATAL);
1150 1.1 kefren ldp_peer_holddown(p);
1151 1.1 kefren break;
1152 1.1 kefren }
1153 1.1 kefren /* Check version */
1154 1.1 kefren if (ntohs(itlv->cs_version) != LDP_VERSION) {
1155 1.17 kefren debugp("Bad version");
1156 1.1 kefren send_notification(p, ntohl(itlv->messageid),
1157 1.1 kefren NOTIF_BAD_LDP_VER | NOTIF_FATAL);
1158 1.1 kefren ldp_peer_holddown(p);
1159 1.1 kefren break;
1160 1.1 kefren }
1161 1.1 kefren /* Check if we got any hello from this one */
1162 1.1 kefren SLIST_FOREACH(hi, &hello_info_head, infos)
1163 1.1 kefren if (hi->ldp_id.s_addr == rpdu->ldp_id.s_addr)
1164 1.1 kefren break;
1165 1.1 kefren if (hi == NULL) {
1166 1.17 kefren debugp("No hello. Moving peer to holddown\n");
1167 1.1 kefren send_notification(p, ntohl(itlv->messageid),
1168 1.1 kefren NOTIF_SESSION_REJECTED_NO_HELLO | NOTIF_FATAL);
1169 1.1 kefren ldp_peer_holddown(p);
1170 1.1 kefren break;
1171 1.1 kefren }
1172 1.1 kefren
1173 1.1 kefren if (!p->master) {
1174 1.27 kefren send_initialize(p);
1175 1.1 kefren keep_alive(p);
1176 1.1 kefren } else {
1177 1.1 kefren p->state = LDP_PEER_ESTABLISHED;
1178 1.1 kefren p->established_t = time(NULL);
1179 1.1 kefren keep_alive(p);
1180 1.1 kefren
1181 1.1 kefren /*
1182 1.1 kefren * Recheck here ldp id because we accepted
1183 1.1 kefren * connection without knowing who is it for sure
1184 1.1 kefren */
1185 1.1 kefren p->ldp_id.s_addr = rpdu->ldp_id.s_addr;
1186 1.1 kefren
1187 1.1 kefren fatalp("LDP neighbour %s is UP\n",
1188 1.1 kefren inet_ntoa(p->ldp_id));
1189 1.1 kefren mpls_add_ldp_peer(p);
1190 1.1 kefren send_addresses(p);
1191 1.1 kefren send_all_bindings(p);
1192 1.1 kefren }
1193 1.1 kefren break;
1194 1.1 kefren case LDP_KEEPALIVE:
1195 1.1 kefren if ((p->state == LDP_PEER_CONNECTED) && (!p->master)) {
1196 1.1 kefren p->state = LDP_PEER_ESTABLISHED;
1197 1.1 kefren p->established_t = time(NULL);
1198 1.1 kefren fatalp("LDP neighbour %s is UP\n",
1199 1.1 kefren inet_ntoa(p->ldp_id));
1200 1.1 kefren mpls_add_ldp_peer(p);
1201 1.1 kefren send_addresses(p);
1202 1.1 kefren send_all_bindings(p);
1203 1.1 kefren }
1204 1.1 kefren p->timeout = p->holdtime;
1205 1.1 kefren break;
1206 1.1 kefren case LDP_ADDRESS:
1207 1.1 kefren /* Add peer addresses */
1208 1.1 kefren atlv = (struct address_tlv *) ttmp;
1209 1.1 kefren altlv = (struct al_tlv *) (&atlv[1]);
1210 1.1 kefren add_ifaddresses(p, altlv);
1211 1.29 kefren /*
1212 1.29 kefren * try to see if we have labels with null peer that
1213 1.29 kefren * would match the new peer
1214 1.29 kefren */
1215 1.29 kefren label_check_assoc(p);
1216 1.1 kefren print_bounded_addresses(p);
1217 1.1 kefren break;
1218 1.1 kefren case LDP_ADDRESS_WITHDRAW:
1219 1.1 kefren atlv = (struct address_tlv *) ttmp;
1220 1.1 kefren altlv = (struct al_tlv *) (&atlv[1]);
1221 1.1 kefren del_ifaddresses(p, altlv);
1222 1.1 kefren break;
1223 1.1 kefren case LDP_LABEL_MAPPING:
1224 1.1 kefren lmtlv = (struct label_map_tlv *) ttmp;
1225 1.1 kefren fectlv = (struct fec_tlv *) (&lmtlv[1]);
1226 1.1 kefren labeltlv = (struct label_tlv *)((unsigned char *)fectlv
1227 1.1 kefren + ntohs(fectlv->length) + TLV_TYPE_LENGTH);
1228 1.1 kefren map_label(p, fectlv, labeltlv);
1229 1.1 kefren break;
1230 1.1 kefren case LDP_LABEL_REQUEST:
1231 1.1 kefren lmtlv = (struct label_map_tlv *) ttmp;
1232 1.1 kefren fectlv = (struct fec_tlv *) (&lmtlv[1]);
1233 1.1 kefren switch (request_respond(p, lmtlv, fectlv)) {
1234 1.1 kefren case LDP_E_BAD_FEC:
1235 1.1 kefren send_notification(p, ntohl(lmtlv->messageid),
1236 1.1 kefren NOTIF_UNKNOWN_TLV);
1237 1.1 kefren break;
1238 1.1 kefren case LDP_E_BAD_AF:
1239 1.1 kefren send_notification(p, ntohl(lmtlv->messageid),
1240 1.1 kefren NOTIF_UNSUPPORTED_AF);
1241 1.1 kefren break;
1242 1.1 kefren case LDP_E_NO_SUCH_ROUTE:
1243 1.1 kefren send_notification(p, ntohl(lmtlv->messageid),
1244 1.1 kefren NOTIF_NO_ROUTE);
1245 1.1 kefren break;
1246 1.1 kefren }
1247 1.1 kefren break;
1248 1.1 kefren case LDP_LABEL_WITHDRAW:
1249 1.1 kefren lmtlv = (struct label_map_tlv *) ttmp;
1250 1.1 kefren fectlv = (struct fec_tlv *) (&lmtlv[1]);
1251 1.1 kefren if (withdraw_label(p, fectlv) == LDP_E_OK) {
1252 1.1 kefren /* Send RELEASE */
1253 1.1 kefren prepare_release(ttmp);
1254 1.1 kefren send_tlv(p, ttmp);
1255 1.1 kefren }
1256 1.1 kefren break;
1257 1.1 kefren case LDP_LABEL_RELEASE:
1258 1.1 kefren /*
1259 1.1 kefren * XXX: we need to make a timed queue...
1260 1.1 kefren * For now I just assume peers are processing messages
1261 1.1 kefren * correctly so I just ignore confirmations
1262 1.1 kefren */
1263 1.1 kefren wo = -1; /* Ignore rest of message */
1264 1.1 kefren break;
1265 1.1 kefren case LDP_LABEL_ABORT:
1266 1.1 kefren /* XXX: For now I pretend I can process everything
1267 1.12 kefren * RFC 5036, Section 3.5.9.1
1268 1.1 kefren * If an LSR receives a Label Abort Request Message after it
1269 1.1 kefren * has responded to the Label Request in question with a Label
1270 1.1 kefren * Mapping message or a Notification message, it ignores the
1271 1.1 kefren * abort request.
1272 1.1 kefren */
1273 1.1 kefren wo = -1;
1274 1.1 kefren break;
1275 1.1 kefren case LDP_NOTIFICATION:
1276 1.1 kefren nottlv = (struct notification_tlv *) ttmp;
1277 1.1 kefren nottlv->st_code = ntohl(nottlv->st_code);
1278 1.1 kefren fatalp("Got notification 0x%X from peer %s\n",
1279 1.1 kefren nottlv->st_code, inet_ntoa(p->ldp_id));
1280 1.1 kefren if (nottlv->st_code >> 31) {
1281 1.1 kefren fatalp("LDP peer %s signalized %s\n",
1282 1.1 kefren inet_ntoa(p->ldp_id),
1283 1.1 kefren NOTIF_STR[(nottlv->st_code << 1) >> 1]);
1284 1.1 kefren ldp_peer_holddown(p);
1285 1.1 kefren wo = -1;
1286 1.1 kefren }
1287 1.1 kefren break;
1288 1.1 kefren case LDP_HELLO:
1289 1.1 kefren /* No hellos should came on tcp session */
1290 1.1 kefren wo = -1;
1291 1.1 kefren break;
1292 1.1 kefren default:
1293 1.1 kefren warnp("Unknown TLV received from %s\n",
1294 1.1 kefren inet_ntoa(p->ldp_id));
1295 1.1 kefren debug_tlv(ttmp);
1296 1.1 kefren wo = -1;/* discard the rest of the message */
1297 1.1 kefren break;
1298 1.1 kefren }
1299 1.1 kefren if (wo < 0) {
1300 1.1 kefren debugp("Discarding the rest of the message\n");
1301 1.1 kefren break;
1302 1.1 kefren } else {
1303 1.1 kefren wo += ntohs(ttmp->length) + TLV_TYPE_LENGTH;
1304 1.1 kefren debugp("WORKED ON %u bytes (Left %d)\n", wo, c - wo);
1305 1.1 kefren }
1306 1.1 kefren } /* while */
1307 1.1 kefren
1308 1.1 kefren }
1309 1.1 kefren
1310 1.1 kefren /* Sends a pdu, tlv pair to a connected peer */
1311 1.1 kefren int
1312 1.28 kefren send_message(const struct ldp_peer * p, const struct ldp_pdu * pdu,
1313 1.28 kefren const struct tlv * t)
1314 1.1 kefren {
1315 1.1 kefren unsigned char sendspace[MAX_PDU_SIZE];
1316 1.1 kefren
1317 1.1 kefren /* Check if peer is connected */
1318 1.1 kefren switch (p->state) {
1319 1.1 kefren case LDP_PEER_CONNECTED:
1320 1.1 kefren case LDP_PEER_ESTABLISHED:
1321 1.1 kefren break;
1322 1.1 kefren default:
1323 1.1 kefren return -1;
1324 1.1 kefren }
1325 1.1 kefren
1326 1.1 kefren /* Check length validity first */
1327 1.1 kefren if (ntohs(pdu->length) !=
1328 1.1 kefren ntohs(t->length) + TLV_TYPE_LENGTH + PDU_PAYLOAD_LENGTH) {
1329 1.1 kefren fatalp("LDP: TLV - PDU incompability. Message discarded\n");
1330 1.1 kefren fatalp("LDP: TLV len %d - PDU len %d\n", ntohs(t->length),
1331 1.1 kefren ntohs(pdu->length));
1332 1.1 kefren return -1;
1333 1.1 kefren }
1334 1.1 kefren if (ntohs(t->length) + PDU_VER_LENGTH > MAX_PDU_SIZE) {
1335 1.1 kefren fatalp("Message to large discarded\n");
1336 1.1 kefren return -1;
1337 1.1 kefren }
1338 1.1 kefren /* Arrange them in a buffer and send */
1339 1.1 kefren memcpy(sendspace, pdu, sizeof(struct ldp_pdu));
1340 1.1 kefren memcpy(sendspace + sizeof(struct ldp_pdu), t,
1341 1.1 kefren ntohs(t->length) + TLV_TYPE_LENGTH);
1342 1.1 kefren
1343 1.1 kefren /* Report keepalives only for DEBUG */
1344 1.1 kefren if ((ntohs(t->type) != 0x201) && (ntohs(t->type) != 0x400)) {
1345 1.1 kefren debugp("Sending message type 0x%.4X to %s (size: %d)\n",
1346 1.1 kefren ntohs(t->type), inet_ntoa(p->ldp_id), ntohs(t->length));
1347 1.1 kefren } else
1348 1.1 kefren /* downgraded from warnp to debugp for now */
1349 1.1 kefren debugp("Sending message type 0x%.4X to %s (size: %d)\n",
1350 1.1 kefren ntohs(t->type), inet_ntoa(p->ldp_id), ntohs(t->length));
1351 1.1 kefren
1352 1.1 kefren /* Send it finally */
1353 1.1 kefren return send(p->socket, sendspace,
1354 1.1 kefren ntohs(pdu->length) + PDU_VER_LENGTH, 0);
1355 1.1 kefren }
1356 1.1 kefren
1357 1.1 kefren /*
1358 1.1 kefren * Encapsulates TLV into a PDU and sends it to a peer
1359 1.1 kefren */
1360 1.1 kefren int
1361 1.28 kefren send_tlv(const struct ldp_peer * p, const struct tlv * t)
1362 1.1 kefren {
1363 1.1 kefren struct ldp_pdu pdu;
1364 1.1 kefren
1365 1.1 kefren pdu.version = htons(LDP_VERSION);
1366 1.1 kefren inet_aton(LDP_ID, &pdu.ldp_id);
1367 1.1 kefren pdu.label_space = 0;
1368 1.1 kefren pdu.length = htons(ntohs(t->length) + TLV_TYPE_LENGTH +
1369 1.1 kefren PDU_PAYLOAD_LENGTH);
1370 1.1 kefren
1371 1.1 kefren return send_message(p, &pdu, t);
1372 1.1 kefren }
1373 1.1 kefren
1374 1.1 kefren
1375 1.1 kefren int
1376 1.28 kefren send_addresses(const struct ldp_peer * p)
1377 1.1 kefren {
1378 1.1 kefren struct address_list_tlv *t;
1379 1.1 kefren int ret;
1380 1.1 kefren
1381 1.1 kefren t = build_address_list_tlv();
1382 1.1 kefren
1383 1.1 kefren ret = send_tlv(p, (struct tlv *) t);
1384 1.1 kefren free(t);
1385 1.1 kefren return ret;
1386 1.1 kefren
1387 1.1 kefren }
1388