[mirror_frr.git] / zebra / zebra_pw.c

/* Zebra PW code
 * Copyright (C) 2016 Volta Networks, Inc.
 *
 * This program 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 of the License, or
 * (at your option) any later version.
 *
 * This program 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 this program; see the file COPYING; if not, write to the
 * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
 * MA 02110-1301 USA
 */

#include <zebra.h>

#include "log.h"
#include "memory.h"
#include "thread.h"
#include "command.h"
#include "vrf.h"

#include "zebra/debug.h"
#include "zebra/rib.h"
#include "zebra/zserv.h"
#include "zebra/zapi_msg.h"
#include "zebra/zebra_rnh.h"
#include "zebra/zebra_vrf.h"
#include "zebra/zebra_pw.h"

DEFINE_MTYPE_STATIC(LIB, PW, "Pseudowire")

DEFINE_QOBJ_TYPE(zebra_pw)

DEFINE_HOOK(pw_install, (struct zebra_pw * pw), (pw))
DEFINE_HOOK(pw_uninstall, (struct zebra_pw * pw), (pw))

#define MPLS_NO_LABEL MPLS_INVALID_LABEL

extern struct zebra_t zebrad;

static int zebra_pw_enabled(struct zebra_pw *);
static void zebra_pw_install(struct zebra_pw *);
static void zebra_pw_uninstall(struct zebra_pw *);
static int zebra_pw_install_retry(struct thread *);
static int zebra_pw_check_reachability(struct zebra_pw *);
static void zebra_pw_update_status(struct zebra_pw *, int);

static inline int zebra_pw_compare(const struct zebra_pw *a,
				   const struct zebra_pw *b)
{
	return (strcmp(a->ifname, b->ifname));
}

RB_GENERATE(zebra_pw_head, zebra_pw, pw_entry, zebra_pw_compare)
RB_GENERATE(zebra_static_pw_head, zebra_pw, static_pw_entry, zebra_pw_compare)

struct zebra_pw *zebra_pw_add(struct zebra_vrf *zvrf, const char *ifname,
			      uint8_t protocol, struct zserv *client)
{
	struct zebra_pw *pw;

	if (IS_ZEBRA_DEBUG_PW)
		zlog_debug("%u: adding pseudowire %s protocol %s",
			   zvrf_id(zvrf), ifname, zebra_route_string(protocol));

	pw = XCALLOC(MTYPE_PW, sizeof(*pw));
	strlcpy(pw->ifname, ifname, sizeof(pw->ifname));
	pw->protocol = protocol;
	pw->vrf_id = zvrf_id(zvrf);
	pw->client = client;
	pw->status = PW_STATUS_DOWN;
	pw->local_label = MPLS_NO_LABEL;
	pw->remote_label = MPLS_NO_LABEL;
	pw->flags = F_PSEUDOWIRE_CWORD;

	RB_INSERT(zebra_pw_head, &zvrf->pseudowires, pw);
	if (pw->protocol == ZEBRA_ROUTE_STATIC) {
		RB_INSERT(zebra_static_pw_head, &zvrf->static_pseudowires, pw);
		QOBJ_REG(pw, zebra_pw);
	}

	return pw;
}

void zebra_pw_del(struct zebra_vrf *zvrf, struct zebra_pw *pw)
{
	if (IS_ZEBRA_DEBUG_PW)
		zlog_debug("%u: deleting pseudowire %s protocol %s", pw->vrf_id,
			   pw->ifname, zebra_route_string(pw->protocol));

	/* remove nexthop tracking */
	zebra_deregister_rnh_pseudowire(pw->vrf_id, pw);

	/* uninstall */
	if (pw->status == PW_STATUS_UP)
		hook_call(pw_uninstall, pw);
	else if (pw->install_retry_timer)
		THREAD_TIMER_OFF(pw->install_retry_timer);

	/* unlink and release memory */
	RB_REMOVE(zebra_pw_head, &zvrf->pseudowires, pw);
	if (pw->protocol == ZEBRA_ROUTE_STATIC)
		RB_REMOVE(zebra_static_pw_head, &zvrf->static_pseudowires, pw);
	XFREE(MTYPE_PW, pw);
}

void zebra_pw_change(struct zebra_pw *pw, ifindex_t ifindex, int type, int af,
		     union g_addr *nexthop, uint32_t local_label,
		     uint32_t remote_label, uint8_t flags,
		     union pw_protocol_fields *data)
{
	zebra_deregister_rnh_pseudowire(pw->vrf_id, pw);

	pw->ifindex = ifindex;
	pw->type = type;
	pw->af = af;
	pw->nexthop = *nexthop;
	pw->local_label = local_label;
	pw->remote_label = remote_label;
	pw->flags = flags;
	pw->data = *data;

	if (zebra_pw_enabled(pw))
		zebra_register_rnh_pseudowire(pw->vrf_id, pw);
	else
		zebra_pw_uninstall(pw);
}

struct zebra_pw *zebra_pw_find(struct zebra_vrf *zvrf, const char *ifname)
{
	struct zebra_pw pw;
	strlcpy(pw.ifname, ifname, sizeof(pw.ifname));
	return (RB_FIND(zebra_pw_head, &zvrf->pseudowires, &pw));
}

static int zebra_pw_enabled(struct zebra_pw *pw)
{
	if (pw->protocol == ZEBRA_ROUTE_STATIC) {
		if (pw->local_label == MPLS_NO_LABEL
		    || pw->remote_label == MPLS_NO_LABEL || pw->af == AF_UNSPEC)
			return 0;
		return 1;
	} else
		return pw->enabled;
}

void zebra_pw_update(struct zebra_pw *pw)
{
	if (zebra_pw_check_reachability(pw) < 0) {
		zebra_pw_uninstall(pw);
		/* wait for NHT and try again later */
	} else {
		/*
		 * Install or reinstall the pseudowire (e.g. to update
		 * parameters like the nexthop or the use of the control word).
		 */
		zebra_pw_install(pw);
	}
}

static void zebra_pw_install(struct zebra_pw *pw)
{
	if (IS_ZEBRA_DEBUG_PW)
		zlog_debug("%u: installing pseudowire %s protocol %s",
			   pw->vrf_id, pw->ifname,
			   zebra_route_string(pw->protocol));

	if (hook_call(pw_install, pw)) {
		zebra_pw_install_failure(pw);
		return;
	}

	if (pw->status == PW_STATUS_DOWN)
		zebra_pw_update_status(pw, PW_STATUS_UP);
}

static void zebra_pw_uninstall(struct zebra_pw *pw)
{
	if (pw->status == PW_STATUS_DOWN)
		return;

	if (IS_ZEBRA_DEBUG_PW)
		zlog_debug("%u: uninstalling pseudowire %s protocol %s",
			   pw->vrf_id, pw->ifname,
			   zebra_route_string(pw->protocol));

	/* ignore any possible error */
	hook_call(pw_uninstall, pw);

	if (zebra_pw_enabled(pw))
		zebra_pw_update_status(pw, PW_STATUS_DOWN);
}

/*
 * Installation of the pseudowire in the kernel or hardware has failed. This
 * function will notify the pseudowire client about the failure and schedule
 * to retry the installation later. This function can be called by an external
 * agent that performs the pseudowire installation in an asynchronous way.
 */
void zebra_pw_install_failure(struct zebra_pw *pw)
{
	if (IS_ZEBRA_DEBUG_PW)
		zlog_debug(
			"%u: failed installing pseudowire %s, "
			"scheduling retry in %u seconds",
			pw->vrf_id, pw->ifname, PW_INSTALL_RETRY_INTERVAL);

	/* schedule to retry later */
	THREAD_TIMER_OFF(pw->install_retry_timer);
	thread_add_timer(zebrad.master, zebra_pw_install_retry, pw,
			 PW_INSTALL_RETRY_INTERVAL, &pw->install_retry_timer);

	zebra_pw_update_status(pw, PW_STATUS_DOWN);
}

static int zebra_pw_install_retry(struct thread *thread)
{
	struct zebra_pw *pw = THREAD_ARG(thread);

	pw->install_retry_timer = NULL;
	zebra_pw_install(pw);

	return 0;
}

static void zebra_pw_update_status(struct zebra_pw *pw, int status)
{
	pw->status = status;
	if (pw->client)
		zsend_pw_update(pw->client, pw);
}

static int zebra_pw_check_reachability(struct zebra_pw *pw)
{
	struct route_entry *re;
	struct nexthop *nexthop;

	/* TODO: consider GRE/L2TPv3 tunnels in addition to MPLS LSPs */

	/* find route to the remote end of the pseudowire */
	re = rib_match(family2afi(pw->af), SAFI_UNICAST, pw->vrf_id,
		       &pw->nexthop, NULL);
	if (!re) {
		if (IS_ZEBRA_DEBUG_PW)
			zlog_debug("%s: no route found for %s", __func__,
				   pw->ifname);
		return -1;
	}

	/*
	 * Need to ensure that there's a label binding for all nexthops.
	 * Otherwise, ECMP for this route could render the pseudowire unusable.
	 */
	for (ALL_NEXTHOPS(re->ng, nexthop)) {
		if (!nexthop->nh_label) {
			if (IS_ZEBRA_DEBUG_PW)
				zlog_debug("%s: unlabeled route for %s",
					   __func__, pw->ifname);
			return -1;
		}
	}

	return 0;
}

static int zebra_pw_client_close(struct zserv *client)
{
	struct vrf *vrf;
	struct zebra_vrf *zvrf;
	struct zebra_pw *pw, *tmp;

	RB_FOREACH (vrf, vrf_id_head, &vrfs_by_id) {
		zvrf = vrf->info;
		RB_FOREACH_SAFE (pw, zebra_pw_head, &zvrf->pseudowires, tmp) {
			if (pw->client != client)
				continue;
			zebra_pw_del(zvrf, pw);
		}
	}

	return 0;
}

void zebra_pw_init(struct zebra_vrf *zvrf)
{
	RB_INIT(zebra_pw_head, &zvrf->pseudowires);
	RB_INIT(zebra_static_pw_head, &zvrf->static_pseudowires);

	hook_register(zserv_client_close, zebra_pw_client_close);
}

void zebra_pw_exit(struct zebra_vrf *zvrf)
{
	struct zebra_pw *pw;

	while (!RB_EMPTY(zebra_pw_head, &zvrf->pseudowires)) {
		pw = RB_ROOT(zebra_pw_head, &zvrf->pseudowires);

		zebra_pw_del(zvrf, pw);
	}
}

DEFUN_NOSH (pseudowire_if,
	    pseudowire_if_cmd,
	    "pseudowire IFNAME",
	    "Static pseudowire configuration\n"
	    "Pseudowire name\n")
{
	struct zebra_vrf *zvrf;
	struct zebra_pw *pw;
	const char *ifname;
	int idx = 0;

	zvrf = vrf_info_lookup(VRF_DEFAULT);
	if (!zvrf)
		return CMD_WARNING;

	argv_find(argv, argc, "IFNAME", &idx);
	ifname = argv[idx]->arg;

	pw = zebra_pw_find(zvrf, ifname);
	if (pw && pw->protocol != ZEBRA_ROUTE_STATIC) {
		vty_out(vty, "%% Pseudowire is not static\n");
		return CMD_WARNING;
	}

	if (!pw)
		pw = zebra_pw_add(zvrf, ifname, ZEBRA_ROUTE_STATIC, NULL);
	VTY_PUSH_CONTEXT(PW_NODE, pw);

	return CMD_SUCCESS;
}

DEFUN (no_pseudowire_if,
       no_pseudowire_if_cmd,
       "no pseudowire IFNAME",
       NO_STR
       "Static pseudowire configuration\n"
       "Pseudowire name\n")
{
	struct zebra_vrf *zvrf;
	struct zebra_pw *pw;
	const char *ifname;
	int idx = 0;

	zvrf = vrf_info_lookup(VRF_DEFAULT);
	if (!zvrf)
		return CMD_WARNING;

	argv_find(argv, argc, "IFNAME", &idx);
	ifname = argv[idx]->arg;

	pw = zebra_pw_find(zvrf, ifname);
	if (pw) {
		if (pw->protocol != ZEBRA_ROUTE_STATIC) {
			vty_out(vty, "%% Pseudowire is not static\n");
			return CMD_WARNING;
		}
		zebra_pw_del(zvrf, pw);
	}

	return CMD_SUCCESS;
}

DEFUN (pseudowire_labels,
       pseudowire_labels_cmd,
       "[no] mpls label local (16-1048575) remote (16-1048575)",
       NO_STR
       "MPLS L2VPN PW command\n"
       "MPLS L2VPN static labels\n"
       "Local pseudowire label\n"
       "Local pseudowire label\n"
       "Remote pseudowire label\n"
       "Remote pseudowire label\n")
{
	VTY_DECLVAR_CONTEXT(zebra_pw, pw);
	int idx = 0;
	mpls_label_t local_label, remote_label;

	if (argv_find(argv, argc, "no", &idx)) {
		local_label = MPLS_NO_LABEL;
		remote_label = MPLS_NO_LABEL;
	} else {
		argv_find(argv, argc, "local", &idx);
		local_label = atoi(argv[idx + 1]->arg);
		argv_find(argv, argc, "remote", &idx);
		remote_label = atoi(argv[idx + 1]->arg);
	}

	zebra_pw_change(pw, pw->ifindex, pw->type, pw->af, &pw->nexthop,
			local_label, remote_label, pw->flags, &pw->data);

	return CMD_SUCCESS;
}

DEFUN (pseudowire_neighbor,
       pseudowire_neighbor_cmd,
       "[no] neighbor <A.B.C.D|X:X::X:X>",
       NO_STR
       "Specify the IPv4 or IPv6 address of the remote endpoint\n"
       "IPv4 address\n"
       "IPv6 address\n")
{
	VTY_DECLVAR_CONTEXT(zebra_pw, pw);
	int idx = 0;
	const char *address;
	int af;
	union g_addr nexthop;

	af = AF_UNSPEC;
	memset(&nexthop, 0, sizeof(nexthop));

	if (!argv_find(argv, argc, "no", &idx)) {
		argv_find(argv, argc, "neighbor", &idx);
		address = argv[idx + 1]->arg;

		if (inet_pton(AF_INET, address, &nexthop.ipv4) == 1)
			af = AF_INET;
		else if (inet_pton(AF_INET6, address, &nexthop.ipv6) == 1)
			af = AF_INET6;
		else {
			vty_out(vty, "%% Malformed address\n");
			return CMD_WARNING;
		}
	}

	zebra_pw_change(pw, pw->ifindex, pw->type, af, &nexthop,
			pw->local_label, pw->remote_label, pw->flags,
			&pw->data);

	return CMD_SUCCESS;
}

DEFUN (pseudowire_control_word,
       pseudowire_control_word_cmd,
       "[no] control-word <exclude|include>",
       NO_STR
       "Control-word options\n"
       "Exclude control-word in pseudowire packets\n"
       "Include control-word in pseudowire packets\n")
{
	VTY_DECLVAR_CONTEXT(zebra_pw, pw);
	int idx = 0;
	uint8_t flags = 0;

	if (argv_find(argv, argc, "no", &idx))
		flags = F_PSEUDOWIRE_CWORD;
	else {
		argv_find(argv, argc, "control-word", &idx);
		if (argv[idx + 1]->text[0] == 'i')
			flags = F_PSEUDOWIRE_CWORD;
	}

	zebra_pw_change(pw, pw->ifindex, pw->type, pw->af, &pw->nexthop,
			pw->local_label, pw->remote_label, flags, &pw->data);

	return CMD_SUCCESS;
}

DEFUN (show_pseudowires,
       show_pseudowires_cmd,
       "show mpls pseudowires",
       SHOW_STR
       MPLS_STR
       "Pseudowires\n")
{
	struct zebra_vrf *zvrf;
	struct zebra_pw *pw;

	zvrf = vrf_info_lookup(VRF_DEFAULT);
	if (!zvrf)
		return 0;

	vty_out(vty, "%-16s %-24s %-12s %-8s %-10s\n", "Interface", "Neighbor",
		"Labels", "Protocol", "Status");

	RB_FOREACH (pw, zebra_pw_head, &zvrf->pseudowires) {
		char buf_nbr[INET6_ADDRSTRLEN];
		char buf_labels[64];

		inet_ntop(pw->af, &pw->nexthop, buf_nbr, sizeof(buf_nbr));

		if (pw->local_label != MPLS_NO_LABEL
		    && pw->remote_label != MPLS_NO_LABEL)
			snprintf(buf_labels, sizeof(buf_labels), "%u/%u",
				 pw->local_label, pw->remote_label);
		else
			snprintf(buf_labels, sizeof(buf_labels), "-");

		vty_out(vty, "%-16s %-24s %-12s %-8s %-10s\n", pw->ifname,
			(pw->af != AF_UNSPEC) ? buf_nbr : "-", buf_labels,
			zebra_route_string(pw->protocol),
			(zebra_pw_enabled(pw) && pw->status == PW_STATUS_UP)
				? "UP"
				: "DOWN");
	}

	return CMD_SUCCESS;
}

/* Pseudowire configuration write function. */
static int zebra_pw_config(struct vty *vty)
{
	int write = 0;
	struct zebra_vrf *zvrf;
	struct zebra_pw *pw;

	zvrf = vrf_info_lookup(VRF_DEFAULT);
	if (!zvrf)
		return 0;

	RB_FOREACH (pw, zebra_static_pw_head, &zvrf->static_pseudowires) {
		vty_out(vty, "pseudowire %s\n", pw->ifname);
		if (pw->local_label != MPLS_NO_LABEL
		    && pw->remote_label != MPLS_NO_LABEL)
			vty_out(vty, " mpls label local %u remote %u\n",
				pw->local_label, pw->remote_label);
		else
			vty_out(vty,
				" ! Incomplete config, specify the static "
				"MPLS labels\n");

		if (pw->af != AF_UNSPEC) {
			char buf[INET6_ADDRSTRLEN];
			inet_ntop(pw->af, &pw->nexthop, buf, sizeof(buf));
			vty_out(vty, " neighbor %s\n", buf);
		} else
			vty_out(vty,
				" ! Incomplete config, specify a neighbor "
				"address\n");

		if (!(pw->flags & F_PSEUDOWIRE_CWORD))
			vty_out(vty, " control-word exclude\n");

		vty_out(vty, "!\n");
		write = 1;
	}

	return write;
}

static struct cmd_node pw_node = {
	PW_NODE, "%s(config-pw)# ", 1,
};

void zebra_pw_vty_init(void)
{
	install_node(&pw_node, zebra_pw_config);
	install_default(PW_NODE);

	install_element(CONFIG_NODE, &pseudowire_if_cmd);
	install_element(CONFIG_NODE, &no_pseudowire_if_cmd);
	install_element(PW_NODE, &pseudowire_labels_cmd);
	install_element(PW_NODE, &pseudowire_neighbor_cmd);
	install_element(PW_NODE, &pseudowire_control_word_cmd);

	install_element(VIEW_NODE, &show_pseudowires_cmd);
}
Commit	Line	Data
6833ae01	1	/* Zebra PW code
	2	* Copyright (C) 2016 Volta Networks, Inc.
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License as published by
	6	* the Free Software Foundation; either version 2 of the License, or
	7	* (at your option) any later version.
	8	*
	9	* This program is distributed in the hope that it will be useful, but
	10	* WITHOUT ANY WARRANTY; without even the implied warranty of
	11	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	12	* General Public License for more details.
	13	*
	14	* You should have received a copy of the GNU General Public License
	15	* along with this program; see the file COPYING; if not, write to the
	16	* Free Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
	17	* MA 02110-1301 USA
	18	*/
	19
	20	#include <zebra.h>
	21
	22	#include "log.h"
	23	#include "memory.h"
	24	#include "thread.h"
2dd0d726	25	#include "command.h"
6833ae01	26	#include "vrf.h"
	27
	28	#include "zebra/debug.h"
	29	#include "zebra/rib.h"
	30	#include "zebra/zserv.h"
bf094f69	31	#include "zebra/zapi_msg.h"
731a75fe	32	#include "zebra/zebra_rnh.h"
6833ae01	33	#include "zebra/zebra_vrf.h"
	34	#include "zebra/zebra_pw.h"
	35
	36	DEFINE_MTYPE_STATIC(LIB, PW, "Pseudowire")
	37
2dd0d726 RW	38	DEFINE_QOBJ_TYPE(zebra_pw)
2dd0d726 RW	39
6833ae01	40	DEFINE_HOOK(pw_install, (struct zebra_pw * pw), (pw))
	41	DEFINE_HOOK(pw_uninstall, (struct zebra_pw * pw), (pw))
	42
69965f53 DL	43	#define MPLS_NO_LABEL MPLS_INVALID_LABEL
69965f53 DL	44
6833ae01	45	extern struct zebra_t zebrad;
6833ae01	46
2dd0d726	47	static int zebra_pw_enabled(struct zebra_pw *);
6833ae01	48	static void zebra_pw_install(struct zebra_pw *);
	49	static void zebra_pw_uninstall(struct zebra_pw *);
	50	static int zebra_pw_install_retry(struct thread *);
	51	static int zebra_pw_check_reachability(struct zebra_pw *);
	52	static void zebra_pw_update_status(struct zebra_pw *, int);
	53
	54	static inline int zebra_pw_compare(const struct zebra_pw *a,
	55	const struct zebra_pw *b)
	56	{
	57	return (strcmp(a->ifname, b->ifname));
	58	}
	59
2dd0d726 RW	60	RB_GENERATE(zebra_pw_head, zebra_pw, pw_entry, zebra_pw_compare)
2dd0d726 RW	61	RB_GENERATE(zebra_static_pw_head, zebra_pw, static_pw_entry, zebra_pw_compare)
6833ae01	62
	63	struct zebra_pw zebra_pw_add(struct zebra_vrf zvrf, const char *ifname,
	64	uint8_t protocol, struct zserv *client)
	65	{
	66	struct zebra_pw *pw;
	67
	68	if (IS_ZEBRA_DEBUG_PW)
	69	zlog_debug("%u: adding pseudowire %s protocol %s",
	70	zvrf_id(zvrf), ifname, zebra_route_string(protocol));
	71
	72	pw = XCALLOC(MTYPE_PW, sizeof(*pw));
	73	strlcpy(pw->ifname, ifname, sizeof(pw->ifname));
	74	pw->protocol = protocol;
	75	pw->vrf_id = zvrf_id(zvrf);
	76	pw->client = client;
3c5b5220	77	pw->status = PW_STATUS_DOWN;
2dd0d726 RW	78	pw->local_label = MPLS_NO_LABEL;
	79	pw->remote_label = MPLS_NO_LABEL;
	80	pw->flags = F_PSEUDOWIRE_CWORD;
6833ae01	81
6833ae01	82	RB_INSERT(zebra_pw_head, &zvrf->pseudowires, pw);
2dd0d726 RW	83	if (pw->protocol == ZEBRA_ROUTE_STATIC) {
	84	RB_INSERT(zebra_static_pw_head, &zvrf->static_pseudowires, pw);
	85	QOBJ_REG(pw, zebra_pw);
	86	}
6833ae01	87
	88	return pw;
	89	}
	90
	91	void zebra_pw_del(struct zebra_vrf zvrf, struct zebra_pw pw)
	92	{
	93	if (IS_ZEBRA_DEBUG_PW)
	94	zlog_debug("%u: deleting pseudowire %s protocol %s", pw->vrf_id,
	95	pw->ifname, zebra_route_string(pw->protocol));
	96
731a75fe RW	97	/* remove nexthop tracking */
	98	zebra_deregister_rnh_pseudowire(pw->vrf_id, pw);
	99
6833ae01	100	/* uninstall */
	101	if (pw->status == PW_STATUS_UP)
	102	hook_call(pw_uninstall, pw);
	103	else if (pw->install_retry_timer)
	104	THREAD_TIMER_OFF(pw->install_retry_timer);
	105
	106	/* unlink and release memory */
	107	RB_REMOVE(zebra_pw_head, &zvrf->pseudowires, pw);
2dd0d726 RW	108	if (pw->protocol == ZEBRA_ROUTE_STATIC)
2dd0d726 RW	109	RB_REMOVE(zebra_static_pw_head, &zvrf->static_pseudowires, pw);
6833ae01	110	XFREE(MTYPE_PW, pw);
	111	}
	112
	113	void zebra_pw_change(struct zebra_pw *pw, ifindex_t ifindex, int type, int af,
	114	union g_addr *nexthop, uint32_t local_label,
	115	uint32_t remote_label, uint8_t flags,
	116	union pw_protocol_fields *data)
	117	{
731a75fe RW	118	zebra_deregister_rnh_pseudowire(pw->vrf_id, pw);
731a75fe RW	119
6833ae01	120	pw->ifindex = ifindex;
	121	pw->type = type;
	122	pw->af = af;
	123	pw->nexthop = *nexthop;
	124	pw->local_label = local_label;
	125	pw->remote_label = remote_label;
	126	pw->flags = flags;
	127	pw->data = *data;
	128
2dd0d726	129	if (zebra_pw_enabled(pw))
731a75fe	130	zebra_register_rnh_pseudowire(pw->vrf_id, pw);
6833ae01	131	else
	132	zebra_pw_uninstall(pw);
	133	}
	134
	135	struct zebra_pw zebra_pw_find(struct zebra_vrf zvrf, const char *ifname)
	136	{
	137	struct zebra_pw pw;
	138	strlcpy(pw.ifname, ifname, sizeof(pw.ifname));
	139	return (RB_FIND(zebra_pw_head, &zvrf->pseudowires, &pw));
	140	}
	141
2dd0d726 RW	142	static int zebra_pw_enabled(struct zebra_pw *pw)
	143	{
	144	if (pw->protocol == ZEBRA_ROUTE_STATIC) {
	145	if (pw->local_label == MPLS_NO_LABEL
	146	\|\| pw->remote_label == MPLS_NO_LABEL \|\| pw->af == AF_UNSPEC)
	147	return 0;
	148	return 1;
	149	} else
	150	return pw->enabled;
	151	}
	152
6833ae01	153	void zebra_pw_update(struct zebra_pw *pw)
	154	{
	155	if (zebra_pw_check_reachability(pw) < 0) {
	156	zebra_pw_uninstall(pw);
731a75fe	157	/* wait for NHT and try again later */
6833ae01	158	} else {
	159	/*
	160	* Install or reinstall the pseudowire (e.g. to update
	161	* parameters like the nexthop or the use of the control word).
	162	*/
	163	zebra_pw_install(pw);
	164	}
	165	}
	166
	167	static void zebra_pw_install(struct zebra_pw *pw)
	168	{
	169	if (IS_ZEBRA_DEBUG_PW)
	170	zlog_debug("%u: installing pseudowire %s protocol %s",
	171	pw->vrf_id, pw->ifname,
	172	zebra_route_string(pw->protocol));
	173
	174	if (hook_call(pw_install, pw)) {
	175	zebra_pw_install_failure(pw);
	176	return;
	177	}
	178
	179	if (pw->status == PW_STATUS_DOWN)
	180	zebra_pw_update_status(pw, PW_STATUS_UP);
	181	}
	182
	183	static void zebra_pw_uninstall(struct zebra_pw *pw)
	184	{
	185	if (pw->status == PW_STATUS_DOWN)
	186	return;
	187
	188	if (IS_ZEBRA_DEBUG_PW)
	189	zlog_debug("%u: uninstalling pseudowire %s protocol %s",
	190	pw->vrf_id, pw->ifname,
	191	zebra_route_string(pw->protocol));
	192
	193	/* ignore any possible error */
	194	hook_call(pw_uninstall, pw);
	195
2dd0d726	196	if (zebra_pw_enabled(pw))
6833ae01	197	zebra_pw_update_status(pw, PW_STATUS_DOWN);
	198	}
	199
	200	/*
	201	* Installation of the pseudowire in the kernel or hardware has failed. This
	202	* function will notify the pseudowire client about the failure and schedule
	203	* to retry the installation later. This function can be called by an external
	204	* agent that performs the pseudowire installation in an asynchronous way.
	205	*/
	206	void zebra_pw_install_failure(struct zebra_pw *pw)
	207	{
	208	if (IS_ZEBRA_DEBUG_PW)
	209	zlog_debug(
	210	"%u: failed installing pseudowire %s, "
	211	"scheduling retry in %u seconds",
	212	pw->vrf_id, pw->ifname, PW_INSTALL_RETRY_INTERVAL);
	213
	214	/* schedule to retry later */
	215	THREAD_TIMER_OFF(pw->install_retry_timer);
69965f53 DL	216	thread_add_timer(zebrad.master, zebra_pw_install_retry, pw,
69965f53 DL	217	PW_INSTALL_RETRY_INTERVAL, &pw->install_retry_timer);
6833ae01	218
	219	zebra_pw_update_status(pw, PW_STATUS_DOWN);
	220	}
	221
	222	static int zebra_pw_install_retry(struct thread *thread)
	223	{
	224	struct zebra_pw *pw = THREAD_ARG(thread);
	225
	226	pw->install_retry_timer = NULL;
	227	zebra_pw_install(pw);
	228
	229	return 0;
	230	}
	231
	232	static void zebra_pw_update_status(struct zebra_pw *pw, int status)
	233	{
	234	pw->status = status;
	235	if (pw->client)
	236	zsend_pw_update(pw->client, pw);
	237	}
	238
	239	static int zebra_pw_check_reachability(struct zebra_pw *pw)
	240	{
69965f53 DL	241	struct route_entry *re;
69965f53 DL	242	struct nexthop *nexthop;
6833ae01	243
	244	/* TODO: consider GRE/L2TPv3 tunnels in addition to MPLS LSPs */
	245
	246	/* find route to the remote end of the pseudowire */
69965f53 DL	247	re = rib_match(family2afi(pw->af), SAFI_UNICAST, pw->vrf_id,
	248	&pw->nexthop, NULL);
	249	if (!re) {
6833ae01	250	if (IS_ZEBRA_DEBUG_PW)
9df414fe QY	251	zlog_debug("%s: no route found for %s", __func__,
9df414fe QY	252	pw->ifname);
6833ae01	253	return -1;
	254	}
	255
	256	/*
	257	* Need to ensure that there's a label binding for all nexthops.
	258	* Otherwise, ECMP for this route could render the pseudowire unusable.
	259	*/
7ee30f28	260	for (ALL_NEXTHOPS(re->ng, nexthop)) {
6833ae01	261	if (!nexthop->nh_label) {
6833ae01	262	if (IS_ZEBRA_DEBUG_PW)
9df414fe QY	263	zlog_debug("%s: unlabeled route for %s",
9df414fe QY	264	__func__, pw->ifname);
6833ae01	265	return -1;
	266	}
	267	}
	268
	269	return 0;
	270	}
	271
453844ab	272	static int zebra_pw_client_close(struct zserv *client)
6833ae01	273	{
	274	struct vrf *vrf;
	275	struct zebra_vrf *zvrf;
	276	struct zebra_pw pw, tmp;
	277
a2addae8	278	RB_FOREACH (vrf, vrf_id_head, &vrfs_by_id) {
6833ae01	279	zvrf = vrf->info;
a2addae8	280	RB_FOREACH_SAFE (pw, zebra_pw_head, &zvrf->pseudowires, tmp) {
6833ae01	281	if (pw->client != client)
	282	continue;
	283	zebra_pw_del(zvrf, pw);
	284	}
	285	}
453844ab QY	286
453844ab QY	287	return 0;
6833ae01	288	}
	289
	290	void zebra_pw_init(struct zebra_vrf *zvrf)
	291	{
69965f53 DL	292	RB_INIT(zebra_pw_head, &zvrf->pseudowires);
69965f53 DL	293	RB_INIT(zebra_static_pw_head, &zvrf->static_pseudowires);
453844ab	294
21ccc0cf	295	hook_register(zserv_client_close, zebra_pw_client_close);
6833ae01	296	}
	297
	298	void zebra_pw_exit(struct zebra_vrf *zvrf)
	299	{
	300	struct zebra_pw *pw;
	301
55cd0f61 DS	302	while (!RB_EMPTY(zebra_pw_head, &zvrf->pseudowires)) {
	303	pw = RB_ROOT(zebra_pw_head, &zvrf->pseudowires);
	304
6833ae01	305	zebra_pw_del(zvrf, pw);
55cd0f61	306	}
6833ae01	307	}
2dd0d726 RW	308
	309	DEFUN_NOSH (pseudowire_if,
	310	pseudowire_if_cmd,
1e9d1183	311	"pseudowire IFNAME",
2dd0d726 RW	312	"Static pseudowire configuration\n"
	313	"Pseudowire name\n")
	314	{
	315	struct zebra_vrf *zvrf;
	316	struct zebra_pw *pw;
2dd0d726	317	const char *ifname;
1e9d1183	318	int idx = 0;
2dd0d726 RW	319
	320	zvrf = vrf_info_lookup(VRF_DEFAULT);
	321	if (!zvrf)
	322	return CMD_WARNING;
	323
	324	argv_find(argv, argc, "IFNAME", &idx);
	325	ifname = argv[idx]->arg;
1e9d1183	326
2dd0d726 RW	327	pw = zebra_pw_find(zvrf, ifname);
2dd0d726 RW	328	if (pw && pw->protocol != ZEBRA_ROUTE_STATIC) {
69965f53	329	vty_out(vty, "%% Pseudowire is not static\n");
2dd0d726 RW	330	return CMD_WARNING;
	331	}
	332
2dd0d726 RW	333	if (!pw)
	334	pw = zebra_pw_add(zvrf, ifname, ZEBRA_ROUTE_STATIC, NULL);
	335	VTY_PUSH_CONTEXT(PW_NODE, pw);
	336
	337	return CMD_SUCCESS;
	338	}
	339
1e9d1183 RW	340	DEFUN (no_pseudowire_if,
	341	no_pseudowire_if_cmd,
	342	"no pseudowire IFNAME",
	343	NO_STR
	344	"Static pseudowire configuration\n"
	345	"Pseudowire name\n")
	346	{
	347	struct zebra_vrf *zvrf;
	348	struct zebra_pw *pw;
	349	const char *ifname;
	350	int idx = 0;
	351
	352	zvrf = vrf_info_lookup(VRF_DEFAULT);
	353	if (!zvrf)
	354	return CMD_WARNING;
	355
	356	argv_find(argv, argc, "IFNAME", &idx);
	357	ifname = argv[idx]->arg;
	358
	359	pw = zebra_pw_find(zvrf, ifname);
	360	if (pw) {
	361	if (pw->protocol != ZEBRA_ROUTE_STATIC) {
	362	vty_out(vty, "%% Pseudowire is not static\n");
	363	return CMD_WARNING;
	364	}
	365	zebra_pw_del(zvrf, pw);
	366	}
	367
	368	return CMD_SUCCESS;
	369	}
	370
2dd0d726 RW	371	DEFUN (pseudowire_labels,
	372	pseudowire_labels_cmd,
	373	"[no] mpls label local (16-1048575) remote (16-1048575)",
	374	NO_STR
	375	"MPLS L2VPN PW command\n"
	376	"MPLS L2VPN static labels\n"
	377	"Local pseudowire label\n"
	378	"Local pseudowire label\n"
	379	"Remote pseudowire label\n"
	380	"Remote pseudowire label\n")
	381	{
	382	VTY_DECLVAR_CONTEXT(zebra_pw, pw);
	383	int idx = 0;
	384	mpls_label_t local_label, remote_label;
	385
	386	if (argv_find(argv, argc, "no", &idx)) {
	387	local_label = MPLS_NO_LABEL;
	388	remote_label = MPLS_NO_LABEL;
	389	} else {
	390	argv_find(argv, argc, "local", &idx);
	391	local_label = atoi(argv[idx + 1]->arg);
	392	argv_find(argv, argc, "remote", &idx);
	393	remote_label = atoi(argv[idx + 1]->arg);
	394	}
	395
	396	zebra_pw_change(pw, pw->ifindex, pw->type, pw->af, &pw->nexthop,
	397	local_label, remote_label, pw->flags, &pw->data);
	398
	399	return CMD_SUCCESS;
	400	}
	401
	402	DEFUN (pseudowire_neighbor,
	403	pseudowire_neighbor_cmd,
	404	"[no] neighbor <A.B.C.D\|X:X::X:X>",
	405	NO_STR
	406	"Specify the IPv4 or IPv6 address of the remote endpoint\n"
	407	"IPv4 address\n"
	408	"IPv6 address\n")
	409	{
	410	VTY_DECLVAR_CONTEXT(zebra_pw, pw);
	411	int idx = 0;
	412	const char *address;
	413	int af;
	414	union g_addr nexthop;
	415
	416	af = AF_UNSPEC;
	417	memset(&nexthop, 0, sizeof(nexthop));
	418
	419	if (!argv_find(argv, argc, "no", &idx)) {
	420	argv_find(argv, argc, "neighbor", &idx);
	421	address = argv[idx + 1]->arg;
	422
	423	if (inet_pton(AF_INET, address, &nexthop.ipv4) == 1)
	424	af = AF_INET;
	425	else if (inet_pton(AF_INET6, address, &nexthop.ipv6) == 1)
	426	af = AF_INET6;
	427	else {
69965f53	428	vty_out(vty, "%% Malformed address\n");
2dd0d726 RW	429	return CMD_WARNING;
	430	}
	431	}
	432
	433	zebra_pw_change(pw, pw->ifindex, pw->type, af, &nexthop,
	434	pw->local_label, pw->remote_label, pw->flags,
	435	&pw->data);
	436
	437	return CMD_SUCCESS;
	438	}
	439
	440	DEFUN (pseudowire_control_word,
	441	pseudowire_control_word_cmd,
	442	"[no] control-word <exclude\|include>",
	443	NO_STR
	444	"Control-word options\n"
	445	"Exclude control-word in pseudowire packets\n"
	446	"Include control-word in pseudowire packets\n")
	447	{
	448	VTY_DECLVAR_CONTEXT(zebra_pw, pw);
	449	int idx = 0;
	450	uint8_t flags = 0;
	451
	452	if (argv_find(argv, argc, "no", &idx))
	453	flags = F_PSEUDOWIRE_CWORD;
	454	else {
	455	argv_find(argv, argc, "control-word", &idx);
	456	if (argv[idx + 1]->text[0] == 'i')
	457	flags = F_PSEUDOWIRE_CWORD;
	458	}
	459
	460	zebra_pw_change(pw, pw->ifindex, pw->type, pw->af, &pw->nexthop,
	461	pw->local_label, pw->remote_label, flags, &pw->data);
	462
	463	return CMD_SUCCESS;
	464	}
	465
	466	DEFUN (show_pseudowires,
	467	show_pseudowires_cmd,
d261dd7e	468	"show mpls pseudowires",
2dd0d726	469	SHOW_STR
d261dd7e	470	MPLS_STR
efd7904e	471	"Pseudowires\n")
2dd0d726 RW	472	{
	473	struct zebra_vrf *zvrf;
	474	struct zebra_pw *pw;
	475
	476	zvrf = vrf_info_lookup(VRF_DEFAULT);
	477	if (!zvrf)
	478	return 0;
	479
69965f53 DL	480	vty_out(vty, "%-16s %-24s %-12s %-8s %-10s\n", "Interface", "Neighbor",
69965f53 DL	481	"Labels", "Protocol", "Status");
2dd0d726	482
a2addae8	483	RB_FOREACH (pw, zebra_pw_head, &zvrf->pseudowires) {
2dd0d726 RW	484	char buf_nbr[INET6_ADDRSTRLEN];
	485	char buf_labels[64];
	486
	487	inet_ntop(pw->af, &pw->nexthop, buf_nbr, sizeof(buf_nbr));
	488
	489	if (pw->local_label != MPLS_NO_LABEL
	490	&& pw->remote_label != MPLS_NO_LABEL)
	491	snprintf(buf_labels, sizeof(buf_labels), "%u/%u",
	492	pw->local_label, pw->remote_label);
	493	else
	494	snprintf(buf_labels, sizeof(buf_labels), "-");
	495
69965f53	496	vty_out(vty, "%-16s %-24s %-12s %-8s %-10s\n", pw->ifname,
2dd0d726 RW	497	(pw->af != AF_UNSPEC) ? buf_nbr : "-", buf_labels,
	498	zebra_route_string(pw->protocol),
	499	(zebra_pw_enabled(pw) && pw->status == PW_STATUS_UP)
	500	? "UP"
69965f53	501	: "DOWN");
2dd0d726 RW	502	}
	503
	504	return CMD_SUCCESS;
	505	}
	506
	507	/* Pseudowire configuration write function. */
	508	static int zebra_pw_config(struct vty *vty)
	509	{
	510	int write = 0;
	511	struct zebra_vrf *zvrf;
	512	struct zebra_pw *pw;
	513
	514	zvrf = vrf_info_lookup(VRF_DEFAULT);
	515	if (!zvrf)
	516	return 0;
	517
a2addae8	518	RB_FOREACH (pw, zebra_static_pw_head, &zvrf->static_pseudowires) {
69965f53	519	vty_out(vty, "pseudowire %s\n", pw->ifname);
2dd0d726 RW	520	if (pw->local_label != MPLS_NO_LABEL
2dd0d726 RW	521	&& pw->remote_label != MPLS_NO_LABEL)
69965f53 DL	522	vty_out(vty, " mpls label local %u remote %u\n",
69965f53 DL	523	pw->local_label, pw->remote_label);
2dd0d726 RW	524	else
	525	vty_out(vty,
	526	" ! Incomplete config, specify the static "
69965f53	527	"MPLS labels\n");
2dd0d726 RW	528
	529	if (pw->af != AF_UNSPEC) {
	530	char buf[INET6_ADDRSTRLEN];
	531	inet_ntop(pw->af, &pw->nexthop, buf, sizeof(buf));
69965f53	532	vty_out(vty, " neighbor %s\n", buf);
2dd0d726 RW	533	} else
	534	vty_out(vty,
	535	" ! Incomplete config, specify a neighbor "
69965f53	536	"address\n");
2dd0d726 RW	537
2dd0d726 RW	538	if (!(pw->flags & F_PSEUDOWIRE_CWORD))
69965f53	539	vty_out(vty, " control-word exclude\n");
2dd0d726	540
69965f53	541	vty_out(vty, "!\n");
2dd0d726 RW	542	write = 1;
	543	}
	544
	545	return write;
	546	}
	547
	548	static struct cmd_node pw_node = {
	549	PW_NODE, "%s(config-pw)# ", 1,
	550	};
	551
	552	void zebra_pw_vty_init(void)
	553	{
	554	install_node(&pw_node, zebra_pw_config);
	555	install_default(PW_NODE);
	556
	557	install_element(CONFIG_NODE, &pseudowire_if_cmd);
1e9d1183	558	install_element(CONFIG_NODE, &no_pseudowire_if_cmd);
2dd0d726 RW	559	install_element(PW_NODE, &pseudowire_labels_cmd);
	560	install_element(PW_NODE, &pseudowire_neighbor_cmd);
	561	install_element(PW_NODE, &pseudowire_control_word_cmd);
	562
	563	install_element(VIEW_NODE, &show_pseudowires_cmd);
	564	}