pimd/pim_zlookup.c

   1 /*
   2   PIM for Quagga
   3   Copyright (C) 2008  Everton da Silva Marques
   4
   5   This program is free software; you can redistribute it and/or modify
   6   it under the terms of the GNU General Public License as published by
   7   the Free Software Foundation; either version 2 of the License, or
   8   (at your option) any later version.
   9
  10   This program is distributed in the hope that it will be useful, but
  11   WITHOUT ANY WARRANTY; without even the implied warranty of
  12   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13   General Public License for more details.
  14
  15   You should have received a copy of the GNU General Public License
  16   along with this program; see the file COPYING; if not, write to the
  17   Free Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
  18   MA 02110-1301 USA
  19 */
  20
  21 #include <zebra.h>
  22 #include "zebra/rib.h"
  23
  24 #include "log.h"
  25 #include "prefix.h"
  26 #include "zclient.h"
  27 #include "stream.h"
  28 #include "network.h"
  29 #include "thread.h"
  30 #include "prefix.h"
  31 #include "vty.h"
  32
  33 #include "pimd.h"
  34 #include "pim_iface.h"
  35 #include "pim_pim.h"
  36 #include "pim_str.h"
  37 #include "pim_oil.h"
  38 #include "pim_zlookup.h"
  39
  40 static struct zclient *zlookup = NULL;
  41
  42 static void zclient_lookup_sched(struct zclient *zlookup, int delay);
  43
  44 /* Connect to zebra for nexthop lookup. */
  45 static int zclient_lookup_connect(struct thread *t)
  46 {
  47   struct zclient *zlookup;
  48
  49   zlookup = THREAD_ARG(t);
  50   zlookup->t_connect = NULL;
  51
  52   if (zlookup->sock >= 0) {
  53     return 0;
  54   }
  55
  56   if (zclient_socket_connect(zlookup) < 0) {
  57     ++zlookup->fail;
  58     zlog_warn("%s: failure connecting zclient socket: failures=%d",
  59               __PRETTY_FUNCTION__, zlookup->fail);
  60   }
  61   else {
  62     zlookup->fail = 0; /* reset counter on connection */
  63   }
  64
  65   zassert(!zlookup->t_connect);
  66   if (zlookup->sock < 0) {
  67     /* Since last connect failed, retry within 10 secs */
  68     zclient_lookup_sched(zlookup, 10);
  69     return -1;
  70   }
  71
  72   return 0;
  73 }
  74
  75 /* Schedule connection with delay. */
  76 static void zclient_lookup_sched(struct zclient *zlookup, int delay)
  77 {
  78   zassert(!zlookup->t_connect);
  79
  80   THREAD_TIMER_ON(master, zlookup->t_connect,
  81                   zclient_lookup_connect,
  82                   zlookup, delay);
  83
  84   zlog_notice("%s: zclient lookup connection scheduled for %d seconds",
  85               __PRETTY_FUNCTION__, delay);
  86 }
  87
  88 /* Schedule connection for now. */
  89 static void zclient_lookup_sched_now(struct zclient *zlookup)
  90 {
  91   zassert(!zlookup->t_connect);
  92
  93   zlookup->t_connect = thread_add_event(master, zclient_lookup_connect,
  94                                         zlookup, 0);
  95
  96   zlog_notice("%s: zclient lookup immediate connection scheduled",
  97               __PRETTY_FUNCTION__);
  98 }
  99
 100 /* Schedule reconnection, if needed. */
 101 static void zclient_lookup_reconnect(struct zclient *zlookup)
 102 {
 103   if (zlookup->t_connect) {
 104     return;
 105   }
 106
 107   zclient_lookup_sched_now(zlookup);
 108 }
 109
 110 static void zclient_lookup_failed(struct zclient *zlookup)
 111 {
 112   if (zlookup->sock >= 0) {
 113     if (close(zlookup->sock)) {
 114       zlog_warn("%s: closing fd=%d: errno=%d %s", __func__, zlookup->sock,
 115                 errno, safe_strerror(errno));
 116     }
 117     zlookup->sock = -1;
 118   }
 119
 120   zclient_lookup_reconnect(zlookup);
 121 }
 122
 123 void
 124 zclient_lookup_free (void)
 125 {
 126   zclient_free (zlookup);
 127   zlookup = NULL;
 128 }
 129
 130 void
 131 zclient_lookup_new (void)
 132 {
 133   zlookup = zclient_new (master);
 134   if (!zlookup) {
 135     zlog_err("%s: zclient_new() failure",
 136              __PRETTY_FUNCTION__);
 137     return;
 138   }
 139
 140   zlookup->sock = -1;
 141   zlookup->t_connect = NULL;
 142
 143   zclient_lookup_sched_now(zlookup);
 144
 145   zlog_notice("%s: zclient lookup socket initialized",
 146               __PRETTY_FUNCTION__);
 147
 148 }
 149
 150 static int zclient_read_nexthop(struct zclient *zlookup,
 151                                 struct pim_zlookup_nexthop nexthop_tab[],
 152                                 const int tab_size,
 153                                 struct in_addr addr)
 154 {
 155   int num_ifindex = 0;
 156   struct stream *s;
 157   const uint16_t MIN_LEN = 10; /* getipv4=4 getc=1 getl=4 getc=1 */
 158   uint16_t length;
 159   u_char marker;
 160   u_char version;
 161   vrf_id_t vrf_id;
 162   uint16_t command = 0;
 163   struct in_addr raddr;
 164   uint8_t distance;
 165   uint32_t metric;
 166   int nexthop_num;
 167   int i, err;
 168
 169   if (PIM_DEBUG_PIM_TRACE_DETAIL) {
 170     char addr_str[INET_ADDRSTRLEN];
 171     pim_inet4_dump("<addr?>", addr, addr_str, sizeof(addr_str));
 172     zlog_debug("%s: addr=%s",
 173                __PRETTY_FUNCTION__,
 174                addr_str);
 175   }
 176
 177   s = zlookup->ibuf;
 178
 179   while (command != ZEBRA_IPV4_NEXTHOP_LOOKUP_MRIB)
 180     {
 181       stream_reset(s);
 182       err = zclient_read_header (s, zlookup->sock, &length, &marker, &version,
 183                                  &vrf_id, &command);
 184       if (err < 0) {
 185         zlog_err("%s %s: zclient_read_header() failed",
 186                  __FILE__, __PRETTY_FUNCTION__);
 187         zclient_lookup_failed(zlookup);
 188         return -1;
 189       }
 190
 191       if (length < MIN_LEN) {
 192         zlog_err("%s %s: failure reading zclient lookup socket: len=%d < MIN_LEN=%d",
 193                  __FILE__, __PRETTY_FUNCTION__, length, MIN_LEN);
 194         zclient_lookup_failed(zlookup);
 195         return -2;
 196       }
 197     }
 198
 199   raddr.s_addr = stream_get_ipv4(s);
 200
 201   if (raddr.s_addr != addr.s_addr) {
 202     char addr_str[INET_ADDRSTRLEN];
 203     char raddr_str[INET_ADDRSTRLEN];
 204     pim_inet4_dump("<addr?>", addr, addr_str, sizeof(addr_str));
 205     pim_inet4_dump("<raddr?>", raddr, raddr_str, sizeof(raddr_str));
 206     zlog_warn("%s: address mismatch: addr=%s raddr=%s",
 207                __PRETTY_FUNCTION__,
 208                addr_str, raddr_str);
 209     /* warning only */
 210   }
 211
 212   distance = stream_getc(s);
 213   metric = stream_getl(s);
 214   nexthop_num = stream_getc(s);
 215
 216   if (nexthop_num < 1) {
 217     zlog_err("%s: socket %d bad nexthop_num=%d",
 218             __func__, zlookup->sock, nexthop_num);
 219     return -6;
 220   }
 221
 222   for (i = 0; i < nexthop_num; ++i) {
 223     enum nexthop_types_t nexthop_type;
 224     struct pim_neighbor *nbr;
 225     struct prefix p;
 226
 227     nexthop_type = stream_getc(s);
 228     if (num_ifindex >= tab_size) {
 229       char addr_str[INET_ADDRSTRLEN];
 230       pim_inet4_dump("<addr?>", addr, addr_str, sizeof(addr_str));
 231       zlog_warn("%s %s: found too many nexthop ifindexes (%d > %d) for address %s",
 232                 __FILE__, __PRETTY_FUNCTION__,
 233                 (num_ifindex + 1), tab_size, addr_str);
 234       return num_ifindex;
 235     }
 236     switch (nexthop_type) {
 237     case NEXTHOP_TYPE_IFINDEX:
 238     case NEXTHOP_TYPE_IPV4_IFINDEX:
 239     case NEXTHOP_TYPE_IPV4:
 240       nexthop_tab[num_ifindex].nexthop_addr.family = AF_INET;
 241       if (nexthop_type == NEXTHOP_TYPE_IPV4_IFINDEX ||
 242           nexthop_type == NEXTHOP_TYPE_IPV4) {
 243         nexthop_tab[num_ifindex].nexthop_addr.u.prefix4.s_addr = stream_get_ipv4(s);
 244       }
 245       else {
 246         nexthop_tab[num_ifindex].nexthop_addr.u.prefix4.s_addr = PIM_NET_INADDR_ANY;
 247       }
 248       nexthop_tab[num_ifindex].ifindex           = stream_getl(s);
 249       nexthop_tab[num_ifindex].protocol_distance = distance;
 250       nexthop_tab[num_ifindex].route_metric      = metric;
 251       ++num_ifindex;
 252       break;
 253     case NEXTHOP_TYPE_IPV6_IFINDEX:
 254       nexthop_tab[num_ifindex].nexthop_addr.family = AF_INET6;
 255       stream_get (&nexthop_tab[num_ifindex].nexthop_addr.u.prefix6, s, 16);
 256       nexthop_tab[num_ifindex].ifindex = stream_getl (s);
 257
 258       p.family = AF_INET6;
 259       p.prefixlen = IPV6_MAX_PREFIXLEN;
 260       memcpy (&p.u.prefix6, &nexthop_tab[num_ifindex].nexthop_addr.u.prefix6, 16);
 261
 262       /*
 263        * If we are sending v6 secondary assume we receive v6 secondary
 264        */
 265       if (pimg->send_v6_secondary)
 266         nbr = pim_neighbor_find_by_secondary(if_lookup_by_index (nexthop_tab[num_ifindex].ifindex, VRF_DEFAULT), &p);
 267       else
 268         nbr = pim_neighbor_find_if (if_lookup_by_index (nexthop_tab[num_ifindex].ifindex, VRF_DEFAULT));
 269       if (nbr)
 270         {
 271           nexthop_tab[num_ifindex].nexthop_addr.family = AF_INET;
 272           nexthop_tab[num_ifindex].nexthop_addr.u.prefix4 = nbr->source_addr;
 273         }
 274         ++num_ifindex;
 275       break;
 276     default:
 277       /* do nothing */
 278       {
 279         char addr_str[INET_ADDRSTRLEN];
 280         pim_inet4_dump("<addr?>", addr, addr_str, sizeof(addr_str));
 281         zlog_warn("%s %s: found non-ifindex nexthop type=%d for address %s",
 282                  __FILE__, __PRETTY_FUNCTION__,
 283                   nexthop_type, addr_str);
 284       }
 285       break;
 286     }
 287   }
 288
 289   return num_ifindex;
 290 }
 291
 292 static int
 293 zclient_lookup_nexthop_once (struct pim_zlookup_nexthop nexthop_tab[],
 294                              const int tab_size,
 295                              struct in_addr addr)
 296 {
 297   struct stream *s;
 298   int ret;
 299
 300   if (PIM_DEBUG_PIM_TRACE_DETAIL) {
 301     char addr_str[INET_ADDRSTRLEN];
 302     pim_inet4_dump("<addr?>", addr, addr_str, sizeof(addr_str));
 303     zlog_debug("%s: addr=%s",
 304                __PRETTY_FUNCTION__,
 305                addr_str);
 306   }
 307
 308   /* Check socket. */
 309   if (zlookup->sock < 0) {
 310     zlog_err("%s %s: zclient lookup socket is not connected",
 311              __FILE__, __PRETTY_FUNCTION__);
 312     zclient_lookup_failed(zlookup);
 313     return -1;
 314   }
 315
 316   s = zlookup->obuf;
 317   stream_reset(s);
 318   zclient_create_header(s, ZEBRA_IPV4_NEXTHOP_LOOKUP_MRIB, VRF_DEFAULT);
 319   stream_put_in_addr(s, &addr);
 320   stream_putw_at(s, 0, stream_get_endp(s));
 321
 322   ret = writen(zlookup->sock, s->data, stream_get_endp(s));
 323   if (ret < 0) {
 324     zlog_err("%s %s: writen() failure: %d writing to zclient lookup socket",
 325              __FILE__, __PRETTY_FUNCTION__, errno);
 326     zclient_lookup_failed(zlookup);
 327     return -2;
 328   }
 329   if (ret == 0) {
 330     zlog_err("%s %s: connection closed on zclient lookup socket",
 331              __FILE__, __PRETTY_FUNCTION__);
 332     zclient_lookup_failed(zlookup);
 333     return -3;
 334   }
 335
 336   return zclient_read_nexthop(zlookup, nexthop_tab,
 337                               tab_size, addr);
 338 }
 339
 340 int
 341 zclient_lookup_nexthop (struct pim_zlookup_nexthop nexthop_tab[],
 342                         const int tab_size,
 343                         struct in_addr addr,
 344                         int max_lookup)
 345 {
 346   int lookup;
 347   uint32_t route_metric = 0xFFFFFFFF;
 348   uint8_t  protocol_distance = 0xFF;
 349
 350   qpim_nexthop_lookups++;
 351
 352   for (lookup = 0; lookup < max_lookup; ++lookup) {
 353     int num_ifindex;
 354     int first_ifindex;
 355     struct prefix nexthop_addr;
 356
 357     num_ifindex = zclient_lookup_nexthop_once(nexthop_tab,
 358                                               tab_size, addr);
 359     if (num_ifindex < 1) {
 360       if (PIM_DEBUG_ZEBRA) {
 361         char addr_str[INET_ADDRSTRLEN];
 362         pim_inet4_dump("<addr?>", addr, addr_str, sizeof(addr_str));
 363         zlog_debug("%s %s: lookup=%d/%d: could not find nexthop ifindex for address %s",
 364                    __FILE__, __PRETTY_FUNCTION__,
 365                    lookup, max_lookup, addr_str);
 366       }
 367       return -1;
 368     }
 369
 370     if (lookup < 1) {
 371       /* this is the non-recursive lookup - save original metric/distance */
 372       route_metric = nexthop_tab[0].route_metric;
 373       protocol_distance = nexthop_tab[0].protocol_distance;
 374     }
 375
 376     /*
 377      * FIXME: Non-recursive nexthop ensured only for first ifindex.
 378      * However, recursive route lookup should really be fixed in zebra daemon.
 379      * See also TODO T24.
 380      *
 381      * So Zebra for NEXTHOP_TYPE_IPV4 returns the ifindex now since
 382      * it was being stored.  This Doesn't solve all cases of
 383      * recursive lookup but for the most common types it does.
 384      */
 385     first_ifindex = nexthop_tab[0].ifindex;
 386     nexthop_addr = nexthop_tab[0].nexthop_addr;
 387     if (first_ifindex > 0) {
 388       /* found: first ifindex is non-recursive nexthop */
 389
 390       if (lookup > 0) {
 391         /* Report non-recursive success after first lookup */
 392         if (PIM_DEBUG_ZEBRA) {
 393           char addr_str[INET_ADDRSTRLEN];
 394           pim_inet4_dump("<addr?>", addr, addr_str, sizeof(addr_str));
 395           zlog_debug("%s %s: lookup=%d/%d: found non-recursive ifindex=%d for address %s dist=%d met=%d",
 396                      __FILE__, __PRETTY_FUNCTION__,
 397                      lookup, max_lookup, first_ifindex, addr_str,
 398                      nexthop_tab[0].protocol_distance,
 399                      nexthop_tab[0].route_metric);
 400         }
 401
 402         /* use last address as nexthop address */
 403         nexthop_tab[0].nexthop_addr.u.prefix4 = addr;
 404
 405         /* report original route metric/distance */
 406         nexthop_tab[0].route_metric = route_metric;
 407         nexthop_tab[0].protocol_distance = protocol_distance;
 408       }
 409
 410       return num_ifindex;
 411     }
 412
 413     if (PIM_DEBUG_ZEBRA) {
 414       char addr_str[INET_ADDRSTRLEN];
 415       char nexthop_str[PREFIX_STRLEN];
 416       pim_inet4_dump("<addr?>", addr, addr_str, sizeof(addr_str));
 417       pim_addr_dump("<nexthop?>", &nexthop_addr, nexthop_str, sizeof(nexthop_str));
 418       zlog_debug("%s %s: lookup=%d/%d: zebra returned recursive nexthop %s for address %s dist=%d met=%d",
 419                 __FILE__, __PRETTY_FUNCTION__,
 420                 lookup, max_lookup, nexthop_str, addr_str,
 421                 nexthop_tab[0].protocol_distance,
 422                 nexthop_tab[0].route_metric);
 423     }
 424
 425     addr = nexthop_addr.u.prefix4; /* use nexthop addr for recursive lookup */
 426
 427   } /* for (max_lookup) */
 428
 429   if (PIM_DEBUG_ZEBRA) {
 430     char addr_str[INET_ADDRSTRLEN];
 431     pim_inet4_dump("<addr?>", addr, addr_str, sizeof(addr_str));
 432     zlog_warn("%s %s: lookup=%d/%d: failure searching recursive nexthop ifindex for address %s",
 433               __FILE__, __PRETTY_FUNCTION__,
 434               lookup, max_lookup, addr_str);
 435   }
 436
 437   return -2;
 438 }
 439
 440 void
 441 pim_zlookup_show_ip_multicast (struct vty *vty)
 442 {
 443   vty_out(vty, "Zclient lookup socket: ");
 444   if (zlookup) {
 445     vty_out(vty, "%d failures=%d%s", zlookup->sock,
 446             zlookup->fail, VTY_NEWLINE);
 447   }
 448   else {
 449     vty_out(vty, "<null zclient>%s", VTY_NEWLINE);
 450   }
 451 }
 452
 453 int
 454 pim_zlookup_sg_statistics (struct channel_oil *c_oil)
 455 {
 456   struct stream *s = zlookup->obuf;
 457   uint16_t command = 0;
 458   unsigned long long lastused;
 459   struct prefix_sg sg;
 460   int count = 0;
 461   int ret;
 462   struct interface *ifp = pim_if_find_by_vif_index (c_oil->oil.mfcc_parent);
 463
 464   if (PIM_DEBUG_ZEBRA)
 465     {
 466       struct prefix_sg more;
 467
 468       more.src = c_oil->oil.mfcc_origin;
 469       more.grp = c_oil->oil.mfcc_mcastgrp;
 470       zlog_debug ("Sending Request for New Channel Oil Information(%s) VIIF %d",
 471             pim_str_sg_dump (&more), c_oil->oil.mfcc_parent);
 472     }
 473
 474   if (!ifp)
 475     return -1;
 476
 477   stream_reset (s);
 478   zclient_create_header (s, ZEBRA_IPMR_ROUTE_STATS, VRF_DEFAULT);
 479   stream_put_in_addr (s, &c_oil->oil.mfcc_origin);
 480   stream_put_in_addr (s, &c_oil->oil.mfcc_mcastgrp);
 481   stream_putl (s,  ifp->ifindex);
 482   stream_putw_at(s, 0, stream_get_endp(s));
 483
 484   count = stream_get_endp (s);
 485   ret = writen (zlookup->sock, s->data, count);
 486   if (ret <= 0)
 487     {
 488       zlog_err("%s %s: writen() failure: %d writing to zclient lookup socket",
 489                __FILE__, __PRETTY_FUNCTION__, errno);
 490       return -1;
 491     }
 492
 493   s = zlookup->ibuf;
 494
 495   while (command != ZEBRA_IPMR_ROUTE_STATS)
 496     {
 497       int err;
 498       uint16_t length = 0;
 499       vrf_id_t vrf_id;
 500       u_char marker;
 501       u_char version;
 502
 503       stream_reset (s);
 504       err = zclient_read_header (s, zlookup->sock, &length, &marker, &version,
 505                                  &vrf_id, &command);
 506       if (err < 0)
 507         {
 508           zlog_err ("%s %s: zclient_read_header() failed",
 509                  __FILE__, __PRETTY_FUNCTION__);
 510         zclient_lookup_failed(zlookup);
 511         return -1;
 512         }
 513     }
 514
 515   sg.src.s_addr = stream_get_ipv4 (s);
 516   sg.grp.s_addr = stream_get_ipv4 (s);
 517   if (sg.src.s_addr != c_oil->oil.mfcc_origin.s_addr ||
 518       sg.grp.s_addr != c_oil->oil.mfcc_mcastgrp.s_addr)
 519     {
 520        zlog_err ("%s: Received wrong %s information",
 521                  __PRETTY_FUNCTION__, pim_str_sg_dump (&sg));
 522        zclient_lookup_failed (zlookup);
 523        return -3;
 524     }
 525
 526   stream_get (&lastused, s, sizeof (lastused));
 527   ret = stream_getl (s);
 528
 529   if (PIM_DEBUG_ZEBRA)
 530     zlog_debug ("Received %lld for %s success: %d", lastused, pim_str_sg_dump (&sg), ret);
 531
 532   c_oil->cc.lastused = lastused;
 533
 534   return 0;
 535
 536 }