1453 lines
38 KiB
C
1453 lines
38 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* pim_bsm.c: PIM BSM handling routines
|
|
*
|
|
* Copyright (C) 2018-19 Vmware, Inc.
|
|
* Saravanan K
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include "if.h"
|
|
#include "pimd.h"
|
|
#include "pim_iface.h"
|
|
#include "pim_instance.h"
|
|
#include "pim_neighbor.h"
|
|
#include "pim_rpf.h"
|
|
#include "pim_hello.h"
|
|
#include "pim_pim.h"
|
|
#include "pim_nht.h"
|
|
#include "pim_bsm.h"
|
|
#include "pim_time.h"
|
|
#include "pim_zebra.h"
|
|
#include "pim_util.h"
|
|
|
|
/* Functions forward declaration */
|
|
static void pim_bs_timer_start(struct bsm_scope *scope, int bs_timeout);
|
|
static void pim_g2rp_timer_start(struct bsm_rpinfo *bsrp, int hold_time);
|
|
static inline void pim_g2rp_timer_restart(struct bsm_rpinfo *bsrp,
|
|
int hold_time);
|
|
|
|
/* Memory Types */
|
|
DEFINE_MTYPE_STATIC(PIMD, PIM_BSGRP_NODE, "PIM BSR advertised grp info");
|
|
DEFINE_MTYPE_STATIC(PIMD, PIM_BSRP_INFO, "PIM BSR advertised RP info");
|
|
DEFINE_MTYPE_STATIC(PIMD, PIM_BSM_FRAG, "PIM BSM fragment");
|
|
DEFINE_MTYPE_STATIC(PIMD, PIM_BSM_PKT_VAR_MEM, "PIM BSM Packet");
|
|
|
|
/* All bsm packets forwarded shall be fit within ip mtu less iphdr(max) */
|
|
#define MAX_IP_HDR_LEN 24
|
|
|
|
/* pim_bsm_write_config - Write the interface pim bsm configuration.*/
|
|
void pim_bsm_write_config(struct vty *vty, struct interface *ifp)
|
|
{
|
|
struct pim_interface *pim_ifp = ifp->info;
|
|
|
|
if (pim_ifp) {
|
|
if (!pim_ifp->bsm_enable)
|
|
vty_out(vty, " no " PIM_AF_NAME " pim bsm\n");
|
|
if (!pim_ifp->ucast_bsm_accept)
|
|
vty_out(vty, " no " PIM_AF_NAME " pim unicast-bsm\n");
|
|
}
|
|
}
|
|
|
|
static void pim_bsm_rpinfo_free(struct bsm_rpinfo *bsrp_info)
|
|
{
|
|
EVENT_OFF(bsrp_info->g2rp_timer);
|
|
XFREE(MTYPE_PIM_BSRP_INFO, bsrp_info);
|
|
}
|
|
|
|
static void pim_bsm_rpinfos_free(struct bsm_rpinfos_head *head)
|
|
{
|
|
struct bsm_rpinfo *bsrp_info;
|
|
|
|
while ((bsrp_info = bsm_rpinfos_pop(head)))
|
|
pim_bsm_rpinfo_free(bsrp_info);
|
|
}
|
|
|
|
static void pim_free_bsgrp_data(struct bsgrp_node *bsgrp_node)
|
|
{
|
|
pim_bsm_rpinfos_free(bsgrp_node->bsrp_list);
|
|
pim_bsm_rpinfos_free(bsgrp_node->partial_bsrp_list);
|
|
XFREE(MTYPE_PIM_BSGRP_NODE, bsgrp_node);
|
|
}
|
|
|
|
static void pim_free_bsgrp_node(struct route_table *rt, struct prefix *grp)
|
|
{
|
|
struct route_node *rn;
|
|
|
|
rn = route_node_lookup(rt, grp);
|
|
if (rn) {
|
|
rn->info = NULL;
|
|
route_unlock_node(rn);
|
|
route_unlock_node(rn);
|
|
}
|
|
}
|
|
|
|
static void pim_bsm_frag_free(struct bsm_frag *bsfrag)
|
|
{
|
|
XFREE(MTYPE_PIM_BSM_FRAG, bsfrag);
|
|
}
|
|
|
|
static void pim_bsm_frags_free(struct bsm_scope *scope)
|
|
{
|
|
struct bsm_frag *bsfrag;
|
|
|
|
while ((bsfrag = bsm_frags_pop(scope->bsm_frags)))
|
|
pim_bsm_frag_free(bsfrag);
|
|
}
|
|
|
|
int pim_bsm_rpinfo_cmp(const struct bsm_rpinfo *node1,
|
|
const struct bsm_rpinfo *node2)
|
|
{
|
|
/* RP election Algo :
|
|
* Step-1 : Loweset Rp priority will have higher precedance.
|
|
* Step-2 : If priority same then higher hash val will have
|
|
* higher precedance.
|
|
* Step-3 : If Hash val is same then highest rp address will
|
|
* become elected RP.
|
|
*/
|
|
if (node1->rp_prio < node2->rp_prio)
|
|
return -1;
|
|
if (node1->rp_prio > node2->rp_prio)
|
|
return 1;
|
|
if (node1->hash < node2->hash)
|
|
return 1;
|
|
if (node1->hash > node2->hash)
|
|
return -1;
|
|
return pim_addr_cmp(node2->rp_address, node1->rp_address);
|
|
}
|
|
|
|
static struct bsgrp_node *pim_bsm_new_bsgrp_node(struct route_table *rt,
|
|
struct prefix *grp)
|
|
{
|
|
struct route_node *rn;
|
|
struct bsgrp_node *bsgrp;
|
|
|
|
rn = route_node_get(rt, grp);
|
|
if (!rn) {
|
|
zlog_warn("%s: route node creation failed", __func__);
|
|
return NULL;
|
|
}
|
|
bsgrp = XCALLOC(MTYPE_PIM_BSGRP_NODE, sizeof(struct bsgrp_node));
|
|
|
|
rn->info = bsgrp;
|
|
bsm_rpinfos_init(bsgrp->bsrp_list);
|
|
bsm_rpinfos_init(bsgrp->partial_bsrp_list);
|
|
|
|
prefix_copy(&bsgrp->group, grp);
|
|
return bsgrp;
|
|
}
|
|
|
|
static void pim_on_bs_timer(struct event *t)
|
|
{
|
|
struct route_node *rn;
|
|
struct bsm_scope *scope;
|
|
struct bsgrp_node *bsgrp_node;
|
|
struct bsm_rpinfo *bsrp;
|
|
|
|
scope = EVENT_ARG(t);
|
|
EVENT_OFF(scope->bs_timer);
|
|
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: Bootstrap Timer expired for scope: %d",
|
|
__func__, scope->sz_id);
|
|
|
|
pim_nht_bsr_del(scope->pim, scope->current_bsr);
|
|
/* Reset scope zone data */
|
|
scope->state = ACCEPT_ANY;
|
|
scope->current_bsr = PIMADDR_ANY;
|
|
scope->current_bsr_prio = 0;
|
|
scope->current_bsr_first_ts = 0;
|
|
scope->current_bsr_last_ts = 0;
|
|
scope->bsm_frag_tag = 0;
|
|
pim_bsm_frags_free(scope);
|
|
|
|
for (rn = route_top(scope->bsrp_table); rn; rn = route_next(rn)) {
|
|
|
|
bsgrp_node = (struct bsgrp_node *)rn->info;
|
|
if (!bsgrp_node) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: bsgrp_node is null", __func__);
|
|
continue;
|
|
}
|
|
/* Give grace time for rp to continue for another hold time */
|
|
bsrp = bsm_rpinfos_first(bsgrp_node->bsrp_list);
|
|
if (bsrp)
|
|
pim_g2rp_timer_restart(bsrp, bsrp->rp_holdtime);
|
|
|
|
/* clear pending list */
|
|
pim_bsm_rpinfos_free(bsgrp_node->partial_bsrp_list);
|
|
bsgrp_node->pend_rp_cnt = 0;
|
|
}
|
|
}
|
|
|
|
static void pim_bs_timer_stop(struct bsm_scope *scope)
|
|
{
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s : BS timer being stopped of sz: %d", __func__,
|
|
scope->sz_id);
|
|
EVENT_OFF(scope->bs_timer);
|
|
}
|
|
|
|
static void pim_bs_timer_start(struct bsm_scope *scope, int bs_timeout)
|
|
{
|
|
if (!scope) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s : Invalid scope(NULL).", __func__);
|
|
return;
|
|
}
|
|
EVENT_OFF(scope->bs_timer);
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s : starting bs timer for scope %d with timeout %d secs",
|
|
__func__, scope->sz_id, bs_timeout);
|
|
event_add_timer(router->master, pim_on_bs_timer, scope, bs_timeout,
|
|
&scope->bs_timer);
|
|
}
|
|
|
|
static inline void pim_bs_timer_restart(struct bsm_scope *scope, int bs_timeout)
|
|
{
|
|
pim_bs_timer_start(scope, bs_timeout);
|
|
}
|
|
|
|
void pim_bsm_proc_init(struct pim_instance *pim)
|
|
{
|
|
memset(&pim->global_scope, 0, sizeof(struct bsm_scope));
|
|
|
|
pim->global_scope.sz_id = PIM_GBL_SZ_ID;
|
|
pim->global_scope.bsrp_table = route_table_init();
|
|
pim->global_scope.accept_nofwd_bsm = true;
|
|
pim->global_scope.state = NO_INFO;
|
|
pim->global_scope.pim = pim;
|
|
bsm_frags_init(pim->global_scope.bsm_frags);
|
|
pim_bs_timer_start(&pim->global_scope, PIM_BS_TIME);
|
|
}
|
|
|
|
void pim_bsm_proc_free(struct pim_instance *pim)
|
|
{
|
|
struct route_node *rn;
|
|
struct bsgrp_node *bsgrp;
|
|
|
|
pim_bs_timer_stop(&pim->global_scope);
|
|
pim_bsm_frags_free(&pim->global_scope);
|
|
|
|
for (rn = route_top(pim->global_scope.bsrp_table); rn;
|
|
rn = route_next(rn)) {
|
|
bsgrp = rn->info;
|
|
if (!bsgrp)
|
|
continue;
|
|
pim_free_bsgrp_data(bsgrp);
|
|
}
|
|
|
|
route_table_finish(pim->global_scope.bsrp_table);
|
|
}
|
|
|
|
static bool is_hold_time_elapsed(void *data)
|
|
{
|
|
struct bsm_rpinfo *bsrp;
|
|
|
|
bsrp = data;
|
|
|
|
if (bsrp->elapse_time < bsrp->rp_holdtime)
|
|
return false;
|
|
else
|
|
return true;
|
|
}
|
|
|
|
static void pim_on_g2rp_timer(struct event *t)
|
|
{
|
|
struct bsm_rpinfo *bsrp;
|
|
struct bsm_rpinfo *bsrp_node;
|
|
struct bsgrp_node *bsgrp_node;
|
|
struct pim_instance *pim;
|
|
struct rp_info *rp_info;
|
|
struct route_node *rn;
|
|
uint16_t elapse;
|
|
pim_addr bsrp_addr;
|
|
|
|
bsrp = EVENT_ARG(t);
|
|
EVENT_OFF(bsrp->g2rp_timer);
|
|
bsgrp_node = bsrp->bsgrp_node;
|
|
|
|
/* elapse time is the hold time of expired node */
|
|
elapse = bsrp->rp_holdtime;
|
|
bsrp_addr = bsrp->rp_address;
|
|
|
|
/* update elapse for all bsrp nodes */
|
|
frr_each_safe (bsm_rpinfos, bsgrp_node->bsrp_list, bsrp_node) {
|
|
bsrp_node->elapse_time += elapse;
|
|
|
|
if (is_hold_time_elapsed(bsrp_node)) {
|
|
bsm_rpinfos_del(bsgrp_node->bsrp_list, bsrp_node);
|
|
pim_bsm_rpinfo_free(bsrp_node);
|
|
}
|
|
}
|
|
|
|
/* Get the next elected rp node */
|
|
bsrp = bsm_rpinfos_first(bsgrp_node->bsrp_list);
|
|
pim = bsgrp_node->scope->pim;
|
|
rn = route_node_lookup(pim->rp_table, &bsgrp_node->group);
|
|
|
|
if (!rn) {
|
|
zlog_warn("%s: Route node doesn't exist", __func__);
|
|
return;
|
|
}
|
|
|
|
rp_info = (struct rp_info *)rn->info;
|
|
|
|
if (!rp_info) {
|
|
route_unlock_node(rn);
|
|
return;
|
|
}
|
|
|
|
if (rp_info->rp_src != RP_SRC_STATIC) {
|
|
/* If new rp available, change it else delete the existing */
|
|
if (bsrp) {
|
|
pim_g2rp_timer_start(
|
|
bsrp, (bsrp->rp_holdtime - bsrp->elapse_time));
|
|
pim_rp_change(pim, bsrp->rp_address, bsgrp_node->group,
|
|
RP_SRC_BSR);
|
|
} else {
|
|
pim_rp_del(pim, bsrp_addr, bsgrp_node->group, NULL,
|
|
RP_SRC_BSR);
|
|
}
|
|
}
|
|
|
|
if (!bsm_rpinfos_count(bsgrp_node->bsrp_list)
|
|
&& !bsm_rpinfos_count(bsgrp_node->partial_bsrp_list)) {
|
|
pim_free_bsgrp_node(pim->global_scope.bsrp_table,
|
|
&bsgrp_node->group);
|
|
pim_free_bsgrp_data(bsgrp_node);
|
|
}
|
|
}
|
|
|
|
static void pim_g2rp_timer_start(struct bsm_rpinfo *bsrp, int hold_time)
|
|
{
|
|
if (!bsrp) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s : Invalid brsp(NULL).", __func__);
|
|
return;
|
|
}
|
|
EVENT_OFF(bsrp->g2rp_timer);
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s : starting g2rp timer for grp: %pFX - rp: %pPAs with timeout %d secs(Actual Hold time : %d secs)",
|
|
__func__, &bsrp->bsgrp_node->group, &bsrp->rp_address,
|
|
hold_time, bsrp->rp_holdtime);
|
|
|
|
event_add_timer(router->master, pim_on_g2rp_timer, bsrp, hold_time,
|
|
&bsrp->g2rp_timer);
|
|
}
|
|
|
|
static inline void pim_g2rp_timer_restart(struct bsm_rpinfo *bsrp,
|
|
int hold_time)
|
|
{
|
|
pim_g2rp_timer_start(bsrp, hold_time);
|
|
}
|
|
|
|
static void pim_g2rp_timer_stop(struct bsm_rpinfo *bsrp)
|
|
{
|
|
if (!bsrp)
|
|
return;
|
|
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s : stopping g2rp timer for grp: %pFX - rp: %pPAs",
|
|
__func__, &bsrp->bsgrp_node->group,
|
|
&bsrp->rp_address);
|
|
|
|
EVENT_OFF(bsrp->g2rp_timer);
|
|
}
|
|
|
|
static bool is_hold_time_zero(void *data)
|
|
{
|
|
struct bsm_rpinfo *bsrp;
|
|
|
|
bsrp = data;
|
|
|
|
if (bsrp->rp_holdtime)
|
|
return false;
|
|
else
|
|
return true;
|
|
}
|
|
|
|
static void pim_instate_pend_list(struct bsgrp_node *bsgrp_node)
|
|
{
|
|
struct bsm_rpinfo *active;
|
|
struct bsm_rpinfo *pend;
|
|
struct rp_info *rp_info;
|
|
struct route_node *rn;
|
|
struct pim_instance *pim;
|
|
struct rp_info *rp_all;
|
|
struct prefix group_all;
|
|
bool had_rp_node = true;
|
|
|
|
pim = bsgrp_node->scope->pim;
|
|
active = bsm_rpinfos_first(bsgrp_node->bsrp_list);
|
|
|
|
/* Remove nodes with hold time 0 & check if list still has a head */
|
|
frr_each_safe (bsm_rpinfos, bsgrp_node->partial_bsrp_list, pend) {
|
|
if (is_hold_time_zero(pend)) {
|
|
bsm_rpinfos_del(bsgrp_node->partial_bsrp_list, pend);
|
|
pim_bsm_rpinfo_free(pend);
|
|
}
|
|
}
|
|
|
|
pend = bsm_rpinfos_first(bsgrp_node->partial_bsrp_list);
|
|
|
|
if (!pim_get_all_mcast_group(&group_all))
|
|
return;
|
|
|
|
rp_all = pim_rp_find_match_group(pim, &group_all);
|
|
rn = route_node_lookup(pim->rp_table, &bsgrp_node->group);
|
|
|
|
if (pend)
|
|
pim_g2rp_timer_start(pend, pend->rp_holdtime);
|
|
|
|
/* if rp node doesn't exist or exist but not configured(rp_all),
|
|
* install the rp from head(if exists) of partial list. List is
|
|
* is sorted such that head is the elected RP for the group.
|
|
*/
|
|
if (!rn || (prefix_same(&rp_all->group, &bsgrp_node->group) &&
|
|
pim_rpf_addr_is_inaddr_any(&rp_all->rp))) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: Route node doesn't exist", __func__);
|
|
if (pend)
|
|
pim_rp_new(pim, pend->rp_address, bsgrp_node->group,
|
|
NULL, RP_SRC_BSR);
|
|
had_rp_node = false;
|
|
} else {
|
|
rp_info = (struct rp_info *)rn->info;
|
|
if (!rp_info) {
|
|
route_unlock_node(rn);
|
|
if (pend)
|
|
pim_rp_new(pim, pend->rp_address,
|
|
bsgrp_node->group, NULL, RP_SRC_BSR);
|
|
had_rp_node = false;
|
|
}
|
|
}
|
|
|
|
/* We didn't have rp node and pending list is empty(unlikely), cleanup*/
|
|
if ((!had_rp_node) && (!pend)) {
|
|
pim_free_bsgrp_node(bsgrp_node->scope->bsrp_table,
|
|
&bsgrp_node->group);
|
|
pim_free_bsgrp_data(bsgrp_node);
|
|
return;
|
|
}
|
|
|
|
if ((had_rp_node) && (rp_info->rp_src != RP_SRC_STATIC)) {
|
|
/* This means we searched and got rp node, needs unlock */
|
|
route_unlock_node(rn);
|
|
|
|
if (active && pend) {
|
|
if (pim_addr_cmp(active->rp_address, pend->rp_address))
|
|
pim_rp_change(pim, pend->rp_address,
|
|
bsgrp_node->group, RP_SRC_BSR);
|
|
}
|
|
|
|
/* Possible when the first BSM has group with 0 rp count */
|
|
if ((!active) && (!pend)) {
|
|
if (PIM_DEBUG_BSM) {
|
|
zlog_debug(
|
|
"%s: Both bsrp and partial list are empty",
|
|
__func__);
|
|
}
|
|
pim_free_bsgrp_node(bsgrp_node->scope->bsrp_table,
|
|
&bsgrp_node->group);
|
|
pim_free_bsgrp_data(bsgrp_node);
|
|
return;
|
|
}
|
|
|
|
/* Possible when a group with 0 rp count received in BSM */
|
|
if ((active) && (!pend)) {
|
|
pim_rp_del(pim, active->rp_address, bsgrp_node->group,
|
|
NULL, RP_SRC_BSR);
|
|
pim_free_bsgrp_node(bsgrp_node->scope->bsrp_table,
|
|
&bsgrp_node->group);
|
|
if (PIM_DEBUG_BSM) {
|
|
zlog_debug("%s:Pend List is null,del grp node",
|
|
__func__);
|
|
}
|
|
pim_free_bsgrp_data(bsgrp_node);
|
|
return;
|
|
}
|
|
}
|
|
|
|
if ((had_rp_node) && (rp_info->rp_src == RP_SRC_STATIC)) {
|
|
/* We need to unlock rn this case */
|
|
route_unlock_node(rn);
|
|
/* there is a chance that static rp exist and bsrp cleaned
|
|
* so clean bsgrp node if pending list empty
|
|
*/
|
|
if (!pend) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s: Partial list is empty, static rp exists",
|
|
__func__);
|
|
pim_free_bsgrp_node(bsgrp_node->scope->bsrp_table,
|
|
&bsgrp_node->group);
|
|
pim_free_bsgrp_data(bsgrp_node);
|
|
return;
|
|
}
|
|
}
|
|
|
|
/* swap the list & delete all nodes in partial list (old bsrp_list)
|
|
* before swap
|
|
* active is head of bsrp list
|
|
* pend is head of partial list
|
|
* After swap
|
|
* active is head of partial list
|
|
* pend is head of bsrp list
|
|
* So check appriate head after swap and clean the new partial list
|
|
*/
|
|
bsm_rpinfos_swap_all(bsgrp_node->bsrp_list,
|
|
bsgrp_node->partial_bsrp_list);
|
|
|
|
if (active)
|
|
pim_g2rp_timer_stop(active);
|
|
pim_bsm_rpinfos_free(bsgrp_node->partial_bsrp_list);
|
|
}
|
|
|
|
static bool is_preferred_bsr(struct pim_instance *pim, pim_addr bsr,
|
|
uint32_t bsr_prio)
|
|
{
|
|
if (!pim_addr_cmp(bsr, pim->global_scope.current_bsr))
|
|
return true;
|
|
|
|
if (bsr_prio > pim->global_scope.current_bsr_prio)
|
|
return true;
|
|
|
|
else if (bsr_prio == pim->global_scope.current_bsr_prio) {
|
|
if (pim_addr_cmp(bsr, pim->global_scope.current_bsr) >= 0)
|
|
return true;
|
|
else
|
|
return false;
|
|
} else
|
|
return false;
|
|
}
|
|
|
|
static void pim_bsm_update(struct pim_instance *pim, pim_addr bsr,
|
|
uint32_t bsr_prio)
|
|
{
|
|
if (pim_addr_cmp(bsr, pim->global_scope.current_bsr)) {
|
|
pim_nht_bsr_del(pim, pim->global_scope.current_bsr);
|
|
pim_nht_bsr_add(pim, bsr);
|
|
|
|
pim->global_scope.current_bsr = bsr;
|
|
pim->global_scope.current_bsr_first_ts =
|
|
pim_time_monotonic_sec();
|
|
pim->global_scope.state = ACCEPT_PREFERRED;
|
|
}
|
|
pim->global_scope.current_bsr_prio = bsr_prio;
|
|
pim->global_scope.current_bsr_last_ts = pim_time_monotonic_sec();
|
|
}
|
|
|
|
void pim_bsm_clear(struct pim_instance *pim)
|
|
{
|
|
struct route_node *rn;
|
|
struct route_node *rpnode;
|
|
struct bsgrp_node *bsgrp;
|
|
pim_addr nht_p;
|
|
struct prefix g_all;
|
|
struct rp_info *rp_all;
|
|
struct pim_upstream *up;
|
|
struct rp_info *rp_info;
|
|
bool upstream_updated = false;
|
|
|
|
pim_nht_bsr_del(pim, pim->global_scope.current_bsr);
|
|
|
|
/* Reset scope zone data */
|
|
pim->global_scope.accept_nofwd_bsm = false;
|
|
pim->global_scope.state = ACCEPT_ANY;
|
|
pim->global_scope.current_bsr = PIMADDR_ANY;
|
|
pim->global_scope.current_bsr_prio = 0;
|
|
pim->global_scope.current_bsr_first_ts = 0;
|
|
pim->global_scope.current_bsr_last_ts = 0;
|
|
pim->global_scope.bsm_frag_tag = 0;
|
|
pim_bsm_frags_free(&pim->global_scope);
|
|
|
|
pim_bs_timer_stop(&pim->global_scope);
|
|
|
|
for (rn = route_top(pim->global_scope.bsrp_table); rn;
|
|
rn = route_next(rn)) {
|
|
bsgrp = rn->info;
|
|
if (!bsgrp)
|
|
continue;
|
|
|
|
rpnode = route_node_lookup(pim->rp_table, &bsgrp->group);
|
|
|
|
if (!rpnode) {
|
|
pim_free_bsgrp_node(bsgrp->scope->bsrp_table,
|
|
&bsgrp->group);
|
|
pim_free_bsgrp_data(bsgrp);
|
|
continue;
|
|
}
|
|
|
|
rp_info = (struct rp_info *)rpnode->info;
|
|
|
|
if ((!rp_info) || (rp_info->rp_src != RP_SRC_BSR)) {
|
|
pim_free_bsgrp_node(bsgrp->scope->bsrp_table,
|
|
&bsgrp->group);
|
|
pim_free_bsgrp_data(bsgrp);
|
|
continue;
|
|
}
|
|
|
|
/* Deregister addr with Zebra NHT */
|
|
nht_p = rp_info->rp.rpf_addr;
|
|
|
|
if (PIM_DEBUG_PIM_NHT_RP) {
|
|
zlog_debug("%s: Deregister RP addr %pPA with Zebra ",
|
|
__func__, &nht_p);
|
|
}
|
|
|
|
pim_delete_tracked_nexthop(pim, nht_p, NULL, rp_info);
|
|
|
|
if (!pim_get_all_mcast_group(&g_all))
|
|
return;
|
|
|
|
rp_all = pim_rp_find_match_group(pim, &g_all);
|
|
|
|
if (rp_all == rp_info) {
|
|
rp_all->rp.rpf_addr = PIMADDR_ANY;
|
|
rp_all->i_am_rp = 0;
|
|
} else {
|
|
/* Delete the rp_info from rp-list */
|
|
listnode_delete(pim->rp_list, rp_info);
|
|
|
|
/* Delete the rp node from rp_table */
|
|
rpnode->info = NULL;
|
|
route_unlock_node(rpnode);
|
|
route_unlock_node(rpnode);
|
|
XFREE(MTYPE_PIM_RP, rp_info);
|
|
}
|
|
|
|
pim_free_bsgrp_node(bsgrp->scope->bsrp_table, &bsgrp->group);
|
|
pim_free_bsgrp_data(bsgrp);
|
|
}
|
|
pim_rp_refresh_group_to_rp_mapping(pim);
|
|
|
|
|
|
frr_each (rb_pim_upstream, &pim->upstream_head, up) {
|
|
/* Find the upstream (*, G) whose upstream address is same as
|
|
* the RP
|
|
*/
|
|
if (!pim_addr_is_any(up->sg.src))
|
|
continue;
|
|
|
|
struct prefix grp;
|
|
struct rp_info *trp_info;
|
|
|
|
pim_addr_to_prefix(&grp, up->sg.grp);
|
|
trp_info = pim_rp_find_match_group(pim, &grp);
|
|
|
|
/* RP not found for the group grp */
|
|
if (pim_rpf_addr_is_inaddr_any(&trp_info->rp)) {
|
|
pim_upstream_rpf_clear(pim, up);
|
|
pim_rp_set_upstream_addr(pim, &up->upstream_addr,
|
|
up->sg.src, up->sg.grp);
|
|
} else {
|
|
/* RP found for the group grp */
|
|
pim_upstream_update(pim, up);
|
|
upstream_updated = true;
|
|
}
|
|
}
|
|
|
|
if (upstream_updated)
|
|
pim_zebra_update_all_interfaces(pim);
|
|
}
|
|
|
|
static bool pim_bsm_send_intf(uint8_t *buf, int len, struct interface *ifp,
|
|
pim_addr dst_addr)
|
|
{
|
|
struct pim_interface *pim_ifp;
|
|
|
|
pim_ifp = ifp->info;
|
|
|
|
if (!pim_ifp) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: Pim interface not available for %s",
|
|
__func__, ifp->name);
|
|
return false;
|
|
}
|
|
|
|
if (pim_ifp->pim_sock_fd == -1) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: Pim sock not available for %s",
|
|
__func__, ifp->name);
|
|
return false;
|
|
}
|
|
|
|
if (pim_msg_send(pim_ifp->pim_sock_fd, pim_ifp->primary_address,
|
|
dst_addr, buf, len, ifp)) {
|
|
zlog_warn("%s: Could not send BSM message on interface: %s",
|
|
__func__, ifp->name);
|
|
return false;
|
|
}
|
|
|
|
if (!pim_ifp->pim_passive_enable)
|
|
pim_ifp->pim_ifstat_bsm_tx++;
|
|
|
|
pim_ifp->pim->bsm_sent++;
|
|
return true;
|
|
}
|
|
|
|
static bool pim_bsm_frag_send(uint8_t *buf, uint32_t len, struct interface *ifp,
|
|
uint32_t pim_mtu, pim_addr dst_addr, bool no_fwd)
|
|
{
|
|
struct pim_interface *pim_ifp = ifp->info;
|
|
struct bsmmsg_grpinfo *grpinfo, *curgrp;
|
|
uint8_t *firstgrp_ptr;
|
|
uint8_t *pkt;
|
|
uint8_t *pak_start;
|
|
uint32_t parsed_len = 0;
|
|
uint32_t this_pkt_rem;
|
|
uint32_t copy_byte_count;
|
|
uint32_t this_pkt_len;
|
|
uint8_t total_rp_cnt;
|
|
uint8_t this_rp_cnt;
|
|
uint8_t frag_rp_cnt;
|
|
uint8_t rp_fit_cnt;
|
|
bool pak_pending = false;
|
|
|
|
/* MTU passed here is PIM MTU (IP MTU less IP Hdr) */
|
|
if (pim_mtu < (PIM_MIN_BSM_LEN)) {
|
|
zlog_warn(
|
|
"%s: mtu(pim mtu: %d) size less than minimum bootstrap len",
|
|
__func__, pim_mtu);
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s: mtu (pim mtu:%d) less than minimum bootstrap len",
|
|
__func__, pim_mtu);
|
|
return false;
|
|
}
|
|
|
|
pak_start = XCALLOC(MTYPE_PIM_BSM_PKT_VAR_MEM, pim_mtu);
|
|
|
|
pkt = pak_start;
|
|
|
|
/* Fill PIM header later before sending packet to calc checksum */
|
|
pkt += PIM_MSG_HEADER_LEN;
|
|
buf += PIM_MSG_HEADER_LEN;
|
|
|
|
/* copy bsm header to new packet at offset of pim hdr */
|
|
memcpy(pkt, buf, PIM_BSM_HDR_LEN);
|
|
pkt += PIM_BSM_HDR_LEN;
|
|
buf += PIM_BSM_HDR_LEN;
|
|
parsed_len += (PIM_MSG_HEADER_LEN + PIM_BSM_HDR_LEN);
|
|
|
|
/* Store the position of first grp ptr, which can be reused for
|
|
* next packet to start filling group. old bsm header and pim hdr
|
|
* remains. So need not be filled again for next packet onwards.
|
|
*/
|
|
firstgrp_ptr = pkt;
|
|
|
|
/* we received mtu excluding IP hdr len as param
|
|
* now this_pkt_rem is mtu excluding
|
|
* PIM_BSM_HDR_LEN + PIM_MSG_HEADER_LEN
|
|
*/
|
|
this_pkt_rem = pim_mtu - (PIM_BSM_HDR_LEN + PIM_MSG_HEADER_LEN);
|
|
|
|
/* For each group till the packet length parsed */
|
|
while (parsed_len < len) {
|
|
/* pkt ---> fragment's current pointer
|
|
* buf ---> input buffer's current pointer
|
|
* mtu ---> size of the pim packet - PIM header
|
|
* curgrp ---> current group on the fragment
|
|
* grpinfo ---> current group on the input buffer
|
|
* this_pkt_rem ---> bytes remaing on the current fragment
|
|
* rp_fit_cnt ---> num of rp for current grp that
|
|
* fits this frag
|
|
* total_rp_cnt ---> total rp present for the group in the buf
|
|
* frag_rp_cnt ---> no of rp for the group to be fit in
|
|
* the frag
|
|
* this_rp_cnt ---> how many rp have we parsed
|
|
*/
|
|
grpinfo = (struct bsmmsg_grpinfo *)buf;
|
|
memcpy(pkt, buf, PIM_BSM_GRP_LEN);
|
|
curgrp = (struct bsmmsg_grpinfo *)pkt;
|
|
parsed_len += PIM_BSM_GRP_LEN;
|
|
pkt += PIM_BSM_GRP_LEN;
|
|
buf += PIM_BSM_GRP_LEN;
|
|
this_pkt_rem -= PIM_BSM_GRP_LEN;
|
|
|
|
/* initialize rp count and total_rp_cnt before the rp loop */
|
|
this_rp_cnt = 0;
|
|
total_rp_cnt = grpinfo->frag_rp_count;
|
|
|
|
/* Loop till all RPs for the group parsed */
|
|
while (this_rp_cnt < total_rp_cnt) {
|
|
/* All RP from a group processed here.
|
|
* group is pointed by grpinfo.
|
|
* At this point make sure buf pointing to a RP
|
|
* within a group
|
|
*/
|
|
rp_fit_cnt = this_pkt_rem / PIM_BSM_RP_LEN;
|
|
|
|
/* calculate how many rp am i going to copy in
|
|
* this frag
|
|
*/
|
|
if (rp_fit_cnt > (total_rp_cnt - this_rp_cnt))
|
|
frag_rp_cnt = total_rp_cnt - this_rp_cnt;
|
|
else
|
|
frag_rp_cnt = rp_fit_cnt;
|
|
|
|
/* populate the frag rp count for the current grp */
|
|
curgrp->frag_rp_count = frag_rp_cnt;
|
|
copy_byte_count = frag_rp_cnt * PIM_BSM_RP_LEN;
|
|
|
|
/* copy all the rp that we are fitting in this
|
|
* frag for the grp
|
|
*/
|
|
memcpy(pkt, buf, copy_byte_count);
|
|
this_rp_cnt += frag_rp_cnt;
|
|
buf += copy_byte_count;
|
|
pkt += copy_byte_count;
|
|
parsed_len += copy_byte_count;
|
|
this_pkt_rem -= copy_byte_count;
|
|
|
|
/* Either we couldn't fit all rp for the group or the
|
|
* mtu reached
|
|
*/
|
|
if ((this_rp_cnt < total_rp_cnt)
|
|
|| (this_pkt_rem
|
|
< (PIM_BSM_GRP_LEN + PIM_BSM_RP_LEN))) {
|
|
/* No space to fit in more rp, send this pkt */
|
|
this_pkt_len = pim_mtu - this_pkt_rem;
|
|
pim_msg_build_header(
|
|
pim_ifp->primary_address, dst_addr,
|
|
pak_start, this_pkt_len,
|
|
PIM_MSG_TYPE_BOOTSTRAP, no_fwd);
|
|
pim_bsm_send_intf(pak_start, this_pkt_len, ifp,
|
|
dst_addr);
|
|
|
|
/* Construct next fragment. Reuse old packet */
|
|
pkt = firstgrp_ptr;
|
|
this_pkt_rem = pim_mtu - (PIM_BSM_HDR_LEN
|
|
+ PIM_MSG_HEADER_LEN);
|
|
|
|
/* If pkt can't accommodate next group + at
|
|
* least one rp, we must break out of this inner
|
|
* loop and process next RP
|
|
*/
|
|
if (total_rp_cnt == this_rp_cnt)
|
|
break;
|
|
|
|
/* If some more RPs for the same group pending,
|
|
* fill grp hdr
|
|
*/
|
|
memcpy(pkt, (uint8_t *)grpinfo,
|
|
PIM_BSM_GRP_LEN);
|
|
curgrp = (struct bsmmsg_grpinfo *)pkt;
|
|
pkt += PIM_BSM_GRP_LEN;
|
|
this_pkt_rem -= PIM_BSM_GRP_LEN;
|
|
pak_pending = false;
|
|
} else {
|
|
/* We filled something but not yet sent out */
|
|
pak_pending = true;
|
|
}
|
|
} /* while RP count */
|
|
} /*while parsed len */
|
|
|
|
/* Send if we have any unsent packet */
|
|
if (pak_pending) {
|
|
this_pkt_len = pim_mtu - this_pkt_rem;
|
|
pim_msg_build_header(pim_ifp->primary_address, dst_addr,
|
|
pak_start, this_pkt_len,
|
|
PIM_MSG_TYPE_BOOTSTRAP, no_fwd);
|
|
pim_bsm_send_intf(pak_start, (pim_mtu - this_pkt_rem), ifp,
|
|
dst_addr);
|
|
}
|
|
XFREE(MTYPE_PIM_BSM_PKT_VAR_MEM, pak_start);
|
|
return true;
|
|
}
|
|
|
|
static void pim_bsm_fwd_whole_sz(struct pim_instance *pim, uint8_t *buf,
|
|
uint32_t len, int sz)
|
|
{
|
|
struct interface *ifp;
|
|
struct pim_interface *pim_ifp;
|
|
pim_addr dst_addr;
|
|
uint32_t pim_mtu;
|
|
bool no_fwd = false;
|
|
bool ret = false;
|
|
|
|
/* For now only global scope zone is supported, so send on all
|
|
* pim interfaces in the vrf
|
|
*/
|
|
dst_addr = qpim_all_pim_routers_addr;
|
|
FOR_ALL_INTERFACES (pim->vrf, ifp) {
|
|
pim_ifp = ifp->info;
|
|
if ((!pim_ifp) || (!pim_ifp->bsm_enable))
|
|
continue;
|
|
|
|
/*
|
|
* RFC 5059 Sec 3.4:
|
|
* When a Bootstrap message is forwarded, it is forwarded out
|
|
* of every multicast-capable interface that has PIM neighbors.
|
|
*
|
|
* So skipping pim interfaces with no neighbors.
|
|
*/
|
|
if (listcount(pim_ifp->pim_neighbor_list) == 0)
|
|
continue;
|
|
|
|
pim_hello_require(ifp);
|
|
pim_mtu = ifp->mtu - MAX_IP_HDR_LEN;
|
|
if (pim_mtu < len) {
|
|
ret = pim_bsm_frag_send(buf, len, ifp, pim_mtu,
|
|
dst_addr, no_fwd);
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: pim_bsm_frag_send returned %s",
|
|
__func__, ret ? "TRUE" : "FALSE");
|
|
} else {
|
|
pim_msg_build_header(pim_ifp->primary_address, dst_addr,
|
|
buf, len, PIM_MSG_TYPE_BOOTSTRAP,
|
|
no_fwd);
|
|
if (!pim_bsm_send_intf(buf, len, ifp, dst_addr)) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s: pim_bsm_send_intf returned false",
|
|
__func__);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
bool pim_bsm_new_nbr_fwd(struct pim_neighbor *neigh, struct interface *ifp)
|
|
{
|
|
pim_addr dst_addr;
|
|
struct pim_interface *pim_ifp;
|
|
struct bsm_scope *scope;
|
|
struct bsm_frag *bsfrag;
|
|
uint32_t pim_mtu;
|
|
bool no_fwd = true;
|
|
bool ret = false;
|
|
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: New neighbor %pPA seen on %s", __func__,
|
|
&neigh->source_addr, ifp->name);
|
|
|
|
pim_ifp = ifp->info;
|
|
|
|
/* DR only forwards BSM packet */
|
|
if (!pim_addr_cmp(pim_ifp->pim_dr_addr, pim_ifp->primary_address)) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s: It is not DR, so don't forward BSM packet",
|
|
__func__);
|
|
}
|
|
|
|
if (!pim_ifp->bsm_enable) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: BSM proc not enabled on %s", __func__,
|
|
ifp->name);
|
|
return ret;
|
|
}
|
|
|
|
scope = &pim_ifp->pim->global_scope;
|
|
|
|
if (!bsm_frags_count(scope->bsm_frags)) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: BSM list for the scope is empty",
|
|
__func__);
|
|
return ret;
|
|
}
|
|
|
|
if (!pim_ifp->ucast_bsm_accept) {
|
|
dst_addr = qpim_all_pim_routers_addr;
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: Sending BSM mcast to %pPA", __func__,
|
|
&neigh->source_addr);
|
|
} else {
|
|
dst_addr = neigh->source_addr;
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: Sending BSM ucast to %pPA", __func__,
|
|
&neigh->source_addr);
|
|
}
|
|
pim_mtu = ifp->mtu - MAX_IP_HDR_LEN;
|
|
pim_hello_require(ifp);
|
|
|
|
frr_each (bsm_frags, scope->bsm_frags, bsfrag) {
|
|
if (pim_mtu < bsfrag->size) {
|
|
ret = pim_bsm_frag_send(bsfrag->data, bsfrag->size, ifp,
|
|
pim_mtu, dst_addr, no_fwd);
|
|
if (!ret) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s: pim_bsm_frag_send failed",
|
|
__func__);
|
|
}
|
|
} else {
|
|
/* Pim header needs to be constructed */
|
|
pim_msg_build_header(pim_ifp->primary_address, dst_addr,
|
|
bsfrag->data, bsfrag->size,
|
|
PIM_MSG_TYPE_BOOTSTRAP, no_fwd);
|
|
ret = pim_bsm_send_intf(bsfrag->data, bsfrag->size, ifp,
|
|
dst_addr);
|
|
if (!ret) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s: pim_bsm_frag_send failed",
|
|
__func__);
|
|
}
|
|
}
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
struct bsgrp_node *pim_bsm_get_bsgrp_node(struct bsm_scope *scope,
|
|
struct prefix *grp)
|
|
{
|
|
struct route_node *rn;
|
|
struct bsgrp_node *bsgrp;
|
|
|
|
rn = route_node_lookup(scope->bsrp_table, grp);
|
|
if (!rn) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: Route node doesn't exist for the group",
|
|
__func__);
|
|
return NULL;
|
|
}
|
|
bsgrp = rn->info;
|
|
route_unlock_node(rn);
|
|
|
|
return bsgrp;
|
|
}
|
|
|
|
static uint32_t hash_calc_on_grp_rp(struct prefix group, pim_addr rp,
|
|
uint8_t hashmasklen)
|
|
{
|
|
uint64_t temp;
|
|
uint32_t hash;
|
|
uint32_t grpaddr;
|
|
uint32_t rp_add;
|
|
uint32_t mask = 0xffffffff;
|
|
|
|
/* mask to be made zero if hashmasklen is 0 because mask << 32
|
|
* may not give 0. hashmasklen can be 0 to 32.
|
|
*/
|
|
if (hashmasklen == 0)
|
|
mask = 0;
|
|
|
|
/* in_addr stores ip in big endian, hence network byte order
|
|
* convert to uint32 before processing hash
|
|
*/
|
|
#if PIM_IPV == 4
|
|
grpaddr = ntohl(group.u.prefix4.s_addr);
|
|
#else
|
|
grpaddr = group.u.prefix6.s6_addr32[0] ^ group.u.prefix6.s6_addr32[1] ^
|
|
group.u.prefix6.s6_addr32[2] ^ group.u.prefix6.s6_addr32[3];
|
|
#endif
|
|
/* Avoid shifting by 32 bit on a 32 bit register */
|
|
if (hashmasklen)
|
|
grpaddr = grpaddr & ((mask << (32 - hashmasklen)));
|
|
else
|
|
grpaddr = grpaddr & mask;
|
|
|
|
#if PIM_IPV == 4
|
|
rp_add = ntohl(rp.s_addr);
|
|
#else
|
|
rp_add = rp.s6_addr32[0] ^ rp.s6_addr32[1] ^ rp.s6_addr32[2] ^
|
|
rp.s6_addr32[3];
|
|
#endif
|
|
temp = 1103515245 * ((1103515245 * (uint64_t)grpaddr + 12345) ^ rp_add)
|
|
+ 12345;
|
|
hash = temp & (0x7fffffff);
|
|
return hash;
|
|
}
|
|
|
|
static bool pim_install_bsm_grp_rp(struct pim_instance *pim,
|
|
struct bsgrp_node *grpnode,
|
|
struct bsmmsg_rpinfo *rp)
|
|
{
|
|
struct bsm_rpinfo *bsm_rpinfo;
|
|
uint8_t hashMask_len = pim->global_scope.hashMasklen;
|
|
|
|
/*memory allocation for bsm_rpinfo */
|
|
bsm_rpinfo = XCALLOC(MTYPE_PIM_BSRP_INFO, sizeof(*bsm_rpinfo));
|
|
|
|
bsm_rpinfo->rp_prio = rp->rp_pri;
|
|
bsm_rpinfo->rp_holdtime = rp->rp_holdtime;
|
|
bsm_rpinfo->rp_address = rp->rpaddr.addr;
|
|
bsm_rpinfo->elapse_time = 0;
|
|
|
|
/* Back pointer to the group node. */
|
|
bsm_rpinfo->bsgrp_node = grpnode;
|
|
|
|
/* update hash for this rp node */
|
|
bsm_rpinfo->hash = hash_calc_on_grp_rp(grpnode->group, rp->rpaddr.addr,
|
|
hashMask_len);
|
|
if (bsm_rpinfos_add(grpnode->partial_bsrp_list, bsm_rpinfo) == NULL) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s, bs_rpinfo node added to the partial bs_rplist.",
|
|
__func__);
|
|
return true;
|
|
}
|
|
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: list node not added", __func__);
|
|
|
|
XFREE(MTYPE_PIM_BSRP_INFO, bsm_rpinfo);
|
|
return false;
|
|
}
|
|
|
|
static void pim_update_pending_rp_cnt(struct bsm_scope *sz,
|
|
struct bsgrp_node *bsgrp,
|
|
uint16_t bsm_frag_tag,
|
|
uint32_t total_rp_count)
|
|
{
|
|
if (bsgrp->pend_rp_cnt) {
|
|
/* received bsm is different packet ,
|
|
* it is not same fragment.
|
|
*/
|
|
if (bsm_frag_tag != bsgrp->frag_tag) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s,Received a new BSM ,so clear the pending bs_rpinfo list.",
|
|
__func__);
|
|
pim_bsm_rpinfos_free(bsgrp->partial_bsrp_list);
|
|
bsgrp->pend_rp_cnt = total_rp_count;
|
|
}
|
|
} else
|
|
bsgrp->pend_rp_cnt = total_rp_count;
|
|
|
|
bsgrp->frag_tag = bsm_frag_tag;
|
|
}
|
|
|
|
/* Parsing BSR packet and adding to partial list of corresponding bsgrp node */
|
|
static bool pim_bsm_parse_install_g2rp(struct bsm_scope *scope, uint8_t *buf,
|
|
int buflen, uint16_t bsm_frag_tag)
|
|
{
|
|
struct bsmmsg_grpinfo grpinfo;
|
|
struct bsmmsg_rpinfo rpinfo;
|
|
struct prefix group;
|
|
struct bsgrp_node *bsgrp = NULL;
|
|
int frag_rp_cnt = 0;
|
|
int offset = 0;
|
|
int ins_count = 0;
|
|
pim_addr grp_addr;
|
|
|
|
while (buflen > offset) {
|
|
if (offset + (int)sizeof(struct bsmmsg_grpinfo) > buflen) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s: buflen received %d is less than the internal data structure of the packet would suggest",
|
|
__func__, buflen);
|
|
return false;
|
|
}
|
|
/* Extract Group tlv from BSM */
|
|
memcpy(&grpinfo, buf, sizeof(struct bsmmsg_grpinfo));
|
|
grp_addr = grpinfo.group.addr;
|
|
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s, Group %pPAs Rpcount:%d Fragment-Rp-count:%d",
|
|
__func__, &grp_addr, grpinfo.rp_count,
|
|
grpinfo.frag_rp_count);
|
|
|
|
buf += sizeof(struct bsmmsg_grpinfo);
|
|
offset += sizeof(struct bsmmsg_grpinfo);
|
|
|
|
group.family = PIM_AF;
|
|
if (grpinfo.group.mask > PIM_MAX_BITLEN) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s, prefix length specified: %d is too long",
|
|
__func__, grpinfo.group.mask);
|
|
return false;
|
|
}
|
|
|
|
pim_addr_to_prefix(&group, grp_addr);
|
|
group.prefixlen = grpinfo.group.mask;
|
|
|
|
/* Get the Group node for the BSM rp table */
|
|
bsgrp = pim_bsm_get_bsgrp_node(scope, &group);
|
|
|
|
if (grpinfo.rp_count == 0) {
|
|
struct bsm_rpinfo *old_rpinfo;
|
|
|
|
/* BSR explicitly no longer has RPs for this group */
|
|
if (!bsgrp)
|
|
continue;
|
|
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s, Rp count is zero for group: %pPAs",
|
|
__func__, &grp_addr);
|
|
|
|
old_rpinfo = bsm_rpinfos_first(bsgrp->bsrp_list);
|
|
if (old_rpinfo)
|
|
pim_rp_del(scope->pim, old_rpinfo->rp_address,
|
|
group, NULL, RP_SRC_BSR);
|
|
|
|
pim_free_bsgrp_node(scope->bsrp_table, &bsgrp->group);
|
|
pim_free_bsgrp_data(bsgrp);
|
|
continue;
|
|
}
|
|
|
|
if (!bsgrp) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s, Create new BSM Group node.",
|
|
__func__);
|
|
|
|
/* create a new node to be added to the tree. */
|
|
bsgrp = pim_bsm_new_bsgrp_node(scope->bsrp_table,
|
|
&group);
|
|
|
|
if (!bsgrp) {
|
|
zlog_debug(
|
|
"%s, Failed to get the BSM group node.",
|
|
__func__);
|
|
continue;
|
|
}
|
|
|
|
bsgrp->scope = scope;
|
|
}
|
|
|
|
pim_update_pending_rp_cnt(scope, bsgrp, bsm_frag_tag,
|
|
grpinfo.rp_count);
|
|
frag_rp_cnt = grpinfo.frag_rp_count;
|
|
ins_count = 0;
|
|
|
|
while (frag_rp_cnt--) {
|
|
if (offset + (int)sizeof(struct bsmmsg_rpinfo)
|
|
> buflen) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s, buflen received: %u is less than the internal data structure of the packet would suggest",
|
|
__func__, buflen);
|
|
return false;
|
|
}
|
|
|
|
/* Extract RP address tlv from BSM */
|
|
memcpy(&rpinfo, buf, sizeof(struct bsmmsg_rpinfo));
|
|
rpinfo.rp_holdtime = ntohs(rpinfo.rp_holdtime);
|
|
buf += sizeof(struct bsmmsg_rpinfo);
|
|
offset += sizeof(struct bsmmsg_rpinfo);
|
|
|
|
if (PIM_DEBUG_BSM) {
|
|
pim_addr rp_addr;
|
|
|
|
rp_addr = rpinfo.rpaddr.addr;
|
|
zlog_debug(
|
|
"%s, Rp address - %pPAs; pri:%d hold:%d",
|
|
__func__, &rp_addr, rpinfo.rp_pri,
|
|
rpinfo.rp_holdtime);
|
|
}
|
|
|
|
/* Call Install api to update grp-rp mappings */
|
|
if (pim_install_bsm_grp_rp(scope->pim, bsgrp, &rpinfo))
|
|
ins_count++;
|
|
}
|
|
|
|
bsgrp->pend_rp_cnt -= ins_count;
|
|
|
|
if (!bsgrp->pend_rp_cnt) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s, Recvd all the rps for this group, so bsrp list with penidng rp list.",
|
|
__func__);
|
|
/* replace the bsrp_list with pending list */
|
|
pim_instate_pend_list(bsgrp);
|
|
}
|
|
}
|
|
return true;
|
|
}
|
|
|
|
int pim_bsm_process(struct interface *ifp, pim_sgaddr *sg, uint8_t *buf,
|
|
uint32_t buf_size, bool no_fwd)
|
|
{
|
|
struct bsm_hdr *bshdr;
|
|
int sz = PIM_GBL_SZ_ID;
|
|
struct bsmmsg_grpinfo *msg_grp;
|
|
struct pim_interface *pim_ifp = NULL;
|
|
struct bsm_frag *bsfrag;
|
|
struct pim_instance *pim;
|
|
uint16_t frag_tag;
|
|
pim_addr bsr_addr;
|
|
bool empty_bsm = false;
|
|
|
|
/* BSM Packet acceptance validation */
|
|
pim_ifp = ifp->info;
|
|
if (!pim_ifp) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s: multicast not enabled on interface %s",
|
|
__func__, ifp->name);
|
|
return -1;
|
|
}
|
|
|
|
if (pim_ifp->pim_passive_enable) {
|
|
if (PIM_DEBUG_PIM_PACKETS)
|
|
zlog_debug(
|
|
"skip receiving PIM message on passive interface %s",
|
|
ifp->name);
|
|
return 0;
|
|
}
|
|
|
|
pim_ifp->pim_ifstat_bsm_rx++;
|
|
pim = pim_ifp->pim;
|
|
pim->bsm_rcvd++;
|
|
|
|
/* Drop if bsm processing is disabled on interface */
|
|
if (!pim_ifp->bsm_enable) {
|
|
zlog_warn("%s: BSM not enabled on interface %s", __func__,
|
|
ifp->name);
|
|
pim_ifp->pim_ifstat_bsm_cfg_miss++;
|
|
pim->bsm_dropped++;
|
|
return -1;
|
|
}
|
|
|
|
if (buf_size < (PIM_MSG_HEADER_LEN + sizeof(struct bsm_hdr))) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s: received buffer length of %d which is too small to properly decode",
|
|
__func__, buf_size);
|
|
return -1;
|
|
}
|
|
|
|
bshdr = (struct bsm_hdr *)(buf + PIM_MSG_HEADER_LEN);
|
|
if (bshdr->hm_len > PIM_MAX_BITLEN) {
|
|
zlog_warn(
|
|
"Bad hashmask length for %s; got %hhu, expected value in range 0-32",
|
|
PIM_AF_NAME, bshdr->hm_len);
|
|
pim->bsm_dropped++;
|
|
return -1;
|
|
}
|
|
pim->global_scope.hashMasklen = bshdr->hm_len;
|
|
frag_tag = ntohs(bshdr->frag_tag);
|
|
/* NB: bshdr->bsr_addr.addr is packed/unaligned => memcpy */
|
|
memcpy(&bsr_addr, &bshdr->bsr_addr.addr, sizeof(bsr_addr));
|
|
|
|
/* Identify empty BSM */
|
|
if ((buf_size - PIM_BSM_HDR_LEN - PIM_MSG_HEADER_LEN) < PIM_BSM_GRP_LEN)
|
|
empty_bsm = true;
|
|
|
|
if (!empty_bsm) {
|
|
msg_grp = (struct bsmmsg_grpinfo *)(buf + PIM_MSG_HEADER_LEN
|
|
+ PIM_BSM_HDR_LEN);
|
|
/* Currently we don't support scope zoned BSM */
|
|
if (msg_grp->group.sz) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s : Administratively scoped range BSM received",
|
|
__func__);
|
|
pim_ifp->pim_ifstat_bsm_invalid_sz++;
|
|
pim->bsm_dropped++;
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
/* Drop if bsr is not preferred bsr */
|
|
if (!is_preferred_bsr(pim, bsr_addr, bshdr->bsr_prio)) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s : Received a non-preferred BSM",
|
|
__func__);
|
|
pim->bsm_dropped++;
|
|
return -1;
|
|
}
|
|
|
|
if (no_fwd) {
|
|
/* only accept no-forward BSM if quick refresh on startup */
|
|
if ((pim->global_scope.accept_nofwd_bsm)
|
|
|| (frag_tag == pim->global_scope.bsm_frag_tag)) {
|
|
pim->global_scope.accept_nofwd_bsm = false;
|
|
} else {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s : nofwd_bsm received on %pPAs when accpt_nofwd_bsm false",
|
|
__func__, &bsr_addr);
|
|
pim->bsm_dropped++;
|
|
pim_ifp->pim_ifstat_ucast_bsm_cfg_miss++;
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
/* BSM packet is seen, so resetting accept_nofwd_bsm to false */
|
|
if (pim->global_scope.accept_nofwd_bsm)
|
|
pim->global_scope.accept_nofwd_bsm = false;
|
|
|
|
if (!pim_addr_cmp(sg->grp, qpim_all_pim_routers_addr)) {
|
|
/* Multicast BSMs are only accepted if source interface & IP
|
|
* match RPF towards the BSR's IP address, or they have
|
|
* no-forward set
|
|
*/
|
|
if (!no_fwd &&
|
|
!pim_nht_bsr_rpf_check(pim, bsr_addr, ifp, sg->src)) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"BSM check: RPF to BSR %pPAs is not %pPA%%%s",
|
|
&bsr_addr, &sg->src, ifp->name);
|
|
pim->bsm_dropped++;
|
|
return -1;
|
|
}
|
|
} else if (if_address_is_local(&sg->grp, PIM_AF, pim->vrf->vrf_id)) {
|
|
/* Unicast BSM received - if ucast bsm not enabled on
|
|
* the interface, drop it
|
|
*/
|
|
if (!pim_ifp->ucast_bsm_accept) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug(
|
|
"%s : Unicast BSM not enabled on interface %s",
|
|
__func__, ifp->name);
|
|
pim_ifp->pim_ifstat_ucast_bsm_cfg_miss++;
|
|
pim->bsm_dropped++;
|
|
return -1;
|
|
}
|
|
|
|
} else {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s : Invalid destination address",
|
|
__func__);
|
|
pim->bsm_dropped++;
|
|
return -1;
|
|
}
|
|
|
|
if (empty_bsm) {
|
|
if (PIM_DEBUG_BSM)
|
|
zlog_debug("%s : Empty Pref BSM received", __func__);
|
|
}
|
|
/* Parse Update bsm rp table and install/uninstall rp if required */
|
|
if (!pim_bsm_parse_install_g2rp(
|
|
&pim_ifp->pim->global_scope,
|
|
(buf + PIM_BSM_HDR_LEN + PIM_MSG_HEADER_LEN),
|
|
(buf_size - PIM_BSM_HDR_LEN - PIM_MSG_HEADER_LEN),
|
|
frag_tag)) {
|
|
if (PIM_DEBUG_BSM) {
|
|
zlog_debug("%s, Parsing BSM failed.", __func__);
|
|
}
|
|
pim->bsm_dropped++;
|
|
return -1;
|
|
}
|
|
/* Restart the bootstrap timer */
|
|
pim_bs_timer_restart(&pim_ifp->pim->global_scope,
|
|
PIM_BSR_DEFAULT_TIMEOUT);
|
|
|
|
/* If new BSM received, clear the old bsm database */
|
|
if (pim_ifp->pim->global_scope.bsm_frag_tag != frag_tag) {
|
|
if (PIM_DEBUG_BSM) {
|
|
zlog_debug("%s: Current frag tag: %d Frag teg rcvd: %d",
|
|
__func__,
|
|
pim_ifp->pim->global_scope.bsm_frag_tag,
|
|
frag_tag);
|
|
}
|
|
pim_bsm_frags_free(&pim_ifp->pim->global_scope);
|
|
pim_ifp->pim->global_scope.bsm_frag_tag = frag_tag;
|
|
}
|
|
|
|
/* update the scope information from bsm */
|
|
pim_bsm_update(pim, bsr_addr, bshdr->bsr_prio);
|
|
|
|
if (!no_fwd) {
|
|
pim_bsm_fwd_whole_sz(pim_ifp->pim, buf, buf_size, sz);
|
|
bsfrag = XCALLOC(MTYPE_PIM_BSM_FRAG,
|
|
sizeof(struct bsm_frag) + buf_size);
|
|
|
|
bsfrag->size = buf_size;
|
|
memcpy(bsfrag->data, buf, buf_size);
|
|
bsm_frags_add_tail(pim_ifp->pim->global_scope.bsm_frags,
|
|
bsfrag);
|
|
}
|
|
|
|
return 0;
|
|
}
|