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         struct adj              *adj;
 291
 292         log_debug("%s: lsr-id %s", __func__, inet_ntoa(nbr->id));
 293
 294         nbr_fsm(nbr, NBR_EVT_CLOSE_SESSION);
 295 #ifdef __OpenBSD__
 296         pfkey_remove(nbr);
 297 #else
 298         sock_set_md5sig(
 299             (ldp_af_global_get(&global, nbr->af))->ldp_session_socket,
 300             nbr->af, &nbr->raddr, NULL);
 301 #endif
 302         nbr->auth.method = AUTH_NONE;
 303
 304         if (nbr_pending_connect(nbr))
 305                 THREAD_WRITE_OFF(nbr->ev_connect);
 306         nbr_stop_ktimer(nbr);
 307         nbr_stop_ktimeout(nbr);
 308         nbr_stop_itimeout(nbr);
 309         nbr_stop_idtimer(nbr);
 310
 311         mapping_list_clr(&nbr->mapping_list);
 312         mapping_list_clr(&nbr->withdraw_list);
 313         mapping_list_clr(&nbr->request_list);
 314         mapping_list_clr(&nbr->release_list);
 315         mapping_list_clr(&nbr->abortreq_list);
 316
 317         while ((adj = RB_ROOT(&nbr->adj_tree)) != NULL) {
 318                 adj->nbr = NULL;
 319                 RB_REMOVE(nbr_adj_head, &nbr->adj_tree, adj);
 320         }
 321
 322         if (nbr->peerid)
 323                 RB_REMOVE(nbr_pid_head, &nbrs_by_pid, nbr);
 324         RB_REMOVE(nbr_id_head, &nbrs_by_id, nbr);
 325         RB_REMOVE(nbr_addr_head, &nbrs_by_addr, nbr);
 326
 327         free(nbr);
 328 }
 329
 330 static void
 331 nbr_update_peerid(struct nbr *nbr)
 332 {
 333         static uint32_t  peercnt = 1;
 334
 335         if (nbr->peerid)
 336                 RB_REMOVE(nbr_pid_head, &nbrs_by_pid, nbr);
 337
 338         /* get next unused peerid */
 339         while (nbr_find_peerid(++peercnt))
 340                 ;
 341         nbr->peerid = peercnt;
 342
 343         if (RB_INSERT(nbr_pid_head, &nbrs_by_pid, nbr) != NULL)
 344                 fatalx("nbr_update_peerid: RB_INSERT(nbrs_by_pid) failed");
 345 }
 346
 347 struct nbr *
 348 nbr_find_ldpid(uint32_t lsr_id)
 349 {
 350         struct nbr      n;
 351         n.id.s_addr = lsr_id;
 352         return (RB_FIND(nbr_id_head, &nbrs_by_id, &n));
 353 }
 354
 355 struct nbr *
 356 nbr_find_addr(int af, union ldpd_addr *addr)
 357 {
 358         struct nbr      n;
 359         n.af = af;
 360         n.raddr = *addr;
 361         return (RB_FIND(nbr_addr_head, &nbrs_by_addr, &n));
 362 }
 363
 364 struct nbr *
 365 nbr_find_peerid(uint32_t peerid)
 366 {
 367         struct nbr      n;
 368         n.peerid = peerid;
 369         return (RB_FIND(nbr_pid_head, &nbrs_by_pid, &n));
 370 }
 371
 372 int
 373 nbr_adj_count(struct nbr *nbr, int af)
 374 {
 375         struct adj      *adj;
 376         int              total = 0;
 377
 378         RB_FOREACH(adj, nbr_adj_head, &nbr->adj_tree)
 379                 if (adj_get_af(adj) == af)
 380                         total++;
 381
 382         return (total);
 383 }
 384
 385 int
 386 nbr_session_active_role(struct nbr *nbr)
 387 {
 388         if (ldp_addrcmp(nbr->af, &nbr->laddr, &nbr->raddr) > 0)
 389                 return (1);
 390
 391         return (0);
 392 }
 393
 394 /* timers */
 395
 396 /* Keepalive timer: timer to send keepalive message to neighbors */
 397
 398 static int
 399 nbr_ktimer(struct thread *thread)
 400 {
 401         struct nbr      *nbr = THREAD_ARG(thread);
 402
 403         nbr->keepalive_timer = NULL;
 404         send_keepalive(nbr);
 405         nbr_start_ktimer(nbr);
 406
 407         return (0);
 408 }
 409
 410 static void
 411 nbr_start_ktimer(struct nbr *nbr)
 412 {
 413         int              secs;
 414
 415         /* send three keepalives per period */
 416         secs = nbr->keepalive / KEEPALIVE_PER_PERIOD;
 417         THREAD_TIMER_OFF(nbr->keepalive_timer);
 418         nbr->keepalive_timer = thread_add_timer(master, nbr_ktimer, nbr, secs);
 419 }
 420
 421 void
 422 nbr_stop_ktimer(struct nbr *nbr)
 423 {
 424         THREAD_TIMER_OFF(nbr->keepalive_timer);
 425 }
 426
 427 /* Keepalive timeout: if the nbr hasn't sent keepalive */
 428
 429 static int
 430 nbr_ktimeout(struct thread *thread)
 431 {
 432         struct nbr *nbr = THREAD_ARG(thread);
 433
 434         nbr->keepalive_timeout = NULL;
 435
 436         log_debug("%s: lsr-id %s", __func__, inet_ntoa(nbr->id));
 437
 438         session_shutdown(nbr, S_KEEPALIVE_TMR, 0, 0);
 439
 440         return (0);
 441 }
 442
 443 static void
 444 nbr_start_ktimeout(struct nbr *nbr)
 445 {
 446         THREAD_TIMER_OFF(nbr->keepalive_timeout);
 447         nbr->keepalive_timeout = thread_add_timer(master, nbr_ktimeout, nbr,
 448             nbr->keepalive);
 449 }
 450
 451 void
 452 nbr_stop_ktimeout(struct nbr *nbr)
 453 {
 454         THREAD_TIMER_OFF(nbr->keepalive_timeout);
 455 }
 456
 457 /* Session initialization timeout: if nbr got stuck in the initialization FSM */
 458
 459 static int
 460 nbr_itimeout(struct thread *thread)
 461 {
 462         struct nbr      *nbr = THREAD_ARG(thread);
 463
 464         log_debug("%s: lsr-id %s", __func__, inet_ntoa(nbr->id));
 465
 466         nbr_fsm(nbr, NBR_EVT_CLOSE_SESSION);
 467
 468         return (0);
 469 }
 470
 471 static void
 472 nbr_start_itimeout(struct nbr *nbr)
 473 {
 474         int              secs;
 475
 476         secs = INIT_FSM_TIMEOUT;
 477         THREAD_TIMER_OFF(nbr->init_timeout);
 478         nbr->init_timeout = thread_add_timer(master, nbr_itimeout, nbr, secs);
 479 }
 480
 481 void
 482 nbr_stop_itimeout(struct nbr *nbr)
 483 {
 484         THREAD_TIMER_OFF(nbr->init_timeout);
 485 }
 486
 487 /* Init delay timer: timer to retry to iniziatize session */
 488
 489 static int
 490 nbr_idtimer(struct thread *thread)
 491 {
 492         struct nbr *nbr = THREAD_ARG(thread);
 493
 494         nbr->initdelay_timer = NULL;
 495
 496         log_debug("%s: lsr-id %s", __func__, inet_ntoa(nbr->id));
 497
 498         nbr_establish_connection(nbr);
 499
 500         return (0);
 501 }
 502
 503 void
 504 nbr_start_idtimer(struct nbr *nbr)
 505 {
 506         int     secs;
 507
 508         secs = INIT_DELAY_TMR;
 509         switch(nbr->idtimer_cnt) {
 510         default:
 511                 /* do not further increase the counter */
 512                 secs = MAX_DELAY_TMR;
 513                 break;
 514         case 2:
 515                 secs *= 2;
 516                 /* FALLTHROUGH */
 517         case 1:
 518                 secs *= 2;
 519                 /* FALLTHROUGH */
 520         case 0:
 521                 nbr->idtimer_cnt++;
 522                 break;
 523         }
 524
 525         THREAD_TIMER_OFF(nbr->initdelay_timer);
 526         nbr->initdelay_timer = thread_add_timer(master, nbr_idtimer, nbr, secs);
 527 }
 528
 529 void
 530 nbr_stop_idtimer(struct nbr *nbr)
 531 {
 532         THREAD_TIMER_OFF(nbr->initdelay_timer);
 533 }
 534
 535 int
 536 nbr_pending_idtimer(struct nbr *nbr)
 537 {
 538         return (nbr->initdelay_timer != NULL);
 539 }
 540
 541 int
 542 nbr_pending_connect(struct nbr *nbr)
 543 {
 544         return (nbr->ev_connect != NULL);
 545 }
 546
 547 static int
 548 nbr_connect_cb(struct thread *thread)
 549 {
 550         struct nbr      *nbr = THREAD_ARG(thread);
 551         int              error;
 552         socklen_t        len;
 553
 554         nbr->ev_connect = NULL;
 555
 556         len = sizeof(error);
 557         if (getsockopt(nbr->fd, SOL_SOCKET, SO_ERROR, &error, &len) < 0) {
 558                 log_warn("%s: getsockopt SOL_SOCKET SO_ERROR", __func__);
 559                 return (0);
 560         }
 561
 562         if (error) {
 563                 close(nbr->fd);
 564                 errno = error;
 565                 log_debug("%s: error while connecting to %s: %s", __func__,
 566                     log_addr(nbr->af, &nbr->raddr), strerror(errno));
 567                 return (0);
 568         }
 569
 570         nbr_fsm(nbr, NBR_EVT_CONNECT_UP);
 571
 572         return (0);
 573 }
 574
 575 int
 576 nbr_establish_connection(struct nbr *nbr)
 577 {
 578         struct sockaddr_storage  local_sa;
 579         struct sockaddr_storage  remote_sa;
 580         struct adj              *adj;
 581         struct nbr_params       *nbrp;
 582 #ifdef __OpenBSD__
 583         int                      opt = 1;
 584 #endif
 585
 586         nbr->fd = socket(nbr->af, SOCK_STREAM, 0);
 587         if (nbr->fd == -1) {
 588                 log_warn("%s: error while creating socket", __func__);
 589                 return (-1);
 590         }
 591         sock_set_nonblock(nbr->fd);
 592
 593         nbrp = nbr_params_find(leconf, nbr->id);
 594         if (nbrp && nbrp->auth.method == AUTH_MD5SIG) {
 595 #ifdef __OpenBSD__
 596                 if (sysdep.no_pfkey || sysdep.no_md5sig) {
 597                         log_warnx("md5sig configured but not available");
 598                         close(nbr->fd);
 599                         return (-1);
 600                 }
 601                 if (setsockopt(nbr->fd, IPPROTO_TCP, TCP_MD5SIG,
 602                     &opt, sizeof(opt)) == -1) {
 603                         log_warn("setsockopt md5sig");
 604                         close(nbr->fd);
 605                         return (-1);
 606                 }
 607 #else
 608                 sock_set_md5sig(nbr->fd, nbr->af, &nbr->raddr,
 609                     nbrp->auth.md5key);
 610 #endif
 611         }
 612
 613         memcpy(&local_sa, addr2sa(nbr->af, &nbr->laddr, 0), sizeof(local_sa));
 614         memcpy(&remote_sa, addr2sa(nbr->af, &nbr->raddr, LDP_PORT),
 615             sizeof(local_sa));
 616         if (nbr->af == AF_INET6 && nbr->raddr_scope)
 617                 addscope((struct sockaddr_in6 *)&remote_sa, nbr->raddr_scope);
 618
 619         if (bind(nbr->fd, (struct sockaddr *)&local_sa,
 620             sockaddr_len((struct sockaddr *)&local_sa)) == -1) {
 621                 log_warn("%s: error while binding socket to %s", __func__,
 622                     log_sockaddr((struct sockaddr *)&local_sa));
 623                 close(nbr->fd);
 624                 return (-1);
 625         }
 626
 627         if (nbr_gtsm_check(nbr->fd, nbr, nbrp)) {
 628                 close(nbr->fd);
 629                 return (-1);
 630         }
 631
 632         /*
 633          * Send an extra hello to guarantee that the remote peer has formed
 634          * an adjacency as well.
 635          */
 636         RB_FOREACH(adj, nbr_adj_head, &nbr->adj_tree)
 637                 send_hello(adj->source.type, adj->source.link.ia,
 638                     adj->source.target);
 639
 640         if (connect(nbr->fd, (struct sockaddr *)&remote_sa,
 641             sockaddr_len((struct sockaddr *)&remote_sa)) == -1) {
 642                 if (errno == EINPROGRESS) {
 643                         THREAD_WRITE_ON(master, nbr->ev_connect, nbr_connect_cb,
 644                             nbr, nbr->fd);
 645                         return (0);
 646                 }
 647                 log_warn("%s: error while connecting to %s", __func__,
 648                     log_sockaddr((struct sockaddr *)&remote_sa));
 649                 close(nbr->fd);
 650                 return (-1);
 651         }
 652
 653         /* connection completed immediately */
 654         nbr_fsm(nbr, NBR_EVT_CONNECT_UP);
 655
 656         return (0);
 657 }
 658
 659 int
 660 nbr_gtsm_enabled(struct nbr *nbr, struct nbr_params *nbrp)
 661 {
 662         /*
 663          * RFC 6720 - Section 3:
 664          * "This document allows for the implementation to provide an option to
 665          * statically (e.g., via configuration) and/or dynamically override the
 666          * default behavior and enable/disable GTSM on a per-peer basis".
 667          */
 668         if (nbrp && (nbrp->flags & F_NBRP_GTSM))
 669                 return (nbrp->gtsm_enabled);
 670
 671         if ((ldp_af_conf_get(leconf, nbr->af))->flags & F_LDPD_AF_NO_GTSM)
 672                 return (0);
 673
 674         /* By default, GTSM support has to be negotiated for LDPv4 */
 675         if (nbr->af == AF_INET && !(nbr->flags & F_NBR_GTSM_NEGOTIATED))
 676                 return (0);
 677
 678         return (1);
 679 }
 680
 681 int
 682 nbr_gtsm_setup(int fd, int af, struct nbr_params *nbrp)
 683 {
 684         int      ttl = 255;
 685
 686         if (nbrp && (nbrp->flags & F_NBRP_GTSM_HOPS))
 687                 ttl = 256 - nbrp->gtsm_hops;
 688
 689         switch (af) {
 690         case AF_INET:
 691                 if (sock_set_ipv4_minttl(fd, ttl) == -1)
 692                         return (-1);
 693                 ttl = 255;
 694                 if (sock_set_ipv4_ucast_ttl(fd, ttl) == -1)
 695                         return (-1);
 696                 break;
 697         case AF_INET6:
 698                 /* ignore any possible error */
 699                 sock_set_ipv6_minhopcount(fd, ttl);
 700                 ttl = 255;
 701                 if (sock_set_ipv6_ucast_hops(fd, ttl) == -1)
 702                         return (-1);
 703                 break;
 704         default:
 705                 fatalx("nbr_gtsm_setup: unknown af");
 706         }
 707
 708         return (0);
 709 }
 710
 711 int
 712 nbr_gtsm_check(int fd, struct nbr *nbr, struct nbr_params *nbrp)
 713 {
 714         if (!nbr_gtsm_enabled(nbr, nbrp)) {
 715                 switch (nbr->af) {
 716                 case AF_INET:
 717                         sock_set_ipv4_ucast_ttl(fd, -1);
 718                         break;
 719                 case AF_INET6:
 720                         /*
 721                          * Send packets with a Hop Limit of 255 even when GSTM
 722                          * is disabled to guarantee interoperability.
 723                          */
 724                         sock_set_ipv6_ucast_hops(fd, 255);
 725                         break;
 726                 default:
 727                         fatalx("nbr_gtsm_check: unknown af");
 728                         break;
 729                 }
 730                 return (0);
 731         }
 732
 733         if (nbr_gtsm_setup(fd, nbr->af, nbrp) == -1) {
 734                 log_warnx("%s: error enabling GTSM for lsr-id %s", __func__,
 735                     inet_ntoa(nbr->id));
 736                 return (-1);
 737         }
 738
 739         return (0);
 740 }
 741
 742 static int
 743 nbr_act_session_operational(struct nbr *nbr)
 744 {
 745         struct lde_nbr   lde_nbr;
 746
 747         nbr->idtimer_cnt = 0;
 748
 749         /* this is necessary to avoid ipc synchronization issues */
 750         nbr_update_peerid(nbr);
 751
 752         memset(&lde_nbr, 0, sizeof(lde_nbr));
 753         lde_nbr.id = nbr->id;
 754         lde_nbr.v4_enabled = nbr->v4_enabled;
 755         lde_nbr.v6_enabled = nbr->v6_enabled;
 756         lde_nbr.flags = nbr->flags;
 757         return (ldpe_imsg_compose_lde(IMSG_NEIGHBOR_UP, nbr->peerid, 0,
 758             &lde_nbr, sizeof(lde_nbr)));
 759 }
 760
 761 static void
 762 nbr_send_labelmappings(struct nbr *nbr)
 763 {
 764         ldpe_imsg_compose_lde(IMSG_LABEL_MAPPING_FULL, nbr->peerid, 0,
 765             NULL, 0);
 766 }
 767
 768 static __inline int
 769 nbr_params_compare(struct nbr_params *a, struct nbr_params *b)
 770 {
 771         return (ntohl(a->lsr_id.s_addr) - ntohl(b->lsr_id.s_addr));
 772 }
 773
 774 struct nbr_params *
 775 nbr_params_new(struct in_addr lsr_id)
 776 {
 777         struct nbr_params       *nbrp;
 778
 779         if ((nbrp = calloc(1, sizeof(*nbrp))) == NULL)
 780                 fatal(__func__);
 781
 782         nbrp->lsr_id = lsr_id;
 783         nbrp->auth.method = AUTH_NONE;
 784
 785         return (nbrp);
 786 }
 787
 788 struct nbr_params *
 789 nbr_params_find(struct ldpd_conf *xconf, struct in_addr lsr_id)
 790 {
 791         struct nbr_params        nbrp;
 792         nbrp.lsr_id = lsr_id;
 793         return (RB_FIND(nbrp_head, &xconf->nbrp_tree, &nbrp));
 794 }
 795
 796 uint16_t
 797 nbr_get_keepalive(int af, struct in_addr lsr_id)
 798 {
 799         struct nbr_params       *nbrp;
 800
 801         nbrp = nbr_params_find(leconf, lsr_id);
 802         if (nbrp && (nbrp->flags & F_NBRP_KEEPALIVE))
 803                 return (nbrp->keepalive);
 804
 805         return ((ldp_af_conf_get(leconf, af))->keepalive);
 806 }
 807
 808 struct ctl_nbr *
 809 nbr_to_ctl(struct nbr *nbr)
 810 {
 811         static struct ctl_nbr    nctl;
 812         struct timeval           now;
 813
 814         nctl.af = nbr->af;
 815         nctl.id = nbr->id;
 816         nctl.laddr = nbr->laddr;
 817         nctl.lport = nbr->tcp->lport;
 818         nctl.raddr = nbr->raddr;
 819         nctl.rport = nbr->tcp->rport;
 820         nctl.auth_method = nbr->auth.method;
 821         nctl.holdtime = nbr->keepalive;
 822         nctl.nbr_state = nbr->state;
 823         nctl.stats = nbr->stats;
 824         nctl.flags = nbr->flags;
 825
 826         gettimeofday(&now, NULL);
 827         if (nbr->state == NBR_STA_OPER) {
 828                 nctl.uptime = now.tv_sec - nbr->uptime;
 829         } else
 830                 nctl.uptime = 0;
 831
 832         return (&nctl);
 833 }
 834
 835 void
 836 nbr_clear_ctl(struct ctl_nbr *nctl)
 837 {
 838         struct nbr              *nbr;
 839
 840         RB_FOREACH(nbr, nbr_addr_head, &nbrs_by_addr) {
 841                 if (ldp_addrisset(nctl->af, &nctl->raddr) &&
 842                     ldp_addrcmp(nctl->af, &nctl->raddr, &nbr->raddr))
 843                         continue;
 844
 845                 log_debug("%s: neighbor %s manually cleared", __func__,
 846                     log_addr(nbr->af, &nbr->raddr));
 847                 session_shutdown(nbr, S_SHUTDOWN, 0, 0);
 848         }
 849 }