]> git.proxmox.com Git - mirror_frr.git/blob - zebra/zebra_ptm.c
zebra: Always read full zapi message in ptm code
[mirror_frr.git] / zebra / zebra_ptm.c
1 /* Kernel routing table updates using netlink over GNU/Linux system.
2 * Copyright (C) 1997, 98, 99 Kunihiro Ishiguro
3 *
4 * This file is part of GNU Zebra.
5 *
6 * GNU Zebra is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License as published by the
8 * Free Software Foundation; either version 2, or (at your option) any
9 * later version.
10 *
11 * GNU Zebra is distributed in the hope that it will be useful, but
12 * WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License along
17 * with this program; see the file COPYING; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
19 */
20
21 #include <zebra.h>
22 #include <sys/un.h> /* for sockaddr_un */
23 #include <net/if.h>
24 #include "vty.h"
25 #include "zebra/zserv.h"
26 #include "zebra/interface.h"
27 #include "zebra/debug.h"
28 #include "zebra/zebra_ptm.h"
29 #include "if.h"
30 #include "command.h"
31 #include "stream.h"
32 #include "ptm_lib.h"
33 #include "network.h"
34 #include "buffer.h"
35 #include "zebra/zebra_ptm_redistribute.h"
36 #include "bfd.h"
37 #include "vrf.h"
38 #include "rib.h"
39 #include "zebra_vrf.h"
40 #include "version.h"
41
42 #define ZEBRA_PTM_RECONNECT_TIME_INITIAL 1 /* initial reconnect is 1s */
43 #define ZEBRA_PTM_RECONNECT_TIME_MAX 300
44
45 #define PTM_MSG_LEN 4
46 #define PTM_HEADER_LEN 37
47
48 const char ZEBRA_PTM_GET_STATUS_CMD[] = "get-status";
49 const char ZEBRA_PTM_BFD_START_CMD[] = "start-bfd-sess";
50 const char ZEBRA_PTM_BFD_STOP_CMD[] = "stop-bfd-sess";
51 const char ZEBRA_PTM_BFD_CLIENT_REG_CMD[] = "reg-bfd-client";
52 const char ZEBRA_PTM_BFD_CLIENT_DEREG_CMD[] = "dereg-bfd-client";
53
54 const char ZEBRA_PTM_CMD_STR[] = "cmd";
55 const char ZEBRA_PTM_CMD_STATUS_STR[] = "cmd_status";
56 const char ZEBRA_PTM_PORT_STR[] = "port";
57 const char ZEBRA_PTM_CBL_STR[] = "cbl status";
58 const char ZEBRA_PTM_PASS_STR[] = "pass";
59 const char ZEBRA_PTM_FAIL_STR[] = "fail";
60 const char ZEBRA_PTM_BFDSTATUS_STR[] = "state";
61 const char ZEBRA_PTM_BFDSTATUS_UP_STR[] = "Up";
62 const char ZEBRA_PTM_BFDSTATUS_DOWN_STR[] = "Down";
63 const char ZEBRA_PTM_BFDDEST_STR[] = "peer";
64 const char ZEBRA_PTM_BFDSRC_STR[] = "local";
65 const char ZEBRA_PTM_BFDVRF_STR[] = "vrf";
66 const char ZEBRA_PTM_INVALID_PORT_NAME[] = "N/A";
67 const char ZEBRA_PTM_INVALID_SRC_IP[] = "N/A";
68 const char ZEBRA_PTM_INVALID_VRF[] = "N/A";
69
70 const char ZEBRA_PTM_BFD_DST_IP_FIELD[] = "dstIPaddr";
71 const char ZEBRA_PTM_BFD_SRC_IP_FIELD[] = "srcIPaddr";
72 const char ZEBRA_PTM_BFD_MIN_RX_FIELD[] = "requiredMinRx";
73 const char ZEBRA_PTM_BFD_MIN_TX_FIELD[] = "upMinTx";
74 const char ZEBRA_PTM_BFD_DETECT_MULT_FIELD[] = "detectMult";
75 const char ZEBRA_PTM_BFD_MULTI_HOP_FIELD[] = "multiHop";
76 const char ZEBRA_PTM_BFD_CLIENT_FIELD[] = "client";
77 const char ZEBRA_PTM_BFD_SEQID_FIELD[] = "seqid";
78 const char ZEBRA_PTM_BFD_IFNAME_FIELD[] = "ifName";
79 const char ZEBRA_PTM_BFD_MAX_HOP_CNT_FIELD[] = "maxHopCnt";
80 const char ZEBRA_PTM_BFD_SEND_EVENT[] = "sendEvent";
81 const char ZEBRA_PTM_BFD_VRF_NAME_FIELD[] = "vrfName";
82
83 static ptm_lib_handle_t *ptm_hdl;
84
85 struct zebra_ptm_cb ptm_cb;
86
87 static int zebra_ptm_socket_init(void);
88 int zebra_ptm_sock_read(struct thread *);
89 static void zebra_ptm_install_commands(void);
90 static int zebra_ptm_handle_msg_cb(void *arg, void *in_ctxt);
91 void zebra_bfd_peer_replay_req(void);
92 void zebra_ptm_send_status_req(void);
93 void zebra_ptm_reset_status(int ptm_disable);
94
95 const char ZEBRA_PTM_SOCK_NAME[] = "\0/var/run/ptmd.socket";
96
97 void zebra_ptm_init(void)
98 {
99 char buf[64];
100
101 memset(&ptm_cb, 0, sizeof(struct zebra_ptm_cb));
102
103 ptm_cb.out_data = calloc(1, ZEBRA_PTM_SEND_MAX_SOCKBUF);
104 if (!ptm_cb.out_data) {
105 zlog_warn("%s: Allocation of send data failed", __func__);
106 return;
107 }
108
109 ptm_cb.in_data = calloc(1, ZEBRA_PTM_MAX_SOCKBUF);
110 if (!ptm_cb.in_data) {
111 zlog_warn("%s: Allocation of recv data failed", __func__);
112 free(ptm_cb.out_data);
113 return;
114 }
115
116 ptm_cb.pid = getpid();
117 zebra_ptm_install_commands();
118
119 sprintf(buf, "%s", FRR_PTM_NAME);
120 ptm_hdl = ptm_lib_register(buf, NULL, zebra_ptm_handle_msg_cb,
121 zebra_ptm_handle_msg_cb);
122 ptm_cb.wb = buffer_new(0);
123
124 ptm_cb.reconnect_time = ZEBRA_PTM_RECONNECT_TIME_INITIAL;
125
126 ptm_cb.ptm_sock = -1;
127 }
128
129 void zebra_ptm_finish(void)
130 {
131 int proto;
132
133 for (proto = 0; proto < ZEBRA_ROUTE_MAX; proto++)
134 if (CHECK_FLAG(ptm_cb.client_flags[proto],
135 ZEBRA_PTM_BFD_CLIENT_FLAG_REG))
136 zebra_ptm_bfd_client_deregister(proto);
137
138 buffer_flush_all(ptm_cb.wb, ptm_cb.ptm_sock);
139
140 free(ptm_hdl);
141
142 if (ptm_cb.out_data)
143 free(ptm_cb.out_data);
144
145 if (ptm_cb.in_data)
146 free(ptm_cb.in_data);
147
148 /* Release threads. */
149 if (ptm_cb.t_read)
150 thread_cancel(ptm_cb.t_read);
151 if (ptm_cb.t_write)
152 thread_cancel(ptm_cb.t_write);
153 if (ptm_cb.t_timer)
154 thread_cancel(ptm_cb.t_timer);
155
156 if (ptm_cb.wb)
157 buffer_free(ptm_cb.wb);
158
159 if (ptm_cb.ptm_sock >= 0)
160 close(ptm_cb.ptm_sock);
161 }
162
163 static int zebra_ptm_flush_messages(struct thread *thread)
164 {
165 ptm_cb.t_write = NULL;
166
167 if (ptm_cb.ptm_sock == -1)
168 return -1;
169
170 errno = 0;
171
172 switch (buffer_flush_available(ptm_cb.wb, ptm_cb.ptm_sock)) {
173 case BUFFER_ERROR:
174 zlog_warn("%s ptm socket error: %s", __func__,
175 safe_strerror(errno));
176 close(ptm_cb.ptm_sock);
177 ptm_cb.ptm_sock = -1;
178 zebra_ptm_reset_status(0);
179 ptm_cb.t_timer = NULL;
180 thread_add_timer(zebrad.master, zebra_ptm_connect, NULL,
181 ptm_cb.reconnect_time, &ptm_cb.t_timer);
182 return (-1);
183 case BUFFER_PENDING:
184 ptm_cb.t_write = NULL;
185 thread_add_write(zebrad.master, zebra_ptm_flush_messages, NULL,
186 ptm_cb.ptm_sock, &ptm_cb.t_write);
187 break;
188 case BUFFER_EMPTY:
189 break;
190 }
191
192 return (0);
193 }
194
195 static int zebra_ptm_send_message(char *data, int size)
196 {
197 errno = 0;
198 switch (buffer_write(ptm_cb.wb, ptm_cb.ptm_sock, data, size)) {
199 case BUFFER_ERROR:
200 zlog_warn("%s ptm socket error: %s", __func__,
201 safe_strerror(errno));
202 close(ptm_cb.ptm_sock);
203 ptm_cb.ptm_sock = -1;
204 zebra_ptm_reset_status(0);
205 ptm_cb.t_timer = NULL;
206 thread_add_timer(zebrad.master, zebra_ptm_connect, NULL,
207 ptm_cb.reconnect_time, &ptm_cb.t_timer);
208 return -1;
209 case BUFFER_EMPTY:
210 THREAD_OFF(ptm_cb.t_write);
211 break;
212 case BUFFER_PENDING:
213 thread_add_write(zebrad.master, zebra_ptm_flush_messages, NULL,
214 ptm_cb.ptm_sock, &ptm_cb.t_write);
215 break;
216 }
217
218 return 0;
219 }
220
221 int zebra_ptm_connect(struct thread *t)
222 {
223 int init = 0;
224
225 if (ptm_cb.ptm_sock == -1) {
226 zebra_ptm_socket_init();
227 init = 1;
228 }
229
230 if (ptm_cb.ptm_sock != -1) {
231 if (init) {
232 ptm_cb.t_read = NULL;
233 thread_add_read(zebrad.master, zebra_ptm_sock_read,
234 NULL, ptm_cb.ptm_sock, &ptm_cb.t_read);
235 zebra_bfd_peer_replay_req();
236 }
237 zebra_ptm_send_status_req();
238 ptm_cb.reconnect_time = ZEBRA_PTM_RECONNECT_TIME_INITIAL;
239 } else if (ptm_cb.reconnect_time < ZEBRA_PTM_RECONNECT_TIME_MAX) {
240 ptm_cb.reconnect_time *= 2;
241 if (ptm_cb.reconnect_time > ZEBRA_PTM_RECONNECT_TIME_MAX)
242 ptm_cb.reconnect_time = ZEBRA_PTM_RECONNECT_TIME_MAX;
243
244 ptm_cb.t_timer = NULL;
245 thread_add_timer(zebrad.master, zebra_ptm_connect, NULL,
246 ptm_cb.reconnect_time, &ptm_cb.t_timer);
247 } else if (ptm_cb.reconnect_time >= ZEBRA_PTM_RECONNECT_TIME_MAX) {
248 ptm_cb.reconnect_time = ZEBRA_PTM_RECONNECT_TIME_INITIAL;
249 }
250
251 return (errno);
252 }
253
254 DEFUN (zebra_ptm_enable,
255 zebra_ptm_enable_cmd,
256 "ptm-enable",
257 "Enable neighbor check with specified topology\n")
258 {
259 struct vrf *vrf;
260 struct interface *ifp;
261 struct zebra_if *if_data;
262
263 ptm_cb.ptm_enable = ZEBRA_IF_PTM_ENABLE_ON;
264
265 RB_FOREACH (vrf, vrf_name_head, &vrfs_by_name)
266 FOR_ALL_INTERFACES (vrf, ifp)
267 if (!ifp->ptm_enable) {
268 if_data = (struct zebra_if *)ifp->info;
269 if (if_data
270 && (if_data->ptm_enable
271 == ZEBRA_IF_PTM_ENABLE_UNSPEC)) {
272 ifp->ptm_enable =
273 ZEBRA_IF_PTM_ENABLE_ON;
274 }
275 /* Assign a default unknown status */
276 ifp->ptm_status = ZEBRA_PTM_STATUS_UNKNOWN;
277 }
278
279 zebra_ptm_connect(NULL);
280
281 return CMD_SUCCESS;
282 }
283
284 DEFUN (no_zebra_ptm_enable,
285 no_zebra_ptm_enable_cmd,
286 "no ptm-enable",
287 NO_STR
288 "Enable neighbor check with specified topology\n")
289 {
290 ptm_cb.ptm_enable = ZEBRA_IF_PTM_ENABLE_OFF;
291 zebra_ptm_reset_status(1);
292 return CMD_SUCCESS;
293 }
294
295 DEFUN (zebra_ptm_enable_if,
296 zebra_ptm_enable_if_cmd,
297 "ptm-enable",
298 "Enable neighbor check with specified topology\n")
299 {
300 VTY_DECLVAR_CONTEXT(interface, ifp);
301 struct zebra_if *if_data;
302 int old_ptm_enable;
303 int send_linkdown = 0;
304
305 if (ifp->ifindex == IFINDEX_INTERNAL) {
306 return CMD_SUCCESS;
307 }
308
309 old_ptm_enable = ifp->ptm_enable;
310 ifp->ptm_enable = ptm_cb.ptm_enable;
311
312 if (if_is_no_ptm_operative(ifp))
313 send_linkdown = 1;
314
315 if (!old_ptm_enable && ptm_cb.ptm_enable) {
316 if (!if_is_operative(ifp) && send_linkdown) {
317 if (IS_ZEBRA_DEBUG_EVENT)
318 zlog_debug("%s: Bringing down interface %s\n",
319 __func__, ifp->name);
320 if_down(ifp);
321 }
322 }
323
324 if_data = ifp->info;
325 if_data->ptm_enable = ZEBRA_IF_PTM_ENABLE_UNSPEC;
326
327 return CMD_SUCCESS;
328 }
329
330 DEFUN (no_zebra_ptm_enable_if,
331 no_zebra_ptm_enable_if_cmd,
332 "no ptm-enable",
333 NO_STR
334 "Enable neighbor check with specified topology\n")
335 {
336 VTY_DECLVAR_CONTEXT(interface, ifp);
337 int send_linkup = 0;
338 struct zebra_if *if_data;
339
340 if ((ifp->ifindex != IFINDEX_INTERNAL) && (ifp->ptm_enable)) {
341 if (!if_is_operative(ifp))
342 send_linkup = 1;
343
344 ifp->ptm_enable = ZEBRA_IF_PTM_ENABLE_OFF;
345 if (if_is_no_ptm_operative(ifp) && send_linkup) {
346 if (IS_ZEBRA_DEBUG_EVENT)
347 zlog_debug("%s: Bringing up interface %s\n",
348 __func__, ifp->name);
349 if_up(ifp);
350 }
351 }
352
353 if_data = ifp->info;
354 if_data->ptm_enable = ZEBRA_IF_PTM_ENABLE_OFF;
355
356 return CMD_SUCCESS;
357 }
358
359
360 void zebra_ptm_write(struct vty *vty)
361 {
362 if (ptm_cb.ptm_enable)
363 vty_out(vty, "ptm-enable\n");
364
365 return;
366 }
367
368 static int zebra_ptm_socket_init(void)
369 {
370 int ret;
371 int sock;
372 struct sockaddr_un addr;
373
374 ptm_cb.ptm_sock = -1;
375
376 sock = socket(PF_UNIX, SOCK_STREAM, 0);
377 if (sock < 0)
378 return -1;
379 if (set_nonblocking(sock) < 0) {
380 if (IS_ZEBRA_DEBUG_EVENT)
381 zlog_debug("%s: Unable to set socket non blocking[%s]",
382 __PRETTY_FUNCTION__, safe_strerror(errno));
383 close(sock);
384 return -1;
385 }
386
387 /* Make server socket. */
388 memset(&addr, 0, sizeof(struct sockaddr_un));
389 addr.sun_family = AF_UNIX;
390 memcpy(&addr.sun_path, ZEBRA_PTM_SOCK_NAME,
391 sizeof(ZEBRA_PTM_SOCK_NAME));
392
393 ret = connect(sock, (struct sockaddr *)&addr,
394 sizeof(addr.sun_family) + sizeof(ZEBRA_PTM_SOCK_NAME)
395 - 1);
396 if (ret < 0) {
397 if (IS_ZEBRA_DEBUG_EVENT)
398 zlog_debug("%s: Unable to connect to socket %s [%s]",
399 __func__, ZEBRA_PTM_SOCK_NAME,
400 safe_strerror(errno));
401 close(sock);
402 return -1;
403 }
404 ptm_cb.ptm_sock = sock;
405 return sock;
406 }
407
408 static void zebra_ptm_install_commands(void)
409 {
410 install_element(CONFIG_NODE, &zebra_ptm_enable_cmd);
411 install_element(CONFIG_NODE, &no_zebra_ptm_enable_cmd);
412 install_element(INTERFACE_NODE, &zebra_ptm_enable_if_cmd);
413 install_element(INTERFACE_NODE, &no_zebra_ptm_enable_if_cmd);
414 }
415
416 /* BFD session goes down, send message to the protocols. */
417 static void if_bfd_session_update(struct interface *ifp, struct prefix *dp,
418 struct prefix *sp, int status,
419 vrf_id_t vrf_id)
420 {
421 if (IS_ZEBRA_DEBUG_EVENT) {
422 char buf[2][INET6_ADDRSTRLEN];
423
424 if (ifp) {
425 zlog_debug(
426 "MESSAGE: ZEBRA_INTERFACE_BFD_DEST_UPDATE %s/%d on %s"
427 " %s event",
428 inet_ntop(dp->family, &dp->u.prefix, buf[0],
429 INET6_ADDRSTRLEN),
430 dp->prefixlen, ifp->name,
431 bfd_get_status_str(status));
432 } else {
433 zlog_debug(
434 "MESSAGE: ZEBRA_INTERFACE_BFD_DEST_UPDATE %s/%d "
435 "with src %s/%d and vrf %d %s event",
436 inet_ntop(dp->family, &dp->u.prefix, buf[0],
437 INET6_ADDRSTRLEN),
438 dp->prefixlen,
439 inet_ntop(sp->family, &sp->u.prefix, buf[1],
440 INET6_ADDRSTRLEN),
441 sp->prefixlen, vrf_id,
442 bfd_get_status_str(status));
443 }
444 }
445
446 zebra_interface_bfd_update(ifp, dp, sp, status, vrf_id);
447 }
448
449 static int zebra_ptm_handle_bfd_msg(void *arg, void *in_ctxt,
450 struct interface *ifp)
451 {
452 char bfdst_str[32];
453 char dest_str[64];
454 char src_str[64];
455 char vrf_str[64];
456 struct prefix dest_prefix;
457 struct prefix src_prefix;
458 vrf_id_t vrf_id;
459
460 ptm_lib_find_key_in_msg(in_ctxt, ZEBRA_PTM_BFDSTATUS_STR, bfdst_str);
461
462 if (bfdst_str[0] == '\0') {
463 return -1;
464 }
465
466 ptm_lib_find_key_in_msg(in_ctxt, ZEBRA_PTM_BFDDEST_STR, dest_str);
467
468 if (dest_str[0] == '\0') {
469 zlog_debug("%s: Key %s not found in PTM msg", __func__,
470 ZEBRA_PTM_BFDDEST_STR);
471 return -1;
472 }
473
474 ptm_lib_find_key_in_msg(in_ctxt, ZEBRA_PTM_BFDSRC_STR, src_str);
475
476 if (src_str[0] == '\0') {
477 zlog_debug("%s: Key %s not found in PTM msg", __func__,
478 ZEBRA_PTM_BFDSRC_STR);
479 return -1;
480 }
481
482 ptm_lib_find_key_in_msg(in_ctxt, ZEBRA_PTM_BFDVRF_STR, vrf_str);
483
484 if (vrf_str[0] == '\0') {
485 zlog_debug("%s: Key %s not found in PTM msg", __func__,
486 ZEBRA_PTM_BFDVRF_STR);
487 return -1;
488 }
489
490 if (IS_ZEBRA_DEBUG_EVENT)
491 zlog_debug(
492 "%s: Recv Port [%s] bfd status [%s] vrf [%s]"
493 " peer [%s] local [%s]",
494 __func__, ifp ? ifp->name : "N/A", bfdst_str, vrf_str,
495 dest_str, src_str);
496
497 if (str2prefix(dest_str, &dest_prefix) == 0) {
498 zlog_err("%s: Peer addr %s not found", __func__, dest_str);
499 return -1;
500 }
501
502 memset(&src_prefix, 0, sizeof(struct prefix));
503 if (strcmp(ZEBRA_PTM_INVALID_SRC_IP, src_str)) {
504 if (str2prefix(src_str, &src_prefix) == 0) {
505 zlog_err("%s: Local addr %s not found", __func__,
506 src_str);
507 return -1;
508 }
509 }
510
511 if (!strcmp(ZEBRA_PTM_INVALID_VRF, vrf_str) && ifp) {
512 vrf_id = ifp->vrf_id;
513 } else {
514 vrf_id = vrf_name_to_id(vrf_str);
515 }
516
517 if (!strcmp(bfdst_str, ZEBRA_PTM_BFDSTATUS_DOWN_STR)) {
518 if_bfd_session_update(ifp, &dest_prefix, &src_prefix,
519 BFD_STATUS_DOWN, vrf_id);
520 } else {
521 if_bfd_session_update(ifp, &dest_prefix, &src_prefix,
522 BFD_STATUS_UP, vrf_id);
523 }
524
525 return 0;
526 }
527
528 static int zebra_ptm_handle_cbl_msg(void *arg, void *in_ctxt,
529 struct interface *ifp, char *cbl_str)
530 {
531 int send_linkup = 0;
532
533 if (IS_ZEBRA_DEBUG_EVENT)
534 zlog_debug("%s: Recv Port [%s] cbl status [%s]", __func__,
535 ifp->name, cbl_str);
536
537 if (!strcmp(cbl_str, ZEBRA_PTM_PASS_STR)
538 && (ifp->ptm_status != ZEBRA_PTM_STATUS_UP)) {
539
540 if (ifp->ptm_status == ZEBRA_PTM_STATUS_DOWN)
541 send_linkup = 1;
542 ifp->ptm_status = ZEBRA_PTM_STATUS_UP;
543 if (ifp->ptm_enable && if_is_no_ptm_operative(ifp)
544 && send_linkup)
545 if_up(ifp);
546 } else if (!strcmp(cbl_str, ZEBRA_PTM_FAIL_STR)
547 && (ifp->ptm_status != ZEBRA_PTM_STATUS_DOWN)) {
548 ifp->ptm_status = ZEBRA_PTM_STATUS_DOWN;
549 if (ifp->ptm_enable && if_is_no_ptm_operative(ifp))
550 if_down(ifp);
551 }
552
553 return 0;
554 }
555
556 /*
557 * zebra_ptm_handle_msg_cb - The purpose of this callback function is to handle
558 * all the command responses and notifications received from PTM.
559 *
560 * Command responses: Upon establishing connection with PTM, Zebra requests
561 * status of all interfaces using 'get-status' command if global ptm-enable
562 * knob is enabled. As a response to the get-status command PTM sends status
563 * of all the interfaces as command responses. All other type of command
564 * responses with cmd_status key word are dropped. The sole purpose of
565 * registering this function as callback for the command responses is to
566 * handle the responses to get-status command.
567 *
568 * Notifications: Cable status and BFD session status changes are sent as
569 * notifications by PTM. So, this function is also the callback function for
570 * processing all the notifications from the PTM.
571 *
572 */
573 static int zebra_ptm_handle_msg_cb(void *arg, void *in_ctxt)
574 {
575 struct interface *ifp = NULL;
576 char port_str[128];
577 char cbl_str[32];
578 char cmd_status_str[32];
579
580 ptm_lib_find_key_in_msg(in_ctxt, ZEBRA_PTM_CMD_STATUS_STR,
581 cmd_status_str);
582
583 /* Drop command response messages */
584 if (cmd_status_str[0] != '\0') {
585 return 0;
586 }
587
588 ptm_lib_find_key_in_msg(in_ctxt, ZEBRA_PTM_PORT_STR, port_str);
589
590 if (port_str[0] == '\0') {
591 zlog_debug("%s: Key %s not found in PTM msg", __func__,
592 ZEBRA_PTM_PORT_STR);
593 return -1;
594 }
595
596 if (strcmp(ZEBRA_PTM_INVALID_PORT_NAME, port_str)) {
597 ifp = if_lookup_by_name_all_vrf(port_str);
598
599 if (!ifp) {
600 zlog_err("%s: %s not found in interface list", __func__,
601 port_str);
602 return -1;
603 }
604 }
605
606 ptm_lib_find_key_in_msg(in_ctxt, ZEBRA_PTM_CBL_STR, cbl_str);
607
608 if (cbl_str[0] == '\0') {
609 return zebra_ptm_handle_bfd_msg(arg, in_ctxt, ifp);
610 } else {
611 if (ifp) {
612 return zebra_ptm_handle_cbl_msg(arg, in_ctxt, ifp,
613 cbl_str);
614 } else {
615 return -1;
616 }
617 }
618 }
619
620 int zebra_ptm_sock_read(struct thread *thread)
621 {
622 int sock, done = 0;
623 int rc;
624
625 errno = 0;
626 sock = THREAD_FD(thread);
627
628 if (sock == -1)
629 return -1;
630
631 /* PTM communicates in CSV format */
632 while (!done) {
633 rc = ptm_lib_process_msg(ptm_hdl, sock, ptm_cb.in_data,
634 ZEBRA_PTM_MAX_SOCKBUF, NULL);
635 if (rc <= 0)
636 break;
637 }
638
639 if (rc <= 0) {
640 if (((rc == 0) && !errno)
641 || (errno && (errno != EWOULDBLOCK) && (errno != EAGAIN))) {
642 zlog_warn("%s routing socket error: %s(%d) bytes %d",
643 __func__, safe_strerror(errno), errno, rc);
644
645 close(ptm_cb.ptm_sock);
646 ptm_cb.ptm_sock = -1;
647 zebra_ptm_reset_status(0);
648 ptm_cb.t_timer = NULL;
649 thread_add_timer(zebrad.master, zebra_ptm_connect, NULL,
650 ptm_cb.reconnect_time,
651 &ptm_cb.t_timer);
652 return (-1);
653 }
654 }
655
656 ptm_cb.t_read = NULL;
657 thread_add_read(zebrad.master, zebra_ptm_sock_read, NULL,
658 ptm_cb.ptm_sock, &ptm_cb.t_read);
659
660 return 0;
661 }
662
663 /* BFD peer/dst register/update */
664 int zebra_ptm_bfd_dst_register(struct zserv *client, int sock, u_short length,
665 int command, struct zebra_vrf *zvrf)
666 {
667 struct stream *s;
668 struct prefix src_p;
669 struct prefix dst_p;
670 u_char multi_hop;
671 u_char multi_hop_cnt;
672 u_char detect_mul;
673 unsigned int min_rx_timer;
674 unsigned int min_tx_timer;
675 char if_name[INTERFACE_NAMSIZ];
676 u_char len;
677 void *out_ctxt;
678 char buf[INET6_ADDRSTRLEN];
679 char tmp_buf[64];
680 int data_len = ZEBRA_PTM_SEND_MAX_SOCKBUF;
681 unsigned int pid;
682
683 if (command == ZEBRA_BFD_DEST_UPDATE)
684 client->bfd_peer_upd8_cnt++;
685 else
686 client->bfd_peer_add_cnt++;
687
688 if (IS_ZEBRA_DEBUG_EVENT)
689 zlog_debug("bfd_dst_register msg from client %s: length=%d",
690 zebra_route_string(client->proto), length);
691
692 if (ptm_cb.ptm_sock == -1) {
693 ptm_cb.t_timer = NULL;
694 thread_add_timer(zebrad.master, zebra_ptm_connect, NULL,
695 ptm_cb.reconnect_time, &ptm_cb.t_timer);
696 return -1;
697 }
698
699 ptm_lib_init_msg(ptm_hdl, 0, PTMLIB_MSG_TYPE_CMD, NULL, &out_ctxt);
700 sprintf(tmp_buf, "%s", ZEBRA_PTM_BFD_START_CMD);
701 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_CMD_STR, tmp_buf);
702 sprintf(tmp_buf, "%s", zebra_route_string(client->proto));
703 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_CLIENT_FIELD,
704 tmp_buf);
705
706 s = client->ibuf;
707
708 pid = stream_getl(s);
709 sprintf(tmp_buf, "%d", pid);
710 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_SEQID_FIELD,
711 tmp_buf);
712
713 dst_p.family = stream_getw(s);
714
715 if (dst_p.family == AF_INET)
716 dst_p.prefixlen = IPV4_MAX_BYTELEN;
717 else
718 dst_p.prefixlen = IPV6_MAX_BYTELEN;
719
720 stream_get(&dst_p.u.prefix, s, dst_p.prefixlen);
721 if (dst_p.family == AF_INET) {
722 inet_ntop(AF_INET, &dst_p.u.prefix4, buf, sizeof(buf));
723 ptm_lib_append_msg(ptm_hdl, out_ctxt,
724 ZEBRA_PTM_BFD_DST_IP_FIELD, buf);
725 } else {
726 inet_ntop(AF_INET6, &dst_p.u.prefix6, buf, sizeof(buf));
727 ptm_lib_append_msg(ptm_hdl, out_ctxt,
728 ZEBRA_PTM_BFD_DST_IP_FIELD, buf);
729 }
730
731 min_rx_timer = stream_getl(s);
732 sprintf(tmp_buf, "%d", min_rx_timer);
733 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_MIN_RX_FIELD,
734 tmp_buf);
735 min_tx_timer = stream_getl(s);
736 sprintf(tmp_buf, "%d", min_tx_timer);
737 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_MIN_TX_FIELD,
738 tmp_buf);
739 detect_mul = stream_getc(s);
740 sprintf(tmp_buf, "%d", detect_mul);
741 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_DETECT_MULT_FIELD,
742 tmp_buf);
743
744 multi_hop = stream_getc(s);
745 if (multi_hop) {
746 sprintf(tmp_buf, "%d", 1);
747 ptm_lib_append_msg(ptm_hdl, out_ctxt,
748 ZEBRA_PTM_BFD_MULTI_HOP_FIELD, tmp_buf);
749 src_p.family = stream_getw(s);
750
751 if (src_p.family == AF_INET)
752 src_p.prefixlen = IPV4_MAX_BYTELEN;
753 else
754 src_p.prefixlen = IPV6_MAX_BYTELEN;
755
756 stream_get(&src_p.u.prefix, s, src_p.prefixlen);
757 if (src_p.family == AF_INET) {
758 inet_ntop(AF_INET, &src_p.u.prefix4, buf, sizeof(buf));
759 ptm_lib_append_msg(ptm_hdl, out_ctxt,
760 ZEBRA_PTM_BFD_SRC_IP_FIELD, buf);
761 } else {
762 inet_ntop(AF_INET6, &src_p.u.prefix6, buf, sizeof(buf));
763 ptm_lib_append_msg(ptm_hdl, out_ctxt,
764 ZEBRA_PTM_BFD_SRC_IP_FIELD, buf);
765 }
766
767 multi_hop_cnt = stream_getc(s);
768 sprintf(tmp_buf, "%d", multi_hop_cnt);
769 ptm_lib_append_msg(ptm_hdl, out_ctxt,
770 ZEBRA_PTM_BFD_MAX_HOP_CNT_FIELD, tmp_buf);
771
772 if (zvrf_id(zvrf) != VRF_DEFAULT)
773 ptm_lib_append_msg(ptm_hdl, out_ctxt,
774 ZEBRA_PTM_BFD_VRF_NAME_FIELD,
775 zvrf_name(zvrf));
776 } else {
777 if (dst_p.family == AF_INET6) {
778 src_p.family = stream_getw(s);
779
780 if (src_p.family == AF_INET)
781 src_p.prefixlen = IPV4_MAX_BYTELEN;
782 else
783 src_p.prefixlen = IPV6_MAX_BYTELEN;
784
785 stream_get(&src_p.u.prefix, s, src_p.prefixlen);
786 if (src_p.family == AF_INET) {
787 inet_ntop(AF_INET, &src_p.u.prefix4, buf,
788 sizeof(buf));
789 ptm_lib_append_msg(ptm_hdl, out_ctxt,
790 ZEBRA_PTM_BFD_SRC_IP_FIELD,
791 buf);
792 } else {
793 inet_ntop(AF_INET6, &src_p.u.prefix6, buf,
794 sizeof(buf));
795 ptm_lib_append_msg(ptm_hdl, out_ctxt,
796 ZEBRA_PTM_BFD_SRC_IP_FIELD,
797 buf);
798 }
799 }
800 len = stream_getc(s);
801 stream_get(if_name, s, len);
802 if_name[len] = '\0';
803
804 ptm_lib_append_msg(ptm_hdl, out_ctxt,
805 ZEBRA_PTM_BFD_IFNAME_FIELD, if_name);
806 }
807
808 sprintf(tmp_buf, "%d", 1);
809 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_SEND_EVENT,
810 tmp_buf);
811
812 ptm_lib_complete_msg(ptm_hdl, out_ctxt, ptm_cb.out_data, &data_len);
813
814 if (IS_ZEBRA_DEBUG_SEND)
815 zlog_debug("%s: Sent message (%d) %s", __func__, data_len,
816 ptm_cb.out_data);
817 zebra_ptm_send_message(ptm_cb.out_data, data_len);
818 return 0;
819 }
820
821 /* BFD peer/dst deregister */
822 int zebra_ptm_bfd_dst_deregister(struct zserv *client, int sock, u_short length,
823 struct zebra_vrf *zvrf)
824 {
825 struct stream *s;
826 struct prefix src_p;
827 struct prefix dst_p;
828 u_char multi_hop;
829 char if_name[INTERFACE_NAMSIZ];
830 u_char len;
831 char buf[INET6_ADDRSTRLEN];
832 char tmp_buf[64];
833 int data_len = ZEBRA_PTM_SEND_MAX_SOCKBUF;
834 void *out_ctxt;
835 unsigned int pid;
836
837 client->bfd_peer_del_cnt++;
838
839 if (IS_ZEBRA_DEBUG_EVENT)
840 zlog_debug("bfd_dst_deregister msg from client %s: length=%d",
841 zebra_route_string(client->proto), length);
842
843 if (ptm_cb.ptm_sock == -1) {
844 ptm_cb.t_timer = NULL;
845 thread_add_timer(zebrad.master, zebra_ptm_connect, NULL,
846 ptm_cb.reconnect_time, &ptm_cb.t_timer);
847 return -1;
848 }
849
850 ptm_lib_init_msg(ptm_hdl, 0, PTMLIB_MSG_TYPE_CMD, NULL, &out_ctxt);
851
852 sprintf(tmp_buf, "%s", ZEBRA_PTM_BFD_STOP_CMD);
853 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_CMD_STR, tmp_buf);
854
855 sprintf(tmp_buf, "%s", zebra_route_string(client->proto));
856 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_CLIENT_FIELD,
857 tmp_buf);
858
859 s = client->ibuf;
860
861 pid = stream_getl(s);
862 sprintf(tmp_buf, "%d", pid);
863 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_SEQID_FIELD,
864 tmp_buf);
865
866 dst_p.family = stream_getw(s);
867
868 if (dst_p.family == AF_INET)
869 dst_p.prefixlen = IPV4_MAX_BYTELEN;
870 else
871 dst_p.prefixlen = IPV6_MAX_BYTELEN;
872
873 stream_get(&dst_p.u.prefix, s, dst_p.prefixlen);
874 if (dst_p.family == AF_INET)
875 inet_ntop(AF_INET, &dst_p.u.prefix4, buf, sizeof(buf));
876 else
877 inet_ntop(AF_INET6, &dst_p.u.prefix6, buf, sizeof(buf));
878 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_DST_IP_FIELD, buf);
879
880
881 multi_hop = stream_getc(s);
882 if (multi_hop) {
883 sprintf(tmp_buf, "%d", 1);
884 ptm_lib_append_msg(ptm_hdl, out_ctxt,
885 ZEBRA_PTM_BFD_MULTI_HOP_FIELD, tmp_buf);
886
887 src_p.family = stream_getw(s);
888
889 if (src_p.family == AF_INET)
890 src_p.prefixlen = IPV4_MAX_BYTELEN;
891 else
892 src_p.prefixlen = IPV6_MAX_BYTELEN;
893
894 stream_get(&src_p.u.prefix, s, src_p.prefixlen);
895 if (src_p.family == AF_INET)
896 inet_ntop(AF_INET, &src_p.u.prefix4, buf, sizeof(buf));
897 else
898 inet_ntop(AF_INET6, &src_p.u.prefix6, buf, sizeof(buf));
899 ptm_lib_append_msg(ptm_hdl, out_ctxt,
900 ZEBRA_PTM_BFD_SRC_IP_FIELD, buf);
901
902 if (zvrf_id(zvrf) != VRF_DEFAULT)
903 ptm_lib_append_msg(ptm_hdl, out_ctxt,
904 ZEBRA_PTM_BFD_VRF_NAME_FIELD,
905 zvrf_name(zvrf));
906 } else {
907 if (dst_p.family == AF_INET6) {
908 src_p.family = stream_getw(s);
909
910 if (src_p.family == AF_INET)
911 src_p.prefixlen = IPV4_MAX_BYTELEN;
912 else
913 src_p.prefixlen = IPV6_MAX_BYTELEN;
914
915 stream_get(&src_p.u.prefix, s, src_p.prefixlen);
916 if (src_p.family == AF_INET) {
917 inet_ntop(AF_INET, &src_p.u.prefix4, buf,
918 sizeof(buf));
919 ptm_lib_append_msg(ptm_hdl, out_ctxt,
920 ZEBRA_PTM_BFD_SRC_IP_FIELD,
921 buf);
922 } else {
923 inet_ntop(AF_INET6, &src_p.u.prefix6, buf,
924 sizeof(buf));
925 ptm_lib_append_msg(ptm_hdl, out_ctxt,
926 ZEBRA_PTM_BFD_SRC_IP_FIELD,
927 buf);
928 }
929 }
930
931 len = stream_getc(s);
932 stream_get(if_name, s, len);
933 if_name[len] = '\0';
934
935 ptm_lib_append_msg(ptm_hdl, out_ctxt,
936 ZEBRA_PTM_BFD_IFNAME_FIELD, if_name);
937 }
938
939 ptm_lib_complete_msg(ptm_hdl, out_ctxt, ptm_cb.out_data, &data_len);
940 if (IS_ZEBRA_DEBUG_SEND)
941 zlog_debug("%s: Sent message (%d) %s", __func__, data_len,
942 ptm_cb.out_data);
943
944 zebra_ptm_send_message(ptm_cb.out_data, data_len);
945 return 0;
946 }
947
948 /* BFD client register */
949 int zebra_ptm_bfd_client_register(struct zserv *client, int sock,
950 u_short length)
951 {
952 struct stream *s;
953 unsigned int pid;
954 void *out_ctxt;
955 char tmp_buf[64];
956 int data_len = ZEBRA_PTM_SEND_MAX_SOCKBUF;
957
958 client->bfd_client_reg_cnt++;
959
960 if (IS_ZEBRA_DEBUG_EVENT)
961 zlog_debug("bfd_client_register msg from client %s: length=%d",
962 zebra_route_string(client->proto), length);
963
964 s = client->ibuf;
965 pid = stream_getl(s);
966
967 if (ptm_cb.ptm_sock == -1) {
968 ptm_cb.t_timer = NULL;
969 thread_add_timer(zebrad.master, zebra_ptm_connect, NULL,
970 ptm_cb.reconnect_time, &ptm_cb.t_timer);
971 return -1;
972 }
973
974 ptm_lib_init_msg(ptm_hdl, 0, PTMLIB_MSG_TYPE_CMD, NULL, &out_ctxt);
975
976 sprintf(tmp_buf, "%s", ZEBRA_PTM_BFD_CLIENT_REG_CMD);
977 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_CMD_STR, tmp_buf);
978
979 sprintf(tmp_buf, "%s", zebra_route_string(client->proto));
980 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_CLIENT_FIELD,
981 tmp_buf);
982
983 sprintf(tmp_buf, "%d", pid);
984 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_SEQID_FIELD,
985 tmp_buf);
986
987 ptm_lib_complete_msg(ptm_hdl, out_ctxt, ptm_cb.out_data, &data_len);
988
989 if (IS_ZEBRA_DEBUG_SEND)
990 zlog_debug("%s: Sent message (%d) %s", __func__, data_len,
991 ptm_cb.out_data);
992 zebra_ptm_send_message(ptm_cb.out_data, data_len);
993
994 SET_FLAG(ptm_cb.client_flags[client->proto],
995 ZEBRA_PTM_BFD_CLIENT_FLAG_REG);
996 return 0;
997 }
998
999 /* BFD client deregister */
1000 void zebra_ptm_bfd_client_deregister(int proto)
1001 {
1002 void *out_ctxt;
1003 char tmp_buf[64];
1004 int data_len = ZEBRA_PTM_SEND_MAX_SOCKBUF;
1005
1006 if (proto != ZEBRA_ROUTE_OSPF && proto != ZEBRA_ROUTE_BGP
1007 && proto != ZEBRA_ROUTE_OSPF6 && proto != ZEBRA_ROUTE_PIM)
1008 return;
1009
1010 if (IS_ZEBRA_DEBUG_EVENT)
1011 zlog_err("bfd_client_deregister msg for client %s",
1012 zebra_route_string(proto));
1013
1014 if (ptm_cb.ptm_sock == -1) {
1015 ptm_cb.t_timer = NULL;
1016 thread_add_timer(zebrad.master, zebra_ptm_connect, NULL,
1017 ptm_cb.reconnect_time, &ptm_cb.t_timer);
1018 return;
1019 }
1020
1021 ptm_lib_init_msg(ptm_hdl, 0, PTMLIB_MSG_TYPE_CMD, NULL, &out_ctxt);
1022
1023 sprintf(tmp_buf, "%s", ZEBRA_PTM_BFD_CLIENT_DEREG_CMD);
1024 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_CMD_STR, tmp_buf);
1025
1026 sprintf(tmp_buf, "%s", zebra_route_string(proto));
1027 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_BFD_CLIENT_FIELD,
1028 tmp_buf);
1029
1030 ptm_lib_complete_msg(ptm_hdl, out_ctxt, ptm_cb.out_data, &data_len);
1031
1032 if (IS_ZEBRA_DEBUG_SEND)
1033 zlog_debug("%s: Sent message (%d) %s", __func__, data_len,
1034 ptm_cb.out_data);
1035
1036 zebra_ptm_send_message(ptm_cb.out_data, data_len);
1037 UNSET_FLAG(ptm_cb.client_flags[proto], ZEBRA_PTM_BFD_CLIENT_FLAG_REG);
1038 }
1039
1040 int zebra_ptm_get_enable_state(void)
1041 {
1042 return ptm_cb.ptm_enable;
1043 }
1044
1045 /*
1046 * zebra_ptm_get_status_str - Convert status to a display string.
1047 */
1048 static const char *zebra_ptm_get_status_str(int status)
1049 {
1050 switch (status) {
1051 case ZEBRA_PTM_STATUS_DOWN:
1052 return "fail";
1053 case ZEBRA_PTM_STATUS_UP:
1054 return "pass";
1055 case ZEBRA_PTM_STATUS_UNKNOWN:
1056 default:
1057 return "n/a";
1058 }
1059 }
1060
1061 void zebra_ptm_show_status(struct vty *vty, struct interface *ifp)
1062 {
1063 vty_out(vty, " PTM status: ");
1064 if (ifp->ptm_enable) {
1065 vty_out(vty, "%s\n", zebra_ptm_get_status_str(ifp->ptm_status));
1066 } else {
1067 vty_out(vty, "disabled\n");
1068 }
1069 }
1070
1071 void zebra_ptm_send_status_req(void)
1072 {
1073 void *out_ctxt;
1074 int len = ZEBRA_PTM_SEND_MAX_SOCKBUF;
1075
1076 if (ptm_cb.ptm_enable) {
1077 ptm_lib_init_msg(ptm_hdl, 0, PTMLIB_MSG_TYPE_CMD, NULL,
1078 &out_ctxt);
1079 ptm_lib_append_msg(ptm_hdl, out_ctxt, ZEBRA_PTM_CMD_STR,
1080 ZEBRA_PTM_GET_STATUS_CMD);
1081 ptm_lib_complete_msg(ptm_hdl, out_ctxt, ptm_cb.out_data, &len);
1082
1083 zebra_ptm_send_message(ptm_cb.out_data, len);
1084 }
1085 }
1086
1087 void zebra_ptm_reset_status(int ptm_disable)
1088 {
1089 struct vrf *vrf;
1090 struct interface *ifp;
1091 int send_linkup;
1092
1093 RB_FOREACH (vrf, vrf_id_head, &vrfs_by_id)
1094 FOR_ALL_INTERFACES (vrf, ifp) {
1095 send_linkup = 0;
1096 if (ifp->ptm_enable) {
1097 if (!if_is_operative(ifp))
1098 send_linkup = 1;
1099
1100 if (ptm_disable)
1101 ifp->ptm_enable =
1102 ZEBRA_IF_PTM_ENABLE_OFF;
1103 ifp->ptm_status = ZEBRA_PTM_STATUS_UNKNOWN;
1104
1105 if (if_is_operative(ifp) && send_linkup) {
1106 if (IS_ZEBRA_DEBUG_EVENT)
1107 zlog_debug(
1108 "%s: Bringing up interface %s",
1109 __func__, ifp->name);
1110 if_up(ifp);
1111 }
1112 }
1113 }
1114 }
1115
1116 void zebra_ptm_if_init(struct zebra_if *zebra_ifp)
1117 {
1118 zebra_ifp->ptm_enable = ZEBRA_IF_PTM_ENABLE_UNSPEC;
1119 }
1120
1121 void zebra_ptm_if_set_ptm_state(struct interface *ifp,
1122 struct zebra_if *zebra_ifp)
1123 {
1124 if (zebra_ifp && zebra_ifp->ptm_enable != ZEBRA_IF_PTM_ENABLE_UNSPEC)
1125 ifp->ptm_enable = zebra_ifp->ptm_enable;
1126 }
1127
1128 void zebra_ptm_if_write(struct vty *vty, struct zebra_if *zebra_ifp)
1129 {
1130 if (zebra_ifp->ptm_enable == ZEBRA_IF_PTM_ENABLE_OFF)
1131 vty_out(vty, " no ptm-enable\n");
1132 }