Annotation of embedaddon/quagga/pimd/pim_pim.c, revision 1.1.1.1

1.1       misho       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:   $QuaggaId: $Format:%an, %ai, %h$ $
                     21: */
                     22: 
                     23: #include <zebra.h>
                     24: 
                     25: #include "log.h"
                     26: #include "thread.h"
                     27: #include "memory.h"
                     28: 
                     29: #include "pimd.h"
                     30: #include "pim_pim.h"
                     31: #include "pim_time.h"
                     32: #include "pim_iface.h"
                     33: #include "pim_sock.h"
                     34: #include "pim_str.h"
                     35: #include "pim_util.h"
                     36: #include "pim_tlv.h"
                     37: #include "pim_neighbor.h"
                     38: #include "pim_hello.h"
                     39: #include "pim_join.h"
                     40: #include "pim_assert.h"
                     41: #include "pim_msg.h"
                     42: 
                     43: static int on_pim_hello_send(struct thread *t);
                     44: static int pim_hello_send(struct interface *ifp,
                     45:                          uint16_t holdtime);
                     46: 
                     47: static void sock_close(struct interface *ifp)
                     48: {
                     49:   struct pim_interface *pim_ifp = ifp->info;
                     50: 
                     51:   if (PIM_DEBUG_PIM_TRACE) {
                     52:     if (pim_ifp->t_pim_sock_read) {
                     53:       zlog_debug("Cancelling READ event for PIM socket fd=%d on interface %s",
                     54:                 pim_ifp->pim_sock_fd,
                     55:                 ifp->name);
                     56:     }
                     57:   }
                     58:   THREAD_OFF(pim_ifp->t_pim_sock_read);
                     59: 
                     60:   if (PIM_DEBUG_PIM_TRACE) {
                     61:     if (pim_ifp->t_pim_hello_timer) {
                     62:       zlog_debug("Cancelling PIM hello timer for interface %s",
                     63:                 ifp->name);
                     64:     }
                     65:   }
                     66:   THREAD_OFF(pim_ifp->t_pim_hello_timer);
                     67: 
                     68:   if (PIM_DEBUG_PIM_TRACE) {
                     69:     zlog_debug("Deleting PIM socket fd=%d on interface %s",
                     70:               pim_ifp->pim_sock_fd, ifp->name);
                     71:   }
                     72: 
                     73:   if (close(pim_ifp->pim_sock_fd)) {
                     74:     zlog_warn("Failure closing PIM socket fd=%d on interface %s: errno=%d: %s",
                     75:              pim_ifp->pim_sock_fd, ifp->name,
                     76:              errno, safe_strerror(errno));
                     77:   }
                     78:   
                     79:   pim_ifp->pim_sock_fd = -1;
                     80:   pim_ifp->pim_sock_creation = 0;
                     81: 
                     82:   zassert(pim_ifp->pim_sock_fd < 0);
                     83:   zassert(!pim_ifp->t_pim_sock_read);
                     84:   zassert(!pim_ifp->t_pim_hello_timer);
                     85:   zassert(!pim_ifp->pim_sock_creation);
                     86: }
                     87: 
                     88: void pim_sock_delete(struct interface *ifp, const char *delete_message)
                     89: {
                     90:   zlog_info("PIM INTERFACE DOWN: on interface %s: %s",
                     91:            ifp->name, delete_message);
                     92: 
                     93:   if (!ifp->info) {
                     94:     zlog_err("%s: %s: but PIM not enabled on interface %s (!)",
                     95:             __PRETTY_FUNCTION__, delete_message, ifp->name);
                     96:     return;
                     97:   }
                     98: 
                     99:   /*
                    100:     RFC 4601: 4.3.1.  Sending Hello Messages
                    101:     
                    102:     Before an interface goes down or changes primary IP address, a Hello
                    103:     message with a zero HoldTime should be sent immediately (with the
                    104:     old IP address if the IP address changed).
                    105:   */
                    106:   pim_hello_send(ifp, 0 /* zero-sec holdtime */);
                    107: 
                    108:   pim_neighbor_delete_all(ifp, delete_message);
                    109: 
                    110:   sock_close(ifp);
                    111: }
                    112: 
                    113: int pim_pim_packet(struct interface *ifp, uint8_t *buf, size_t len)
                    114: {
                    115:   struct ip *ip_hdr;
                    116:   size_t ip_hlen; /* ip header length in bytes */
                    117:   char src_str[100];
                    118:   char dst_str[100];
                    119:   uint8_t *pim_msg;
                    120:   int pim_msg_len;
                    121:   uint8_t pim_version;
                    122:   uint8_t pim_type;
                    123:   uint16_t pim_checksum; /* received checksum */
                    124:   uint16_t checksum;     /* computed checksum */
                    125:   struct pim_neighbor *neigh;
                    126: 
                    127:   if (!ifp->info) {
                    128:     zlog_warn("%s: PIM not enabled on interface %s",
                    129:              __PRETTY_FUNCTION__, ifp->name);
                    130:     return -1;
                    131:   }
                    132:     
                    133:   if (len < sizeof(*ip_hdr)) {
                    134:     zlog_warn("PIM packet size=%zu shorter than minimum=%zu",
                    135:              len, sizeof(*ip_hdr));
                    136:     return -1;
                    137:   }
                    138: 
                    139:   ip_hdr = (struct ip *) buf;
                    140: 
                    141:   pim_inet4_dump("<src?>", ip_hdr->ip_src, src_str, sizeof(src_str));
                    142:   pim_inet4_dump("<dst?>", ip_hdr->ip_dst, dst_str, sizeof(dst_str));
                    143: 
                    144:   ip_hlen = ip_hdr->ip_hl << 2; /* ip_hl gives length in 4-byte words */
                    145: 
                    146:   if (PIM_DEBUG_PIM_PACKETS) {
                    147:     zlog_debug("Recv IP packet from %s to %s on %s: size=%zu ip_header_size=%zu ip_proto=%d",
                    148:               src_str, dst_str, ifp->name, len, ip_hlen, ip_hdr->ip_p);
                    149:   }
                    150: 
                    151:   if (ip_hdr->ip_p != PIM_IP_PROTO_PIM) {
                    152:     zlog_warn("IP packet protocol=%d is not PIM=%d",
                    153:              ip_hdr->ip_p, PIM_IP_PROTO_PIM);
                    154:     return -1;
                    155:   }
                    156: 
                    157:   if (ip_hlen < PIM_IP_HEADER_MIN_LEN) {
                    158:     zlog_warn("IP packet header size=%zu shorter than minimum=%d",
                    159:              ip_hlen, PIM_IP_HEADER_MIN_LEN);
                    160:     return -1;
                    161:   }
                    162:   if (ip_hlen > PIM_IP_HEADER_MAX_LEN) {
                    163:     zlog_warn("IP packet header size=%zu greater than maximum=%d",
                    164:              ip_hlen, PIM_IP_HEADER_MAX_LEN);
                    165:     return -1;
                    166:   }
                    167: 
                    168:   pim_msg = buf + ip_hlen;
                    169:   pim_msg_len = len - ip_hlen;
                    170: 
                    171:   if (PIM_DEBUG_PIM_PACKETDUMP_RECV) {
                    172:     pim_pkt_dump(__PRETTY_FUNCTION__, pim_msg, pim_msg_len);
                    173:   }
                    174: 
                    175:   if (pim_msg_len < PIM_PIM_MIN_LEN) {
                    176:     zlog_warn("PIM message size=%d shorter than minimum=%d",
                    177:              pim_msg_len, PIM_PIM_MIN_LEN);
                    178:     return -1;
                    179:   }
                    180: 
                    181:   pim_version = PIM_MSG_HDR_GET_VERSION(pim_msg);
                    182:   pim_type    = PIM_MSG_HDR_GET_TYPE(pim_msg);
                    183: 
                    184:   if (pim_version != PIM_PROTO_VERSION) {
                    185:     zlog_warn("Ignoring PIM pkt from %s with unsupported version: %d",
                    186:              ifp->name, pim_version);
                    187:     return -1;
                    188:   }
                    189: 
                    190:   /* save received checksum */
                    191:   pim_checksum = PIM_MSG_HDR_GET_CHECKSUM(pim_msg);
                    192: 
                    193:   /* for computing checksum */
                    194:   *(uint16_t *) PIM_MSG_HDR_OFFSET_CHECKSUM(pim_msg) = 0;
                    195: 
                    196:   checksum = in_cksum(pim_msg, pim_msg_len);
                    197:   if (checksum != pim_checksum) {
                    198:     zlog_warn("Ignoring PIM pkt from %s with invalid checksum: received=%x calculated=%x",
                    199:              ifp->name, pim_checksum, checksum);
                    200:     return -1;
                    201:   }
                    202: 
                    203:   if (PIM_DEBUG_PIM_PACKETS) {
                    204:     zlog_debug("Recv PIM packet from %s to %s on %s: ttl=%d pim_version=%d pim_type=%d pim_msg_size=%d checksum=%x",
                    205:               src_str, dst_str, ifp->name, ip_hdr->ip_ttl,
                    206:               pim_version, pim_type, pim_msg_len, checksum);
                    207:   }
                    208: 
                    209:   if (pim_type == PIM_MSG_TYPE_REGISTER  ||
                    210:       pim_type == PIM_MSG_TYPE_REG_STOP  ||
                    211:       pim_type == PIM_MSG_TYPE_BOOTSTRAP ||
                    212:       pim_type == PIM_MSG_TYPE_GRAFT     ||
                    213:       pim_type == PIM_MSG_TYPE_GRAFT_ACK ||
                    214:       pim_type == PIM_MSG_TYPE_CANDIDATE)
                    215:     {
                    216:       if (PIM_DEBUG_PIM_PACKETS) {
                    217:        zlog_debug("Recv PIM packet type %d which is not currently understood",
                    218:                   pim_type);
                    219:       }
                    220:       return -1;
                    221:     }
                    222: 
                    223:   if (pim_type == PIM_MSG_TYPE_HELLO) {
                    224:     int result = pim_hello_recv(ifp,
                    225:                  ip_hdr->ip_src,
                    226:                  pim_msg + PIM_MSG_HEADER_LEN,
                    227:                  pim_msg_len - PIM_MSG_HEADER_LEN);
                    228:     return result;
                    229:   }
                    230: 
                    231:   neigh = pim_neighbor_find(ifp, ip_hdr->ip_src);
                    232:   if (!neigh) {
                    233:     zlog_warn("%s %s: non-hello PIM message type=%d from non-neighbor %s on %s",
                    234:              __FILE__, __PRETTY_FUNCTION__,
                    235:              pim_type, src_str, ifp->name);
                    236:     return -1;
                    237:   }
                    238: 
                    239:   switch (pim_type) {
                    240:   case PIM_MSG_TYPE_JOIN_PRUNE:
                    241:     return pim_joinprune_recv(ifp, neigh,
                    242:                              ip_hdr->ip_src,
                    243:                              pim_msg + PIM_MSG_HEADER_LEN,
                    244:                              pim_msg_len - PIM_MSG_HEADER_LEN);
                    245:   case PIM_MSG_TYPE_ASSERT:
                    246:     return pim_assert_recv(ifp, neigh,
                    247:                           ip_hdr->ip_src,
                    248:                           pim_msg + PIM_MSG_HEADER_LEN,
                    249:                           pim_msg_len - PIM_MSG_HEADER_LEN);
                    250:   default:
                    251:     zlog_warn("%s %s: unsupported PIM message type=%d from %s on %s",
                    252:              __FILE__, __PRETTY_FUNCTION__,
                    253:              pim_type, src_str, ifp->name);
                    254:   }
                    255: 
                    256:   return -1;
                    257: }
                    258: 
                    259: static void pim_sock_read_on(struct interface *ifp);
                    260: 
                    261: static int pim_sock_read(struct thread *t)
                    262: {
                    263:   struct interface *ifp;
                    264:   struct pim_interface *pim_ifp;
                    265:   int fd;
                    266:   struct sockaddr_in from;
                    267:   struct sockaddr_in to;
                    268:   socklen_t fromlen = sizeof(from);
                    269:   socklen_t tolen = sizeof(to);
                    270:   uint8_t buf[PIM_PIM_BUFSIZE_READ];
                    271:   int len;
                    272:   ifindex_t ifindex = -1;
                    273:   int result = -1; /* defaults to bad */
                    274: 
                    275:   zassert(t);
                    276: 
                    277:   ifp = THREAD_ARG(t);
                    278:   zassert(ifp);
                    279: 
                    280:   fd = THREAD_FD(t);
                    281: 
                    282:   pim_ifp = ifp->info;
                    283:   zassert(pim_ifp);
                    284: 
                    285:   zassert(fd == pim_ifp->pim_sock_fd);
                    286: 
                    287:   len = pim_socket_recvfromto(fd, buf, sizeof(buf),
                    288:                              &from, &fromlen,
                    289:                              &to, &tolen,
                    290:                              &ifindex);
                    291:   if (len < 0) {
                    292:     zlog_warn("Failure receiving IP PIM packet on fd=%d: errno=%d: %s",
                    293:              fd, errno, safe_strerror(errno));
                    294:     goto done;
                    295:   }
                    296: 
                    297:   if (PIM_DEBUG_PIM_PACKETS) {
                    298:     char from_str[100];
                    299:     char to_str[100];
                    300:     
                    301:     if (!inet_ntop(AF_INET, &from.sin_addr, from_str, sizeof(from_str)))
                    302:       sprintf(from_str, "<from?>");
                    303:     if (!inet_ntop(AF_INET, &to.sin_addr, to_str, sizeof(to_str)))
                    304:       sprintf(to_str, "<to?>");
                    305:     
                    306:     zlog_debug("Recv IP PIM pkt size=%d from %s to %s on fd=%d on ifindex=%d (sock_ifindex=%d)",
                    307:               len, from_str, to_str, fd, ifindex, ifp->ifindex);
                    308:   }
                    309: 
                    310:   if (PIM_DEBUG_PIM_PACKETDUMP_RECV) {
                    311:     pim_pkt_dump(__PRETTY_FUNCTION__, buf, len);
                    312:   }
                    313: 
                    314: #ifdef PIM_CHECK_RECV_IFINDEX_SANITY
                    315:   /* ifindex sanity check */
                    316:   if (ifindex != (int) ifp->ifindex) {
                    317:     char from_str[100];
                    318:     char to_str[100];
                    319:     struct interface *recv_ifp;
                    320: 
                    321:     if (!inet_ntop(AF_INET, &from.sin_addr, from_str , sizeof(from_str)))
                    322:       sprintf(from_str, "<from?>");
                    323:     if (!inet_ntop(AF_INET, &to.sin_addr, to_str , sizeof(to_str)))
                    324:       sprintf(to_str, "<to?>");
                    325: 
                    326:     recv_ifp = if_lookup_by_index(ifindex);
                    327:     if (recv_ifp) {
                    328:       zassert(ifindex == (int) recv_ifp->ifindex);
                    329:     }
                    330: 
                    331: #ifdef PIM_REPORT_RECV_IFINDEX_MISMATCH
                    332:     zlog_warn("Interface mismatch: recv PIM pkt from %s to %s on fd=%d: recv_ifindex=%d (%s) sock_ifindex=%d (%s)",
                    333:              from_str, to_str, fd,
                    334:              ifindex, recv_ifp ? recv_ifp->name : "<if-notfound>",
                    335:              ifp->ifindex, ifp->name);
                    336: #endif
                    337:     goto done;
                    338:   }
                    339: #endif
                    340: 
                    341:   int fail = pim_pim_packet(ifp, buf, len);
                    342:   if (fail) {
                    343:     zlog_warn("%s: pim_pim_packet() return=%d",
                    344:               __PRETTY_FUNCTION__, fail);
                    345:     goto done;
                    346:   }
                    347: 
                    348:   result = 0; /* good */
                    349: 
                    350:  done:
                    351:   pim_sock_read_on(ifp);
                    352: 
                    353:   if (result) {
                    354:     ++pim_ifp->pim_ifstat_hello_recvfail;
                    355:   }
                    356: 
                    357:   return result;
                    358: }
                    359: 
                    360: static void pim_sock_read_on(struct interface *ifp)
                    361: {
                    362:   struct pim_interface *pim_ifp;
                    363: 
                    364:   zassert(ifp);
                    365:   zassert(ifp->info);
                    366: 
                    367:   pim_ifp = ifp->info;
                    368: 
                    369:   if (PIM_DEBUG_PIM_TRACE) {
                    370:     zlog_debug("Scheduling READ event on PIM socket fd=%d",
                    371:               pim_ifp->pim_sock_fd);
                    372:   }
                    373:   pim_ifp->t_pim_sock_read = 0;
                    374:   zassert(!pim_ifp->t_pim_sock_read);
                    375:   THREAD_READ_ON(master, pim_ifp->t_pim_sock_read, pim_sock_read, ifp,
                    376:                 pim_ifp->pim_sock_fd);
                    377: }
                    378: 
                    379: static int pim_sock_open(struct in_addr ifaddr, ifindex_t ifindex)
                    380: {
                    381:   int fd;
                    382: 
                    383:   fd = pim_socket_mcast(IPPROTO_PIM, ifaddr, 0 /* loop=false */);
                    384:   if (fd < 0)
                    385:     return -1;
                    386: 
                    387:   if (pim_socket_join(fd, qpim_all_pim_routers_addr, ifaddr, ifindex)) {
                    388:     close(fd);
                    389:     return -2;
                    390:   }
                    391: 
                    392:   return fd;
                    393: }
                    394: 
                    395: void pim_ifstat_reset(struct interface *ifp)
                    396: {
                    397:   struct pim_interface *pim_ifp;
                    398: 
                    399:   zassert(ifp);
                    400: 
                    401:   pim_ifp = ifp->info;
                    402:   if (!pim_ifp) {
                    403:     return;
                    404:   }
                    405: 
                    406:   pim_ifp->pim_ifstat_start          = pim_time_monotonic_sec();
                    407:   pim_ifp->pim_ifstat_hello_sent     = 0;
                    408:   pim_ifp->pim_ifstat_hello_sendfail = 0;
                    409:   pim_ifp->pim_ifstat_hello_recv     = 0;
                    410:   pim_ifp->pim_ifstat_hello_recvfail = 0;
                    411: }
                    412: 
                    413: void pim_sock_reset(struct interface *ifp)
                    414: {
                    415:   struct pim_interface *pim_ifp;
                    416: 
                    417:   zassert(ifp);
                    418:   zassert(ifp->info);
                    419: 
                    420:   pim_ifp = ifp->info;
                    421: 
                    422:   pim_ifp->primary_address = pim_find_primary_addr(ifp);
                    423: 
                    424:   pim_ifp->pim_sock_fd       = -1;
                    425:   pim_ifp->pim_sock_creation = 0;
                    426:   pim_ifp->t_pim_sock_read   = 0;
                    427: 
                    428:   pim_ifp->t_pim_hello_timer          = 0;
                    429:   pim_ifp->pim_hello_period           = PIM_DEFAULT_HELLO_PERIOD;
                    430:   pim_ifp->pim_default_holdtime       = -1; /* unset: means 3.5 * pim_hello_period */
                    431:   pim_ifp->pim_triggered_hello_delay  = PIM_DEFAULT_TRIGGERED_HELLO_DELAY;
                    432:   pim_ifp->pim_dr_priority            = PIM_DEFAULT_DR_PRIORITY;
                    433:   pim_ifp->pim_propagation_delay_msec = PIM_DEFAULT_PROPAGATION_DELAY_MSEC;
                    434:   pim_ifp->pim_override_interval_msec = PIM_DEFAULT_OVERRIDE_INTERVAL_MSEC;
                    435:   if (PIM_DEFAULT_CAN_DISABLE_JOIN_SUPPRESSION) {
                    436:     PIM_IF_DO_PIM_CAN_DISABLE_JOIN_SUPRESSION(pim_ifp->options);
                    437:   }
                    438:   else {
                    439:     PIM_IF_DONT_PIM_CAN_DISABLE_JOIN_SUPRESSION(pim_ifp->options);
                    440:   }
                    441: 
                    442:   /* neighbors without lan_delay */
                    443:   pim_ifp->pim_number_of_nonlandelay_neighbors = 0;
                    444:   pim_ifp->pim_neighbors_highest_propagation_delay_msec = 0;
                    445:   pim_ifp->pim_neighbors_highest_override_interval_msec = 0;
                    446: 
                    447:   /* DR Election */
                    448:   pim_ifp->pim_dr_election_last          = 0; /* timestamp */
                    449:   pim_ifp->pim_dr_election_count         = 0;
                    450:   pim_ifp->pim_dr_election_changes       = 0;
                    451:   pim_ifp->pim_dr_num_nondrpri_neighbors = 0; /* neighbors without dr_pri */
                    452:   pim_ifp->pim_dr_addr                   = pim_ifp->primary_address;
                    453: 
                    454:   pim_ifstat_reset(ifp);
                    455: }
                    456: 
                    457: int pim_msg_send(int fd,
                    458:                 struct in_addr dst,
                    459:                 uint8_t *pim_msg,
                    460:                 int pim_msg_size,
                    461:                 const char *ifname)
                    462: {
                    463:   ssize_t            sent;
                    464:   struct sockaddr_in to;
                    465:   socklen_t          tolen;
                    466: 
                    467:   if (PIM_DEBUG_PIM_PACKETS) {
                    468:     char dst_str[100];
                    469:     pim_inet4_dump("<dst?>", dst, dst_str, sizeof(dst_str));
                    470:     zlog_debug("%s: to %s on %s: msg_size=%d checksum=%x",
                    471:               __PRETTY_FUNCTION__,
                    472:               dst_str, ifname, pim_msg_size,
                    473:               *(uint16_t *) PIM_MSG_HDR_OFFSET_CHECKSUM(pim_msg));
                    474:   }
                    475: 
                    476: #if 0
                    477:   memset(&to, 0, sizeof(to));
                    478: #endif
                    479:   to.sin_family = AF_INET;
                    480:   to.sin_addr = dst;
                    481: #if 0
                    482:   to.sin_port = htons(0);
                    483: #endif
                    484:   tolen = sizeof(to);
                    485: 
                    486:   if (PIM_DEBUG_PIM_PACKETDUMP_SEND) {
                    487:     pim_pkt_dump(__PRETTY_FUNCTION__, pim_msg, pim_msg_size);
                    488:   }
                    489: 
                    490:   sent = sendto(fd, pim_msg, pim_msg_size, MSG_DONTWAIT,
                    491:                 (struct sockaddr *)&to, tolen);
                    492:   if (sent != (ssize_t) pim_msg_size) {
                    493:     int e = errno;
                    494:     char dst_str[100];
                    495:     pim_inet4_dump("<dst?>", dst, dst_str, sizeof(dst_str));
                    496:     if (sent < 0) {
                    497:       zlog_warn("%s: sendto() failure to %s on %s: fd=%d msg_size=%d: errno=%d: %s",
                    498:                __PRETTY_FUNCTION__,
                    499:                dst_str, ifname, fd, pim_msg_size,
                    500:                e, safe_strerror(e));
                    501:     }
                    502:     else {
                    503:       zlog_warn("%s: sendto() partial to %s on %s: fd=%d msg_size=%d: sent=%zd",
                    504:                __PRETTY_FUNCTION__,
                    505:                dst_str, ifname, fd,
                    506:                pim_msg_size, sent);
                    507:     }
                    508:     return -1;
                    509:   }
                    510: 
                    511:   return 0;
                    512: }
                    513: 
                    514: static int hello_send(struct interface *ifp,
                    515:                      uint16_t holdtime)
                    516: {
                    517:   uint8_t pim_msg[PIM_PIM_BUFSIZE_WRITE];
                    518:   struct pim_interface *pim_ifp;
                    519:   int pim_tlv_size;
                    520:   int pim_msg_size;
                    521: 
                    522:   pim_ifp = ifp->info;
                    523: 
                    524:   if (PIM_DEBUG_PIM_HELLO) {
                    525:     char dst_str[100];
                    526:     pim_inet4_dump("<dst?>", qpim_all_pim_routers_addr, dst_str, sizeof(dst_str));
                    527:     zlog_debug("%s: to %s on %s: holdt=%u prop_d=%u overr_i=%u dis_join_supp=%d dr_prio=%u gen_id=%08x addrs=%d",
                    528:               __PRETTY_FUNCTION__,
                    529:               dst_str, ifp->name,
                    530:               holdtime,
                    531:               pim_ifp->pim_propagation_delay_msec, pim_ifp->pim_override_interval_msec,
                    532:               PIM_IF_TEST_PIM_CAN_DISABLE_JOIN_SUPRESSION(pim_ifp->options),
                    533:               pim_ifp->pim_dr_priority, pim_ifp->pim_generation_id,
                    534:               listcount(ifp->connected));
                    535:   }
                    536: 
                    537:   pim_tlv_size = pim_hello_build_tlv(ifp->name,
                    538:                                     pim_msg + PIM_PIM_MIN_LEN,
                    539:                                     sizeof(pim_msg) - PIM_PIM_MIN_LEN,
                    540:                                     holdtime,
                    541:                                     pim_ifp->pim_dr_priority,
                    542:                                     pim_ifp->pim_generation_id,
                    543:                                     pim_ifp->pim_propagation_delay_msec,
                    544:                                     pim_ifp->pim_override_interval_msec,
                    545:                                     PIM_IF_TEST_PIM_CAN_DISABLE_JOIN_SUPRESSION(pim_ifp->options),
                    546:                                     ifp->connected);
                    547:   if (pim_tlv_size < 0) {
                    548:     return -1;
                    549:   }
                    550: 
                    551:   pim_msg_size = pim_tlv_size + PIM_PIM_MIN_LEN;
                    552: 
                    553:   zassert(pim_msg_size >= PIM_PIM_MIN_LEN);
                    554:   zassert(pim_msg_size <= PIM_PIM_BUFSIZE_WRITE);
                    555: 
                    556:   pim_msg_build_header(pim_msg, pim_msg_size,
                    557:                       PIM_MSG_TYPE_HELLO);
                    558: 
                    559:   if (pim_msg_send(pim_ifp->pim_sock_fd,
                    560:                   qpim_all_pim_routers_addr,
                    561:                   pim_msg,
                    562:                   pim_msg_size,
                    563:                   ifp->name)) {
                    564:     if (PIM_DEBUG_PIM_HELLO) {
                    565:       zlog_debug("%s: could not send PIM message on interface %s",
                    566:                 __PRETTY_FUNCTION__, ifp->name);
                    567:     }
                    568:     return -2;
                    569:   }
                    570: 
                    571:   return 0;
                    572: }
                    573: 
                    574: static int pim_hello_send(struct interface *ifp,
                    575:                          uint16_t holdtime)
                    576: {
                    577:   struct pim_interface *pim_ifp;
                    578: 
                    579:   zassert(ifp);
                    580:   pim_ifp = ifp->info;
                    581:   zassert(pim_ifp);
                    582: 
                    583:   if (hello_send(ifp, holdtime)) {
                    584:     ++pim_ifp->pim_ifstat_hello_sendfail;
                    585: 
                    586:     if (PIM_DEBUG_PIM_HELLO) {
                    587:       zlog_warn("Could not send PIM hello on interface %s",
                    588:                ifp->name);
                    589:     }
                    590:     return -1;
                    591:   }
                    592: 
                    593:   ++pim_ifp->pim_ifstat_hello_sent;
                    594: 
                    595:   return 0;
                    596: }
                    597: 
                    598: static void hello_resched(struct interface *ifp)
                    599: {
                    600:   struct pim_interface *pim_ifp;
                    601: 
                    602:   zassert(ifp);
                    603:   pim_ifp = ifp->info;
                    604:   zassert(pim_ifp);
                    605: 
                    606:   if (PIM_DEBUG_PIM_HELLO) {
                    607:     zlog_debug("Rescheduling %d sec hello on interface %s",
                    608:               pim_ifp->pim_hello_period, ifp->name);
                    609:   }
                    610:   THREAD_OFF(pim_ifp->t_pim_hello_timer);
                    611:   THREAD_TIMER_ON(master, pim_ifp->t_pim_hello_timer,
                    612:                  on_pim_hello_send,
                    613:                  ifp, pim_ifp->pim_hello_period);
                    614: }
                    615: 
                    616: /*
                    617:   Periodic hello timer
                    618:  */
                    619: static int on_pim_hello_send(struct thread *t)
                    620: {
                    621:   struct pim_interface *pim_ifp;
                    622:   struct interface *ifp;
                    623: 
                    624:   zassert(t);
                    625:   ifp = THREAD_ARG(t);
                    626:   zassert(ifp);
                    627: 
                    628:   pim_ifp = ifp->info;
                    629: 
                    630:   /*
                    631:    * Schedule next hello
                    632:    */
                    633:   pim_ifp->t_pim_hello_timer = 0;
                    634:   hello_resched(ifp);
                    635: 
                    636:   /*
                    637:    * Send hello
                    638:    */
                    639:   return pim_hello_send(ifp, PIM_IF_DEFAULT_HOLDTIME(pim_ifp));
                    640: }
                    641: 
                    642: /*
                    643:   RFC 4601: 4.3.1.  Sending Hello Messages
                    644: 
                    645:   Thus, if a router needs to send a Join/Prune or Assert message on an
                    646:   interface on which it has not yet sent a Hello message with the
                    647:   currently configured IP address, then it MUST immediately send the
                    648:   relevant Hello message without waiting for the Hello Timer to
                    649:   expire, followed by the Join/Prune or Assert message.
                    650:  */
                    651: void pim_hello_restart_now(struct interface *ifp)
                    652: {
                    653:   struct pim_interface *pim_ifp;
                    654: 
                    655:   zassert(ifp);
                    656:   pim_ifp = ifp->info;
                    657:   zassert(pim_ifp);
                    658: 
                    659:   /*
                    660:    * Reset next hello timer
                    661:    */
                    662:   hello_resched(ifp);
                    663: 
                    664:   /*
                    665:    * Immediately send hello
                    666:    */
                    667:   pim_hello_send(ifp, PIM_IF_DEFAULT_HOLDTIME(pim_ifp));
                    668: }
                    669: 
                    670: /*
                    671:   RFC 4601: 4.3.1.  Sending Hello Messages
                    672: 
                    673:   To allow new or rebooting routers to learn of PIM neighbors quickly,
                    674:   when a Hello message is received from a new neighbor, or a Hello
                    675:   message with a new GenID is received from an existing neighbor, a
                    676:   new Hello message should be sent on this interface after a
                    677:   randomized delay between 0 and Triggered_Hello_Delay.
                    678:  */
                    679: void pim_hello_restart_triggered(struct interface *ifp)
                    680: {
                    681:   struct pim_interface *pim_ifp;
                    682:   int triggered_hello_delay_msec;
                    683:   int random_msec;
                    684: 
                    685:   zassert(ifp);
                    686:   pim_ifp = ifp->info;
                    687:   zassert(pim_ifp);
                    688: 
                    689:   triggered_hello_delay_msec = 1000 * pim_ifp->pim_triggered_hello_delay;
                    690: 
                    691:   if (pim_ifp->t_pim_hello_timer) {
                    692:     long remain_msec = pim_time_timer_remain_msec(pim_ifp->t_pim_hello_timer);
                    693:     if (remain_msec <= triggered_hello_delay_msec) {
                    694:       /* Rescheduling hello would increase the delay, then it's faster
                    695:         to just wait for the scheduled periodic hello. */
                    696:       return;
                    697:     }
                    698: 
                    699:     THREAD_OFF(pim_ifp->t_pim_hello_timer);
                    700:     pim_ifp->t_pim_hello_timer = 0;
                    701:   }
                    702:   zassert(!pim_ifp->t_pim_hello_timer);
                    703: 
                    704:   random_msec = random() % (triggered_hello_delay_msec + 1);
                    705: 
                    706:   if (PIM_DEBUG_PIM_HELLO) {
                    707:     zlog_debug("Scheduling %d msec triggered hello on interface %s",
                    708:               random_msec, ifp->name);
                    709:   }
                    710: 
                    711:   THREAD_TIMER_MSEC_ON(master, pim_ifp->t_pim_hello_timer,
                    712:                       on_pim_hello_send,
                    713:                       ifp, random_msec);
                    714: }
                    715: 
                    716: int pim_sock_add(struct interface *ifp)
                    717: {
                    718:   struct pim_interface *pim_ifp;
                    719:   struct in_addr ifaddr;
                    720:   uint32_t old_genid;
                    721: 
                    722:   pim_ifp = ifp->info;
                    723:   zassert(pim_ifp);
                    724: 
                    725:   if (pim_ifp->pim_sock_fd >= 0) {
                    726:     zlog_warn("Can't recreate existing PIM socket fd=%d for interface %s",
                    727:              pim_ifp->pim_sock_fd, ifp->name);
                    728:     return -1;
                    729:   }
                    730: 
                    731:   ifaddr = pim_ifp->primary_address;
                    732: 
                    733:   pim_ifp->pim_sock_fd = pim_sock_open(ifaddr, ifp->ifindex);
                    734:   if (pim_ifp->pim_sock_fd < 0) {
                    735:     zlog_warn("Could not open PIM socket on interface %s",
                    736:              ifp->name);
                    737:     return -2;
                    738:   }
                    739: 
                    740:   pim_ifp->t_pim_sock_read   = 0;
                    741:   pim_ifp->pim_sock_creation = pim_time_monotonic_sec();
                    742: 
                    743:   /*
                    744:    * Just ensure that the new generation id
                    745:    * actually chooses something different.
                    746:    * Actually ran across a case where this
                    747:    * happened, pre-switch to random().
                    748:    * While this is unlikely to happen now
                    749:    * let's make sure it doesn't.
                    750:    */
                    751:   old_genid = pim_ifp->pim_generation_id;
                    752: 
                    753:   while (old_genid == pim_ifp->pim_generation_id)
                    754:     pim_ifp->pim_generation_id = random();
                    755: 
                    756:   zlog_info("PIM INTERFACE UP: on interface %s ifindex=%d",
                    757:            ifp->name, ifp->ifindex);
                    758: 
                    759:   /*
                    760:    * Start receiving PIM messages
                    761:    */
                    762:   pim_sock_read_on(ifp);
                    763: 
                    764:   /*
                    765:    * Start sending PIM hello's
                    766:    */
                    767:   pim_hello_restart_triggered(ifp);
                    768: 
                    769:   return 0;
                    770: }

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>