ldpd/neighbor.c

   1 /*      $OpenBSD$ */
   2
   3 /*
   4  * Copyright (c) 2013, 2016 Renato Westphal <renato@openbsd.org>
   5  * Copyright (c) 2009 Michele Marchetto <michele@openbsd.org>
   6  * Copyright (c) 2005 Claudio Jeker <claudio@openbsd.org>
   7  * Copyright (c) 2004, 2005, 2008 Esben Norby <norby@openbsd.org>
   8  *
   9  * Permission to use, copy, modify, and distribute this software for any
  10  * purpose with or without fee is hereby granted, provided that the above
  11  * copyright notice and this permission notice appear in all copies.
  12  *
  13  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  14  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  15  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  16  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  17  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  18  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  19  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  20  */
  21
  22 #include <zebra.h>
  23
  24 #include "ldpd.h"
  25 #include "ldpe.h"
  26 #include "lde.h"
  27 #include "log.h"
  28
  29 static __inline int      nbr_id_compare(struct nbr *, struct nbr *);
  30 static __inline int      nbr_addr_compare(struct nbr *, struct nbr *);
  31 static __inline int      nbr_pid_compare(struct nbr *, struct nbr *);
  32 static void              nbr_update_peerid(struct nbr *);
  33 static int               nbr_ktimer(struct thread *);
  34 static void              nbr_start_ktimer(struct nbr *);
  35 static int               nbr_ktimeout(struct thread *);
  36 static void              nbr_start_ktimeout(struct nbr *);
  37 static int               nbr_itimeout(struct thread *);
  38 static void              nbr_start_itimeout(struct nbr *);
  39 static int               nbr_idtimer(struct thread *);
  40 static int               nbr_act_session_operational(struct nbr *);
  41 static void              nbr_send_labelmappings(struct nbr *);
  42 static __inline int      nbr_params_compare(struct nbr_params *,
  43                             struct nbr_params *);
  44
  45 RB_GENERATE(nbr_id_head, nbr, id_tree, nbr_id_compare)
  46 RB_GENERATE(nbr_addr_head, nbr, addr_tree, nbr_addr_compare)
  47 RB_GENERATE(nbr_pid_head, nbr, pid_tree, nbr_pid_compare)
  48 RB_GENERATE(nbrp_head, nbr_params, entry, nbr_params_compare)
  49
  50 struct {
  51         int             state;
  52         enum nbr_event  event;
  53         enum nbr_action action;
  54         int             new_state;
  55 } nbr_fsm_tbl[] = {
  56     /* current state    event that happened     action to take          resulting state */
  57 /* Passive Role */
  58     {NBR_STA_PRESENT,   NBR_EVT_MATCH_ADJ,      NBR_ACT_NOTHING,        NBR_STA_INITIAL},
  59     {NBR_STA_INITIAL,   NBR_EVT_INIT_RCVD,      NBR_ACT_PASSIVE_INIT,   NBR_STA_OPENREC},
  60     {NBR_STA_OPENREC,   NBR_EVT_KEEPALIVE_RCVD, NBR_ACT_SESSION_EST,    NBR_STA_OPER},
  61 /* Active Role */
  62     {NBR_STA_PRESENT,   NBR_EVT_CONNECT_UP,     NBR_ACT_CONNECT_SETUP,  NBR_STA_INITIAL},
  63     {NBR_STA_INITIAL,   NBR_EVT_INIT_SENT,      NBR_ACT_NOTHING,        NBR_STA_OPENSENT},
  64     {NBR_STA_OPENSENT,  NBR_EVT_INIT_RCVD,      NBR_ACT_KEEPALIVE_SEND, NBR_STA_OPENREC},
  65 /* Session Maintenance */
  66     {NBR_STA_OPER,      NBR_EVT_PDU_RCVD,       NBR_ACT_RST_KTIMEOUT,   0},
  67     {NBR_STA_SESSION,   NBR_EVT_PDU_RCVD,       NBR_ACT_NOTHING,        0},
  68     {NBR_STA_OPER,      NBR_EVT_PDU_SENT,       NBR_ACT_RST_KTIMER,     0},
  69     {NBR_STA_SESSION,   NBR_EVT_PDU_SENT,       NBR_ACT_NOTHING,        0},
  70 /* Session Close */
  71     {NBR_STA_PRESENT,   NBR_EVT_CLOSE_SESSION,  NBR_ACT_NOTHING,        0},
  72     {NBR_STA_SESSION,   NBR_EVT_CLOSE_SESSION,  NBR_ACT_CLOSE_SESSION,  NBR_STA_PRESENT},
  73     {-1,                NBR_EVT_NOTHING,        NBR_ACT_NOTHING,        0},
  74 };
  75
  76 const char * const nbr_event_names[] = {
  77         "NOTHING",
  78         "ADJACENCY MATCHED",
  79         "CONNECTION UP",
  80         "SESSION CLOSE",
  81         "INIT RECEIVED",
  82         "KEEPALIVE RECEIVED",
  83         "PDU RECEIVED",
  84         "PDU SENT",
  85         "INIT SENT"
  86 };
  87
  88 const char * const nbr_action_names[] = {
  89         "NOTHING",
  90         "RESET KEEPALIVE TIMEOUT",
  91         "START NEIGHBOR SESSION",
  92         "RESET KEEPALIVE TIMER",
  93         "SETUP NEIGHBOR CONNECTION",
  94         "SEND INIT AND KEEPALIVE",
  95         "SEND KEEPALIVE",
  96         "CLOSE SESSION"
  97 };
  98
  99 struct nbr_id_head nbrs_by_id = RB_INITIALIZER(&nbrs_by_id);
 100 struct nbr_addr_head nbrs_by_addr = RB_INITIALIZER(&nbrs_by_addr);
 101 struct nbr_pid_head nbrs_by_pid = RB_INITIALIZER(&nbrs_by_pid);
 102
 103 static __inline int
 104 nbr_id_compare(struct nbr *a, struct nbr *b)
 105 {
 106         return (ntohl(a->id.s_addr) - ntohl(b->id.s_addr));
 107 }
 108
 109 static __inline int
 110 nbr_addr_compare(struct nbr *a, struct nbr *b)
 111 {
 112         if (a->af < b->af)
 113                 return (-1);
 114         if (a->af > b->af)
 115                 return (1);
 116
 117         return (ldp_addrcmp(a->af, &a->raddr, &b->raddr));
 118 }
 119
 120 static __inline int
 121 nbr_pid_compare(struct nbr *a, struct nbr *b)
 122 {
 123         return (a->peerid - b->peerid);
 124 }
 125
 126 int
 127 nbr_fsm(struct nbr *nbr, enum nbr_event event)
 128 {
 129         struct timeval  now;
 130         int             old_state;
 131         int             new_state = 0;
 132         int             i;
 133
 134         old_state = nbr->state;
 135         for (i = 0; nbr_fsm_tbl[i].state != -1; i++)
 136                 if ((nbr_fsm_tbl[i].state & old_state) &&
 137                     (nbr_fsm_tbl[i].event == event)) {
 138                         new_state = nbr_fsm_tbl[i].new_state;
 139                         break;
 140                 }
 141
 142         if (nbr_fsm_tbl[i].state == -1) {
 143                 /* event outside of the defined fsm, ignore it. */
 144                 log_warnx("%s: lsr-id %s, event %s not expected in "
 145                     "state %s", __func__, inet_ntoa(nbr->id),
 146                     nbr_event_names[event], nbr_state_name(old_state));
 147                 return (0);
 148         }
 149
 150         if (new_state != 0)
 151                 nbr->state = new_state;
 152
 153         if (old_state != nbr->state) {
 154                 log_debug("%s: event %s resulted in action %s and "
 155                     "changing state for lsr-id %s from %s to %s",
 156                     __func__, nbr_event_names[event],
 157                     nbr_action_names[nbr_fsm_tbl[i].action],
 158                     inet_ntoa(nbr->id), nbr_state_name(old_state),
 159                     nbr_state_name(nbr->state));
 160
 161                 if (nbr->state == NBR_STA_OPER) {
 162                         gettimeofday(&now, NULL);
 163                         nbr->uptime = now.tv_sec;
 164                 }
 165         }
 166
 167         if (nbr->state == NBR_STA_OPER || nbr->state == NBR_STA_PRESENT)
 168                 nbr_stop_itimeout(nbr);
 169         else
 170                 nbr_start_itimeout(nbr);
 171
 172         switch (nbr_fsm_tbl[i].action) {
 173         case NBR_ACT_RST_KTIMEOUT:
 174                 nbr_start_ktimeout(nbr);
 175                 break;
 176         case NBR_ACT_RST_KTIMER:
 177                 nbr_start_ktimer(nbr);
 178                 break;
 179         case NBR_ACT_SESSION_EST:
 180                 nbr_act_session_operational(nbr);
 181                 nbr_start_ktimer(nbr);
 182                 nbr_start_ktimeout(nbr);
 183                 if (nbr->v4_enabled)
 184                         send_address_all(nbr, AF_INET);
 185                 if (nbr->v6_enabled)
 186                         send_address_all(nbr, AF_INET6);
 187                 nbr_send_labelmappings(nbr);
 188                 break;
 189         case NBR_ACT_CONNECT_SETUP:
 190                 nbr->tcp = tcp_new(nbr->fd, nbr);
 191
 192                 /* trigger next state */
 193                 send_init(nbr);
 194                 nbr_fsm(nbr, NBR_EVT_INIT_SENT);
 195                 break;
 196         case NBR_ACT_PASSIVE_INIT:
 197                 send_init(nbr);
 198                 send_keepalive(nbr);
 199                 break;
 200         case NBR_ACT_KEEPALIVE_SEND:
 201                 nbr_start_ktimeout(nbr);
 202                 send_keepalive(nbr);
 203                 break;
 204         case NBR_ACT_CLOSE_SESSION:
 205                 ldpe_imsg_compose_lde(IMSG_NEIGHBOR_DOWN, nbr->peerid, 0,
 206                     NULL, 0);
 207                 session_close(nbr);
 208                 break;
 209         case NBR_ACT_NOTHING:
 210                 /* do nothing */
 211                 break;
 212         }
 213
 214         return (0);
 215 }
 216
 217 struct nbr *
 218 nbr_new(struct in_addr id, int af, int ds_tlv, union ldpd_addr *addr,
 219     uint32_t scope_id)
 220 {
 221         struct nbr              *nbr;
 222         struct nbr_params       *nbrp;
 223         struct adj              *adj;
 224         struct pending_conn     *pconn;
 225
 226         log_debug("%s: lsr-id %s transport-address %s", __func__,
 227             inet_ntoa(id), log_addr(af, addr));
 228
 229         if ((nbr = calloc(1, sizeof(*nbr))) == NULL)
 230                 fatal(__func__);
 231
 232         RB_INIT(&nbr->adj_tree);
 233         nbr->state = NBR_STA_PRESENT;
 234         nbr->peerid = 0;
 235         nbr->af = af;
 236         nbr->ds_tlv = ds_tlv;
 237         if (af == AF_INET || ds_tlv)
 238                 nbr->v4_enabled = 1;
 239         if (af == AF_INET6 || ds_tlv)
 240                 nbr->v6_enabled = 1;
 241         nbr->id = id;
 242         nbr->laddr = (ldp_af_conf_get(leconf, af))->trans_addr;
 243         nbr->raddr = *addr;
 244         nbr->raddr_scope = scope_id;
 245         nbr->conf_seqnum = 0;
 246
 247         RB_FOREACH(adj, global_adj_head, &global.adj_tree) {
 248                 if (adj->lsr_id.s_addr == nbr->id.s_addr) {
 249                         adj->nbr = nbr;
 250                         RB_INSERT(nbr_adj_head, &nbr->adj_tree, adj);
 251                 }
 252         }
 253
 254         if (RB_INSERT(nbr_id_head, &nbrs_by_id, nbr) != NULL)
 255                 fatalx("nbr_new: RB_INSERT(nbrs_by_id) failed");
 256         if (RB_INSERT(nbr_addr_head, &nbrs_by_addr, nbr) != NULL)
 257                 fatalx("nbr_new: RB_INSERT(nbrs_by_addr) failed");
 258
 259         TAILQ_INIT(&nbr->mapping_list);
 260         TAILQ_INIT(&nbr->withdraw_list);
 261         TAILQ_INIT(&nbr->request_list);
 262         TAILQ_INIT(&nbr->release_list);
 263         TAILQ_INIT(&nbr->abortreq_list);
 264
 265         nbrp = nbr_params_find(leconf, nbr->id);
 266         if (nbrp) {
 267                 nbr->auth.method = nbrp->auth.method;
 268 #ifdef __OpenBSD__
 269                 if (pfkey_establish(nbr, nbrp) == -1)
 270                         fatalx("pfkey setup failed");
 271 #else
 272                 sock_set_md5sig(
 273                     (ldp_af_global_get(&global, nbr->af))->ldp_session_socket,
 274                     nbr->af, &nbr->raddr, nbrp->auth.md5key);
 275 #endif
 276         }
 277
 278         pconn = pending_conn_find(nbr->af, &nbr->raddr);
 279         if (pconn) {
 280                 session_accept_nbr(nbr, pconn->fd);
 281                 pending_conn_del(pconn);
 282         }
 283
 284         return (nbr);
 285 }
 286
 287 void
 288 nbr_del(struct nbr *nbr)
 289 {
 290         log_debug("%s: lsr-id %s", __func__, inet_ntoa(nbr->id));
 291
 292         nbr_fsm(nbr, NBR_EVT_CLOSE_SESSION);
 293 #ifdef __OpenBSD__
 294         pfkey_remove(nbr);
 295 #else
 296         sock_set_md5sig(
 297             (ldp_af_global_get(&global, nbr->af))->ldp_session_socket,
 298             nbr->af, &nbr->raddr, NULL);
 299 #endif
 300         nbr->auth.method = AUTH_NONE;
 301
 302         if (nbr_pending_connect(nbr))
 303                 THREAD_WRITE_OFF(nbr->ev_connect);
 304         nbr_stop_ktimer(nbr);
 305         nbr_stop_ktimeout(nbr);
 306         nbr_stop_itimeout(nbr);
 307         nbr_stop_idtimer(nbr);
 308
 309         mapping_list_clr(&nbr->mapping_list);
 310         mapping_list_clr(&nbr->withdraw_list);
 311         mapping_list_clr(&nbr->request_list);
 312         mapping_list_clr(&nbr->release_list);
 313         mapping_list_clr(&nbr->abortreq_list);
 314
 315         if (nbr->peerid)
 316                 RB_REMOVE(nbr_pid_head, &nbrs_by_pid, nbr);
 317         RB_REMOVE(nbr_id_head, &nbrs_by_id, nbr);
 318         RB_REMOVE(nbr_addr_head, &nbrs_by_addr, nbr);
 319
 320         free(nbr);
 321 }
 322
 323 static void
 324 nbr_update_peerid(struct nbr *nbr)
 325 {
 326         static uint32_t  peercnt = 1;
 327
 328         if (nbr->peerid)
 329                 RB_REMOVE(nbr_pid_head, &nbrs_by_pid, nbr);
 330
 331         /* get next unused peerid */
 332         while (nbr_find_peerid(++peercnt))
 333                 ;
 334         nbr->peerid = peercnt;
 335
 336         if (RB_INSERT(nbr_pid_head, &nbrs_by_pid, nbr) != NULL)
 337                 fatalx("nbr_update_peerid: RB_INSERT(nbrs_by_pid) failed");
 338 }
 339
 340 struct nbr *
 341 nbr_find_ldpid(uint32_t lsr_id)
 342 {
 343         struct nbr      n;
 344         n.id.s_addr = lsr_id;
 345         return (RB_FIND(nbr_id_head, &nbrs_by_id, &n));
 346 }
 347
 348 struct nbr *
 349 nbr_find_addr(int af, union ldpd_addr *addr)
 350 {
 351         struct nbr      n;
 352         n.af = af;
 353         n.raddr = *addr;
 354         return (RB_FIND(nbr_addr_head, &nbrs_by_addr, &n));
 355 }
 356
 357 struct nbr *
 358 nbr_find_peerid(uint32_t peerid)
 359 {
 360         struct nbr      n;
 361         n.peerid = peerid;
 362         return (RB_FIND(nbr_pid_head, &nbrs_by_pid, &n));
 363 }
 364
 365 int
 366 nbr_adj_count(struct nbr *nbr, int af)
 367 {
 368         struct adj      *adj;
 369         int              total = 0;
 370
 371         RB_FOREACH(adj, nbr_adj_head, &nbr->adj_tree)
 372                 if (adj_get_af(adj) == af)
 373                         total++;
 374
 375         return (total);
 376 }
 377
 378 int
 379 nbr_session_active_role(struct nbr *nbr)
 380 {
 381         if (ldp_addrcmp(nbr->af, &nbr->laddr, &nbr->raddr) > 0)
 382                 return (1);
 383
 384         return (0);
 385 }
 386
 387 /* timers */
 388
 389 /* Keepalive timer: timer to send keepalive message to neighbors */
 390
 391 static int
 392 nbr_ktimer(struct thread *thread)
 393 {
 394         struct nbr      *nbr = THREAD_ARG(thread);
 395
 396         nbr->keepalive_timer = NULL;
 397         send_keepalive(nbr);
 398         nbr_start_ktimer(nbr);
 399
 400         return (0);
 401 }
 402
 403 static void
 404 nbr_start_ktimer(struct nbr *nbr)
 405 {
 406         int              secs;
 407
 408         /* send three keepalives per period */
 409         secs = nbr->keepalive / KEEPALIVE_PER_PERIOD;
 410         THREAD_TIMER_OFF(nbr->keepalive_timer);
 411         nbr->keepalive_timer = thread_add_timer(master, nbr_ktimer, nbr, secs);
 412 }
 413
 414 void
 415 nbr_stop_ktimer(struct nbr *nbr)
 416 {
 417         THREAD_TIMER_OFF(nbr->keepalive_timer);
 418 }
 419
 420 /* Keepalive timeout: if the nbr hasn't sent keepalive */
 421
 422 static int
 423 nbr_ktimeout(struct thread *thread)
 424 {
 425         struct nbr *nbr = THREAD_ARG(thread);
 426
 427         nbr->keepalive_timeout = NULL;
 428
 429         log_debug("%s: lsr-id %s", __func__, inet_ntoa(nbr->id));
 430
 431         session_shutdown(nbr, S_KEEPALIVE_TMR, 0, 0);
 432
 433         return (0);
 434 }
 435
 436 static void
 437 nbr_start_ktimeout(struct nbr *nbr)
 438 {
 439         THREAD_TIMER_OFF(nbr->keepalive_timeout);
 440         nbr->keepalive_timeout = thread_add_timer(master, nbr_ktimeout, nbr,
 441             nbr->keepalive);
 442 }
 443
 444 void
 445 nbr_stop_ktimeout(struct nbr *nbr)
 446 {
 447         THREAD_TIMER_OFF(nbr->keepalive_timeout);
 448 }
 449
 450 /* Session initialization timeout: if nbr got stuck in the initialization FSM */
 451
 452 static int
 453 nbr_itimeout(struct thread *thread)
 454 {
 455         struct nbr      *nbr = THREAD_ARG(thread);
 456
 457         log_debug("%s: lsr-id %s", __func__, inet_ntoa(nbr->id));
 458
 459         nbr_fsm(nbr, NBR_EVT_CLOSE_SESSION);
 460
 461         return (0);
 462 }
 463
 464 static void
 465 nbr_start_itimeout(struct nbr *nbr)
 466 {
 467         int              secs;
 468
 469         secs = INIT_FSM_TIMEOUT;
 470         THREAD_TIMER_OFF(nbr->init_timeout);
 471         nbr->init_timeout = thread_add_timer(master, nbr_itimeout, nbr, secs);
 472 }
 473
 474 void
 475 nbr_stop_itimeout(struct nbr *nbr)
 476 {
 477         THREAD_TIMER_OFF(nbr->init_timeout);
 478 }
 479
 480 /* Init delay timer: timer to retry to iniziatize session */
 481
 482 static int
 483 nbr_idtimer(struct thread *thread)
 484 {
 485         struct nbr *nbr = THREAD_ARG(thread);
 486
 487         nbr->initdelay_timer = NULL;
 488
 489         log_debug("%s: lsr-id %s", __func__, inet_ntoa(nbr->id));
 490
 491         nbr_establish_connection(nbr);
 492
 493         return (0);
 494 }
 495
 496 void
 497 nbr_start_idtimer(struct nbr *nbr)
 498 {
 499         int     secs;
 500
 501         secs = INIT_DELAY_TMR;
 502         switch(nbr->idtimer_cnt) {
 503         default:
 504                 /* do not further increase the counter */
 505                 secs = MAX_DELAY_TMR;
 506                 break;
 507         case 2:
 508                 secs *= 2;
 509                 /* FALLTHROUGH */
 510         case 1:
 511                 secs *= 2;
 512                 /* FALLTHROUGH */
 513         case 0:
 514                 nbr->idtimer_cnt++;
 515                 break;
 516         }
 517
 518         THREAD_TIMER_OFF(nbr->initdelay_timer);
 519         nbr->initdelay_timer = thread_add_timer(master, nbr_idtimer, nbr, secs);
 520 }
 521
 522 void
 523 nbr_stop_idtimer(struct nbr *nbr)
 524 {
 525         THREAD_TIMER_OFF(nbr->initdelay_timer);
 526 }
 527
 528 int
 529 nbr_pending_idtimer(struct nbr *nbr)
 530 {
 531         return (nbr->initdelay_timer != NULL);
 532 }
 533
 534 int
 535 nbr_pending_connect(struct nbr *nbr)
 536 {
 537         return (nbr->ev_connect != NULL);
 538 }
 539
 540 static int
 541 nbr_connect_cb(struct thread *thread)
 542 {
 543         struct nbr      *nbr = THREAD_ARG(thread);
 544         int              error;
 545         socklen_t        len;
 546
 547         nbr->ev_connect = NULL;
 548
 549         len = sizeof(error);
 550         if (getsockopt(nbr->fd, SOL_SOCKET, SO_ERROR, &error, &len) < 0) {
 551                 log_warn("%s: getsockopt SOL_SOCKET SO_ERROR", __func__);
 552                 return (0);
 553         }
 554
 555         if (error) {
 556                 close(nbr->fd);
 557                 errno = error;
 558                 log_debug("%s: error while connecting to %s: %s", __func__,
 559                     log_addr(nbr->af, &nbr->raddr), strerror(errno));
 560                 return (0);
 561         }
 562
 563         nbr_fsm(nbr, NBR_EVT_CONNECT_UP);
 564
 565         return (0);
 566 }
 567
 568 int
 569 nbr_establish_connection(struct nbr *nbr)
 570 {
 571         struct sockaddr_storage  local_sa;
 572         struct sockaddr_storage  remote_sa;
 573         struct adj              *adj;
 574         struct nbr_params       *nbrp;
 575 #ifdef __OpenBSD__
 576         int                      opt = 1;
 577 #endif
 578
 579         nbr->fd = socket(nbr->af, SOCK_STREAM, 0);
 580         if (nbr->fd == -1) {
 581                 log_warn("%s: error while creating socket", __func__);
 582                 return (-1);
 583         }
 584         sock_set_nonblock(nbr->fd);
 585
 586         nbrp = nbr_params_find(leconf, nbr->id);
 587         if (nbrp && nbrp->auth.method == AUTH_MD5SIG) {
 588 #ifdef __OpenBSD__
 589                 if (sysdep.no_pfkey || sysdep.no_md5sig) {
 590                         log_warnx("md5sig configured but not available");
 591                         close(nbr->fd);
 592                         return (-1);
 593                 }
 594                 if (setsockopt(nbr->fd, IPPROTO_TCP, TCP_MD5SIG,
 595                     &opt, sizeof(opt)) == -1) {
 596                         log_warn("setsockopt md5sig");
 597                         close(nbr->fd);
 598                         return (-1);
 599                 }
 600 #else
 601                 sock_set_md5sig(nbr->fd, nbr->af, &nbr->raddr,
 602                     nbrp->auth.md5key);
 603 #endif
 604         }
 605
 606         memcpy(&local_sa, addr2sa(nbr->af, &nbr->laddr, 0), sizeof(local_sa));
 607         memcpy(&remote_sa, addr2sa(nbr->af, &nbr->raddr, LDP_PORT),
 608             sizeof(local_sa));
 609         if (nbr->af == AF_INET6 && nbr->raddr_scope)
 610                 addscope((struct sockaddr_in6 *)&remote_sa, nbr->raddr_scope);
 611
 612         if (bind(nbr->fd, (struct sockaddr *)&local_sa,
 613             sockaddr_len((struct sockaddr *)&local_sa)) == -1) {
 614                 log_warn("%s: error while binding socket to %s", __func__,
 615                     log_sockaddr((struct sockaddr *)&local_sa));
 616                 close(nbr->fd);
 617                 return (-1);
 618         }
 619
 620         if (nbr_gtsm_check(nbr->fd, nbr, nbrp)) {
 621                 close(nbr->fd);
 622                 return (-1);
 623         }
 624
 625         /*
 626          * Send an extra hello to guarantee that the remote peer has formed
 627          * an adjacency as well.
 628          */
 629         RB_FOREACH(adj, nbr_adj_head, &nbr->adj_tree)
 630                 send_hello(adj->source.type, adj->source.link.ia,
 631                     adj->source.target);
 632
 633         if (connect(nbr->fd, (struct sockaddr *)&remote_sa,
 634             sockaddr_len((struct sockaddr *)&remote_sa)) == -1) {
 635                 if (errno == EINPROGRESS) {
 636                         THREAD_WRITE_ON(master, nbr->ev_connect, nbr_connect_cb,
 637                             nbr, nbr->fd);
 638                         return (0);
 639                 }
 640                 log_warn("%s: error while connecting to %s", __func__,
 641                     log_sockaddr((struct sockaddr *)&remote_sa));
 642                 close(nbr->fd);
 643                 return (-1);
 644         }
 645
 646         /* connection completed immediately */
 647         nbr_fsm(nbr, NBR_EVT_CONNECT_UP);
 648
 649         return (0);
 650 }
 651
 652 int
 653 nbr_gtsm_enabled(struct nbr *nbr, struct nbr_params *nbrp)
 654 {
 655         /*
 656          * RFC 6720 - Section 3:
 657          * "This document allows for the implementation to provide an option to
 658          * statically (e.g., via configuration) and/or dynamically override the
 659          * default behavior and enable/disable GTSM on a per-peer basis".
 660          */
 661         if (nbrp && (nbrp->flags & F_NBRP_GTSM))
 662                 return (nbrp->gtsm_enabled);
 663
 664         if ((ldp_af_conf_get(leconf, nbr->af))->flags & F_LDPD_AF_NO_GTSM)
 665                 return (0);
 666
 667         /* By default, GTSM support has to be negotiated for LDPv4 */
 668         if (nbr->af == AF_INET && !(nbr->flags & F_NBR_GTSM_NEGOTIATED))
 669                 return (0);
 670
 671         return (1);
 672 }
 673
 674 int
 675 nbr_gtsm_setup(int fd, int af, struct nbr_params *nbrp)
 676 {
 677         int      ttl = 255;
 678
 679         if (nbrp && (nbrp->flags & F_NBRP_GTSM_HOPS))
 680                 ttl = 256 - nbrp->gtsm_hops;
 681
 682         switch (af) {
 683         case AF_INET:
 684                 if (sock_set_ipv4_minttl(fd, ttl) == -1)
 685                         return (-1);
 686                 ttl = 255;
 687                 if (sock_set_ipv4_ucast_ttl(fd, ttl) == -1)
 688                         return (-1);
 689                 break;
 690         case AF_INET6:
 691                 /* ignore any possible error */
 692                 sock_set_ipv6_minhopcount(fd, ttl);
 693                 ttl = 255;
 694                 if (sock_set_ipv6_ucast_hops(fd, ttl) == -1)
 695                         return (-1);
 696                 break;
 697         default:
 698                 fatalx("nbr_gtsm_setup: unknown af");
 699         }
 700
 701         return (0);
 702 }
 703
 704 int
 705 nbr_gtsm_check(int fd, struct nbr *nbr, struct nbr_params *nbrp)
 706 {
 707         if (!nbr_gtsm_enabled(nbr, nbrp)) {
 708                 switch (nbr->af) {
 709                 case AF_INET:
 710                         sock_set_ipv4_ucast_ttl(fd, -1);
 711                         break;
 712                 case AF_INET6:
 713                         /*
 714                          * Send packets with a Hop Limit of 255 even when GSTM
 715                          * is disabled to guarantee interoperability.
 716                          */
 717                         sock_set_ipv6_ucast_hops(fd, 255);
 718                         break;
 719                 default:
 720                         fatalx("nbr_gtsm_check: unknown af");
 721                         break;
 722                 }
 723                 return (0);
 724         }
 725
 726         if (nbr_gtsm_setup(fd, nbr->af, nbrp) == -1) {
 727                 log_warnx("%s: error enabling GTSM for lsr-id %s", __func__,
 728                     inet_ntoa(nbr->id));
 729                 return (-1);
 730         }
 731
 732         return (0);
 733 }
 734
 735 static int
 736 nbr_act_session_operational(struct nbr *nbr)
 737 {
 738         struct lde_nbr   lde_nbr;
 739
 740         nbr->idtimer_cnt = 0;
 741
 742         /* this is necessary to avoid ipc synchronization issues */
 743         nbr_update_peerid(nbr);
 744
 745         memset(&lde_nbr, 0, sizeof(lde_nbr));
 746         lde_nbr.id = nbr->id;
 747         lde_nbr.v4_enabled = nbr->v4_enabled;
 748         lde_nbr.v6_enabled = nbr->v6_enabled;
 749         lde_nbr.flags = nbr->flags;
 750         return (ldpe_imsg_compose_lde(IMSG_NEIGHBOR_UP, nbr->peerid, 0,
 751             &lde_nbr, sizeof(lde_nbr)));
 752 }
 753
 754 static void
 755 nbr_send_labelmappings(struct nbr *nbr)
 756 {
 757         ldpe_imsg_compose_lde(IMSG_LABEL_MAPPING_FULL, nbr->peerid, 0,
 758             NULL, 0);
 759 }
 760
 761 static __inline int
 762 nbr_params_compare(struct nbr_params *a, struct nbr_params *b)
 763 {
 764         return (ntohl(a->lsr_id.s_addr) - ntohl(b->lsr_id.s_addr));
 765 }
 766
 767 struct nbr_params *
 768 nbr_params_new(struct in_addr lsr_id)
 769 {
 770         struct nbr_params       *nbrp;
 771
 772         if ((nbrp = calloc(1, sizeof(*nbrp))) == NULL)
 773                 fatal(__func__);
 774
 775         nbrp->lsr_id = lsr_id;
 776         nbrp->auth.method = AUTH_NONE;
 777
 778         return (nbrp);
 779 }
 780
 781 struct nbr_params *
 782 nbr_params_find(struct ldpd_conf *xconf, struct in_addr lsr_id)
 783 {
 784         struct nbr_params        nbrp;
 785         nbrp.lsr_id = lsr_id;
 786         return (RB_FIND(nbrp_head, &xconf->nbrp_tree, &nbrp));
 787 }
 788
 789 uint16_t
 790 nbr_get_keepalive(int af, struct in_addr lsr_id)
 791 {
 792         struct nbr_params       *nbrp;
 793
 794         nbrp = nbr_params_find(leconf, lsr_id);
 795         if (nbrp && (nbrp->flags & F_NBRP_KEEPALIVE))
 796                 return (nbrp->keepalive);
 797
 798         return ((ldp_af_conf_get(leconf, af))->keepalive);
 799 }
 800
 801 struct ctl_nbr *
 802 nbr_to_ctl(struct nbr *nbr)
 803 {
 804         static struct ctl_nbr    nctl;
 805         struct timeval           now;
 806
 807         nctl.af = nbr->af;
 808         nctl.id = nbr->id;
 809         nctl.laddr = nbr->laddr;
 810         nctl.lport = nbr->tcp->lport;
 811         nctl.raddr = nbr->raddr;
 812         nctl.rport = nbr->tcp->rport;
 813         nctl.auth_method = nbr->auth.method;
 814         nctl.holdtime = nbr->keepalive;
 815         nctl.nbr_state = nbr->state;
 816         nctl.stats = nbr->stats;
 817         nctl.flags = nbr->flags;
 818
 819         gettimeofday(&now, NULL);
 820         if (nbr->state == NBR_STA_OPER) {
 821                 nctl.uptime = now.tv_sec - nbr->uptime;
 822         } else
 823                 nctl.uptime = 0;
 824
 825         return (&nctl);
 826 }
 827
 828 void
 829 nbr_clear_ctl(struct ctl_nbr *nctl)
 830 {
 831         struct nbr              *nbr;
 832
 833         RB_FOREACH(nbr, nbr_addr_head, &nbrs_by_addr) {
 834                 if (ldp_addrisset(nctl->af, &nctl->raddr) &&
 835                     ldp_addrcmp(nctl->af, &nctl->raddr, &nbr->raddr))
 836                         continue;
 837
 838                 log_debug("%s: neighbor %s manually cleared", __func__,
 839                     log_addr(nbr->af, &nbr->raddr));
 840                 session_shutdown(nbr, S_SHUTDOWN, 0, 0);
 841         }
 842 }