blob: e78f7f6a59beef0bf61a794957ef6f8cb4f3b560 [file] [log] [blame]
/*
* Copyright (C) 2003 Yasuhiro Ohara
*
* This file is part of GNU Zebra.
*
* GNU Zebra is free software; you can redistribute it and/or modify it
* under the terms of the GNU General Public License as published by the
* Free Software Foundation; either version 2, or (at your option) any
* later version.
*
* GNU Zebra is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with GNU Zebra; see the file COPYING. If not, write to the
* Free Software Foundation, Inc., 59 Temple Place - Suite 330,
* Boston, MA 02111-1307, USA.
*/
/* Shortest Path First calculation for OSPFv3 */
#include <zebra.h>
#include "log.h"
#include "memory.h"
#include "command.h"
#include "vty.h"
#include "prefix.h"
#include "pqueue.h"
#include "linklist.h"
#include "thread.h"
#include "ospf6_lsa.h"
#include "ospf6_lsdb.h"
#include "ospf6_route.h"
#include "ospf6_area.h"
#include "ospf6_spf.h"
#include "ospf6_intra.h"
#include "ospf6_interface.h"
#include "ospf6d.h"
unsigned char conf_debug_ospf6_spf = 0;
static int
ospf6_vertex_cmp (void *a, void *b)
{
struct ospf6_vertex *va = (struct ospf6_vertex *) a;
struct ospf6_vertex *vb = (struct ospf6_vertex *) b;
/* ascending order */
if (va->cost != vb->cost)
return (va->cost - vb->cost);
return (va->hops - vb->hops);
}
static int
ospf6_vertex_id_cmp (void *a, void *b)
{
struct ospf6_vertex *va = (struct ospf6_vertex *) a;
struct ospf6_vertex *vb = (struct ospf6_vertex *) b;
int ret = 0;
ret = ntohl (ospf6_linkstate_prefix_adv_router (&va->vertex_id)) -
ntohl (ospf6_linkstate_prefix_adv_router (&vb->vertex_id));
if (ret)
return ret;
ret = ntohl (ospf6_linkstate_prefix_id (&va->vertex_id)) -
ntohl (ospf6_linkstate_prefix_id (&vb->vertex_id));
return ret;
}
static struct ospf6_vertex *
ospf6_vertex_create (struct ospf6_lsa *lsa)
{
struct ospf6_vertex *v;
int i;
v = (struct ospf6_vertex *)
XMALLOC (MTYPE_OSPF6_VERTEX, sizeof (struct ospf6_vertex));
/* type */
if (ntohs (lsa->header->type) == OSPF6_LSTYPE_ROUTER)
v->type = OSPF6_VERTEX_TYPE_ROUTER;
else if (ntohs (lsa->header->type) == OSPF6_LSTYPE_NETWORK)
v->type = OSPF6_VERTEX_TYPE_NETWORK;
else
assert (0);
/* vertex_id */
ospf6_linkstate_prefix (lsa->header->adv_router, lsa->header->id,
&v->vertex_id);
/* name */
ospf6_linkstate_prefix2str (&v->vertex_id, v->name, sizeof (v->name));
/* Associated LSA */
v->lsa = lsa;
/* capability bits + options */
v->capability = *(u_char *)(OSPF6_LSA_HEADER_END (lsa->header));
v->options[0] = *(u_char *)(OSPF6_LSA_HEADER_END (lsa->header) + 1);
v->options[1] = *(u_char *)(OSPF6_LSA_HEADER_END (lsa->header) + 2);
v->options[2] = *(u_char *)(OSPF6_LSA_HEADER_END (lsa->header) + 3);
for (i = 0; i < OSPF6_MULTI_PATH_LIMIT; i++)
ospf6_nexthop_clear (&v->nexthop[i]);
v->parent = NULL;
v->child_list = list_new ();
v->child_list->cmp = ospf6_vertex_id_cmp;
return v;
}
static void
ospf6_vertex_delete (struct ospf6_vertex *v)
{
list_delete (v->child_list);
XFREE (MTYPE_OSPF6_VERTEX, v);
}
static struct ospf6_lsa *
ospf6_lsdesc_lsa (caddr_t lsdesc, struct ospf6_vertex *v)
{
struct ospf6_lsa *lsa;
u_int16_t type = 0;
u_int32_t id = 0, adv_router = 0;
if (VERTEX_IS_TYPE (NETWORK, v))
{
type = htons (OSPF6_LSTYPE_ROUTER);
id = htonl (0);
adv_router = NETWORK_LSDESC_GET_NBR_ROUTERID (lsdesc);
}
else
{
if (ROUTER_LSDESC_IS_TYPE (POINTTOPOINT, lsdesc))
{
type = htons (OSPF6_LSTYPE_ROUTER);
id = htonl (0);
adv_router = ROUTER_LSDESC_GET_NBR_ROUTERID (lsdesc);
}
else if (ROUTER_LSDESC_IS_TYPE (TRANSIT_NETWORK, lsdesc))
{
type = htons (OSPF6_LSTYPE_NETWORK);
id = htonl (ROUTER_LSDESC_GET_NBR_IFID (lsdesc));
adv_router = ROUTER_LSDESC_GET_NBR_ROUTERID (lsdesc);
}
}
lsa = ospf6_lsdb_lookup (type, id, adv_router, v->area->lsdb);
if (IS_OSPF6_DEBUG_SPF (PROCESS))
{
char ibuf[16], abuf[16];
inet_ntop (AF_INET, &id, ibuf, sizeof (ibuf));
inet_ntop (AF_INET, &adv_router, abuf, sizeof (abuf));
if (lsa)
zlog_debug (" Link to: %s", lsa->name);
else
zlog_debug (" Link to: [%s Id:%s Adv:%s] No LSA",
ospf6_lstype_name (type), ibuf, abuf);
}
return lsa;
}
static char *
ospf6_lsdesc_backlink (struct ospf6_lsa *lsa,
caddr_t lsdesc, struct ospf6_vertex *v)
{
caddr_t backlink, found = NULL;
int size;
size = (OSPF6_LSA_IS_TYPE (ROUTER, lsa) ?
sizeof (struct ospf6_router_lsdesc) :
sizeof (struct ospf6_network_lsdesc));
for (backlink = OSPF6_LSA_HEADER_END (lsa->header) + 4;
backlink + size <= OSPF6_LSA_END (lsa->header); backlink += size)
{
assert (! (OSPF6_LSA_IS_TYPE (NETWORK, lsa) &&
VERTEX_IS_TYPE (NETWORK, v)));
if (OSPF6_LSA_IS_TYPE (NETWORK, lsa) &&
NETWORK_LSDESC_GET_NBR_ROUTERID (backlink)
== v->lsa->header->adv_router)
found = backlink;
else if (VERTEX_IS_TYPE (NETWORK, v) &&
ROUTER_LSDESC_IS_TYPE (TRANSIT_NETWORK, backlink) &&
ROUTER_LSDESC_GET_NBR_ROUTERID (backlink)
== v->lsa->header->adv_router &&
ROUTER_LSDESC_GET_NBR_IFID (backlink)
== ntohl (v->lsa->header->id))
found = backlink;
else
{
if (! ROUTER_LSDESC_IS_TYPE (POINTTOPOINT, backlink) ||
! ROUTER_LSDESC_IS_TYPE (POINTTOPOINT, lsdesc))
continue;
if (ROUTER_LSDESC_GET_NBR_IFID (backlink) !=
ROUTER_LSDESC_GET_IFID (lsdesc) ||
ROUTER_LSDESC_GET_NBR_IFID (lsdesc) !=
ROUTER_LSDESC_GET_IFID (backlink))
continue;
if (ROUTER_LSDESC_GET_NBR_ROUTERID (backlink) !=
v->lsa->header->adv_router ||
ROUTER_LSDESC_GET_NBR_ROUTERID (lsdesc) !=
lsa->header->adv_router)
continue;
found = backlink;
}
}
if (IS_OSPF6_DEBUG_SPF (PROCESS))
zlog_debug (" Backlink %s", (found ? "OK" : "FAIL"));
return found;
}
static void
ospf6_nexthop_calc (struct ospf6_vertex *w, struct ospf6_vertex *v,
caddr_t lsdesc)
{
int i, ifindex;
struct ospf6_interface *oi;
u_int16_t type;
u_int32_t adv_router;
struct ospf6_lsa *lsa;
struct ospf6_link_lsa *link_lsa;
char buf[64];
assert (VERTEX_IS_TYPE (ROUTER, w));
ifindex = (VERTEX_IS_TYPE (NETWORK, v) ? v->nexthop[0].ifindex :
ROUTER_LSDESC_GET_IFID (lsdesc));
oi = ospf6_interface_lookup_by_ifindex (ifindex);
if (oi == NULL)
{
if (IS_OSPF6_DEBUG_SPF (PROCESS))
zlog_debug ("Can't find interface in SPF: ifindex %d", ifindex);
return;
}
type = htons (OSPF6_LSTYPE_LINK);
adv_router = (VERTEX_IS_TYPE (NETWORK, v) ?
NETWORK_LSDESC_GET_NBR_ROUTERID (lsdesc) :
ROUTER_LSDESC_GET_NBR_ROUTERID (lsdesc));
i = 0;
for (lsa = ospf6_lsdb_type_router_head (type, adv_router, oi->lsdb); lsa;
lsa = ospf6_lsdb_type_router_next (type, adv_router, lsa))
{
if (VERTEX_IS_TYPE (ROUTER, v) &&
htonl (ROUTER_LSDESC_GET_NBR_IFID (lsdesc)) != lsa->header->id)
continue;
link_lsa = (struct ospf6_link_lsa *) OSPF6_LSA_HEADER_END (lsa->header);
if (IS_OSPF6_DEBUG_SPF (PROCESS))
{
inet_ntop (AF_INET6, &link_lsa->linklocal_addr, buf, sizeof (buf));
zlog_debug (" nexthop %s from %s", buf, lsa->name);
}
if (i < OSPF6_MULTI_PATH_LIMIT)
{
memcpy (&w->nexthop[i].address, &link_lsa->linklocal_addr,
sizeof (struct in6_addr));
w->nexthop[i].ifindex = ifindex;
i++;
}
}
if (i == 0 && IS_OSPF6_DEBUG_SPF (PROCESS))
zlog_debug ("No nexthop for %s found", w->name);
}
static int
ospf6_spf_install (struct ospf6_vertex *v,
struct ospf6_route_table *result_table)
{
struct ospf6_route *route;
int i, j;
struct ospf6_vertex *prev;
if (IS_OSPF6_DEBUG_SPF (PROCESS))
zlog_debug ("SPF install %s hops %d cost %d",
v->name, v->hops, v->cost);
route = ospf6_route_lookup (&v->vertex_id, result_table);
if (route && route->path.cost < v->cost)
{
if (IS_OSPF6_DEBUG_SPF (PROCESS))
zlog_debug (" already installed with lower cost (%d), ignore",
route->path.cost);
ospf6_vertex_delete (v);
return -1;
}
else if (route && route->path.cost == v->cost)
{
if (IS_OSPF6_DEBUG_SPF (PROCESS))
zlog_debug (" another path found, merge");
for (i = 0; ospf6_nexthop_is_set (&v->nexthop[i]) &&
i < OSPF6_MULTI_PATH_LIMIT; i++)
{
for (j = 0; j < OSPF6_MULTI_PATH_LIMIT; j++)
{
if (ospf6_nexthop_is_set (&route->nexthop[j]))
{
if (ospf6_nexthop_is_same (&route->nexthop[j],
&v->nexthop[i]))
break;
else
continue;
}
ospf6_nexthop_copy (&route->nexthop[j], &v->nexthop[i]);
break;
}
}
prev = (struct ospf6_vertex *) route->route_option;
assert (prev->hops <= v->hops);
ospf6_vertex_delete (v);
return -1;
}
/* There should be no case where candidate being installed (variable
"v") is closer than the one in the SPF tree (variable "route").
In the case something has gone wrong with the behavior of
Priority-Queue. */
/* the case where the route exists already is handled and returned
up to here. */
assert (route == NULL);
route = ospf6_route_create ();
memcpy (&route->prefix, &v->vertex_id, sizeof (struct prefix));
route->type = OSPF6_DEST_TYPE_LINKSTATE;
route->path.type = OSPF6_PATH_TYPE_INTRA;
route->path.origin.type = v->lsa->header->type;
route->path.origin.id = v->lsa->header->id;
route->path.origin.adv_router = v->lsa->header->adv_router;
route->path.metric_type = 1;
route->path.cost = v->cost;
route->path.cost_e2 = v->hops;
route->path.router_bits = v->capability;
route->path.options[0] = v->options[0];
route->path.options[1] = v->options[1];
route->path.options[2] = v->options[2];
for (i = 0; ospf6_nexthop_is_set (&v->nexthop[i]) &&
i < OSPF6_MULTI_PATH_LIMIT; i++)
ospf6_nexthop_copy (&route->nexthop[i], &v->nexthop[i]);
if (v->parent)
listnode_add_sort (v->parent->child_list, v);
route->route_option = v;
ospf6_route_add (route, result_table);
return 0;
}
void
ospf6_spf_table_finish (struct ospf6_route_table *result_table)
{
struct ospf6_route *route;
struct ospf6_vertex *v;
for (route = ospf6_route_head (result_table); route;
route = ospf6_route_next (route))
{
v = (struct ospf6_vertex *) route->route_option;
ospf6_vertex_delete (v);
ospf6_route_remove (route, result_table);
}
}
/* RFC2328 16.1. Calculating the shortest-path tree for an area */
/* RFC2740 3.8.1. Calculating the shortest path tree for an area */
void
ospf6_spf_calculation (u_int32_t router_id,
struct ospf6_route_table *result_table,
struct ospf6_area *oa)
{
struct pqueue *candidate_list;
struct ospf6_vertex *root, *v, *w;
int i;
int size;
caddr_t lsdesc;
struct ospf6_lsa *lsa;
/* initialize */
candidate_list = pqueue_create ();
candidate_list->cmp = ospf6_vertex_cmp;
ospf6_spf_table_finish (result_table);
/* Install the calculating router itself as the root of the SPF tree */
/* construct root vertex */
lsa = ospf6_lsdb_lookup (htons (OSPF6_LSTYPE_ROUTER), htonl (0),
router_id, oa->lsdb);
if (lsa == NULL)
return;
root = ospf6_vertex_create (lsa);
root->area = oa;
root->cost = 0;
root->hops = 0;
root->nexthop[0].ifindex = 0; /* loopbak I/F is better ... */
inet_pton (AF_INET6, "::1", &root->nexthop[0].address);
/* Actually insert root to the candidate-list as the only candidate */
pqueue_enqueue (root, candidate_list);
/* Iterate until candidate-list becomes empty */
while (candidate_list->size)
{
/* get closest candidate from priority queue */
v = pqueue_dequeue (candidate_list);
/* installing may result in merging or rejecting of the vertex */
if (ospf6_spf_install (v, result_table) < 0)
continue;
/* For each LS description in the just-added vertex V's LSA */
size = (VERTEX_IS_TYPE (ROUTER, v) ?
sizeof (struct ospf6_router_lsdesc) :
sizeof (struct ospf6_network_lsdesc));
for (lsdesc = OSPF6_LSA_HEADER_END (v->lsa->header) + 4;
lsdesc + size <= OSPF6_LSA_END (v->lsa->header); lsdesc += size)
{
lsa = ospf6_lsdesc_lsa (lsdesc, v);
if (lsa == NULL)
continue;
if (! ospf6_lsdesc_backlink (lsa, lsdesc, v))
continue;
w = ospf6_vertex_create (lsa);
w->area = oa;
w->parent = v;
if (VERTEX_IS_TYPE (ROUTER, v))
{
w->cost = v->cost + ROUTER_LSDESC_GET_METRIC (lsdesc);
w->hops = v->hops + (VERTEX_IS_TYPE (NETWORK, w) ? 0 : 1);
}
else /* NETWORK */
{
w->cost = v->cost;
w->hops = v->hops + 1;
}
/* nexthop calculation */
if (w->hops == 0)
w->nexthop[0].ifindex = ROUTER_LSDESC_GET_IFID (lsdesc);
else if (w->hops == 1 && v->hops == 0)
ospf6_nexthop_calc (w, v, lsdesc);
else
{
for (i = 0; ospf6_nexthop_is_set (&v->nexthop[i]) &&
i < OSPF6_MULTI_PATH_LIMIT; i++)
ospf6_nexthop_copy (&w->nexthop[i], &v->nexthop[i]);
}
/* add new candidate to the candidate_list */
if (IS_OSPF6_DEBUG_SPF (PROCESS))
zlog_debug (" New candidate: %s hops %d cost %d",
w->name, w->hops, w->cost);
pqueue_enqueue (w, candidate_list);
}
}
pqueue_delete (candidate_list);
}
static void
ospf6_spf_log_database (struct ospf6_area *oa)
{
char *p, *end, buffer[256];
struct listnode *node;
struct ospf6_interface *oi;
p = buffer;
end = buffer + sizeof (buffer);
snprintf (p, end - p, "SPF on DB (#LSAs):");
p = (buffer + strlen (buffer) < end ? buffer + strlen (buffer) : end);
snprintf (p, end - p, " Area %s: %d", oa->name, oa->lsdb->count);
p = (buffer + strlen (buffer) < end ? buffer + strlen (buffer) : end);
for (ALL_LIST_ELEMENTS_RO (oa->if_list, node, oi))
{
snprintf (p, end - p, " I/F %s: %d",
oi->interface->name, oi->lsdb->count);
p = (buffer + strlen (buffer) < end ? buffer + strlen (buffer) : end);
}
zlog_debug ("%s", buffer);
}
static int
ospf6_spf_calculation_thread (struct thread *t)
{
struct ospf6_area *oa;
struct timeval start, end, runtime;
oa = (struct ospf6_area *) THREAD_ARG (t);
oa->thread_spf_calculation = NULL;
if (IS_OSPF6_DEBUG_SPF (PROCESS))
zlog_debug ("SPF calculation for Area %s", oa->name);
if (IS_OSPF6_DEBUG_SPF (DATABASE))
ospf6_spf_log_database (oa);
/* execute SPF calculation */
quagga_gettime (QUAGGA_CLK_MONOTONIC, &start);
ospf6_spf_calculation (oa->ospf6->router_id, oa->spf_table, oa);
quagga_gettime (QUAGGA_CLK_MONOTONIC, &end);
timersub (&end, &start, &runtime);
if (IS_OSPF6_DEBUG_SPF (PROCESS) || IS_OSPF6_DEBUG_SPF (TIME))
zlog_debug ("SPF runtime: %ld sec %ld usec",
runtime.tv_sec, runtime.tv_usec);
ospf6_intra_route_calculation (oa);
ospf6_intra_brouter_calculation (oa);
return 0;
}
void
ospf6_spf_schedule (struct ospf6_area *oa)
{
if (oa->thread_spf_calculation)
return;
oa->thread_spf_calculation =
thread_add_event (master, ospf6_spf_calculation_thread, oa, 0);
}
void
ospf6_spf_display_subtree (struct vty *vty, const char *prefix, int rest,
struct ospf6_vertex *v)
{
struct listnode *node, *nnode;
struct ospf6_vertex *c;
char *next_prefix;
int len;
int restnum;
/* "prefix" is the space prefix of the display line */
vty_out (vty, "%s+-%s [%d]%s", prefix, v->name, v->cost, VNL);
len = strlen (prefix) + 4;
next_prefix = (char *) malloc (len);
if (next_prefix == NULL)
{
vty_out (vty, "malloc failed%s", VNL);
return;
}
snprintf (next_prefix, len, "%s%s", prefix, (rest ? "| " : " "));
restnum = listcount (v->child_list);
for (ALL_LIST_ELEMENTS (v->child_list, node, nnode, c))
{
restnum--;
ospf6_spf_display_subtree (vty, next_prefix, restnum, c);
}
free (next_prefix);
}
DEFUN (debug_ospf6_spf_process,
debug_ospf6_spf_process_cmd,
"debug ospf6 spf process",
DEBUG_STR
OSPF6_STR
"Debug SPF Calculation\n"
"Debug Detailed SPF Process\n"
)
{
unsigned char level = 0;
level = OSPF6_DEBUG_SPF_PROCESS;
OSPF6_DEBUG_SPF_ON (level);
return CMD_SUCCESS;
}
DEFUN (debug_ospf6_spf_time,
debug_ospf6_spf_time_cmd,
"debug ospf6 spf time",
DEBUG_STR
OSPF6_STR
"Debug SPF Calculation\n"
"Measure time taken by SPF Calculation\n"
)
{
unsigned char level = 0;
level = OSPF6_DEBUG_SPF_TIME;
OSPF6_DEBUG_SPF_ON (level);
return CMD_SUCCESS;
}
DEFUN (debug_ospf6_spf_database,
debug_ospf6_spf_database_cmd,
"debug ospf6 spf database",
DEBUG_STR
OSPF6_STR
"Debug SPF Calculation\n"
"Log number of LSAs at SPF Calculation time\n"
)
{
unsigned char level = 0;
level = OSPF6_DEBUG_SPF_DATABASE;
OSPF6_DEBUG_SPF_ON (level);
return CMD_SUCCESS;
}
DEFUN (no_debug_ospf6_spf_process,
no_debug_ospf6_spf_process_cmd,
"no debug ospf6 spf process",
NO_STR
DEBUG_STR
OSPF6_STR
"Quit Debugging SPF Calculation\n"
"Quit Debugging Detailed SPF Process\n"
)
{
unsigned char level = 0;
level = OSPF6_DEBUG_SPF_PROCESS;
OSPF6_DEBUG_SPF_OFF (level);
return CMD_SUCCESS;
}
DEFUN (no_debug_ospf6_spf_time,
no_debug_ospf6_spf_time_cmd,
"no debug ospf6 spf time",
NO_STR
DEBUG_STR
OSPF6_STR
"Quit Debugging SPF Calculation\n"
"Quit Measuring time taken by SPF Calculation\n"
)
{
unsigned char level = 0;
level = OSPF6_DEBUG_SPF_TIME;
OSPF6_DEBUG_SPF_OFF (level);
return CMD_SUCCESS;
}
DEFUN (no_debug_ospf6_spf_database,
no_debug_ospf6_spf_database_cmd,
"no debug ospf6 spf database",
NO_STR
DEBUG_STR
OSPF6_STR
"Debug SPF Calculation\n"
"Quit Logging number of LSAs at SPF Calculation time\n"
)
{
unsigned char level = 0;
level = OSPF6_DEBUG_SPF_DATABASE;
OSPF6_DEBUG_SPF_OFF (level);
return CMD_SUCCESS;
}
int
config_write_ospf6_debug_spf (struct vty *vty)
{
if (IS_OSPF6_DEBUG_SPF (PROCESS))
vty_out (vty, "debug ospf6 spf process%s", VNL);
if (IS_OSPF6_DEBUG_SPF (TIME))
vty_out (vty, "debug ospf6 spf time%s", VNL);
if (IS_OSPF6_DEBUG_SPF (DATABASE))
vty_out (vty, "debug ospf6 spf database%s", VNL);
return 0;
}
void
install_element_ospf6_debug_spf (void)
{
install_element (ENABLE_NODE, &debug_ospf6_spf_process_cmd);
install_element (ENABLE_NODE, &debug_ospf6_spf_time_cmd);
install_element (ENABLE_NODE, &debug_ospf6_spf_database_cmd);
install_element (ENABLE_NODE, &no_debug_ospf6_spf_process_cmd);
install_element (ENABLE_NODE, &no_debug_ospf6_spf_time_cmd);
install_element (ENABLE_NODE, &no_debug_ospf6_spf_database_cmd);
install_element (CONFIG_NODE, &debug_ospf6_spf_process_cmd);
install_element (CONFIG_NODE, &debug_ospf6_spf_time_cmd);
install_element (CONFIG_NODE, &debug_ospf6_spf_database_cmd);
install_element (CONFIG_NODE, &no_debug_ospf6_spf_process_cmd);
install_element (CONFIG_NODE, &no_debug_ospf6_spf_time_cmd);
install_element (CONFIG_NODE, &no_debug_ospf6_spf_database_cmd);
}
void
ospf6_spf_init (void)
{
}