[mirror_frr.git] / zebra / rt_socket.c

/*
 * Kernel routing table updates by routing socket.
 * Copyright (C) 1997, 98 Kunihiro Ishiguro
 *
 * 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 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>
#ifdef __OpenBSD__
#include <netmpls/mpls.h>
#endif

#include "if.h"
#include "prefix.h"
#include "sockunion.h"
#include "log.h"
#include "privs.h"

#include "zebra/debug.h"
#include "zebra/rib.h"
#include "zebra/rt.h"
#include "zebra/kernel_socket.h"
#include "zebra/zebra_mpls.h"

extern struct zebra_privs_t zserv_privs;

/* kernel socket export */
extern int rtm_write (int message, union sockunion *dest,
                      union sockunion *mask, union sockunion *gate,
                      union sockunion *mpls, unsigned int index,
                      int zebra_flags, int metric);

#ifdef HAVE_STRUCT_SOCKADDR_IN_SIN_LEN
/* Adjust netmask socket length. Return value is a adjusted sin_len
   value. */
static int
sin_masklen (struct in_addr mask)
{
  char *p, *lim;
  int len;
  struct sockaddr_in sin;

  if (mask.s_addr == 0) 
    return sizeof (long);

  sin.sin_addr = mask;
  len = sizeof (struct sockaddr_in);

  lim = (char *) &sin.sin_addr;
  p = lim + sizeof (sin.sin_addr);

  while (*--p == 0 && p >= lim) 
    len--;
  return len;
}
#endif /* HAVE_STRUCT_SOCKADDR_IN_SIN_LEN */

/* Interface between zebra message and rtm message. */
static int
kernel_rtm_ipv4 (int cmd, struct prefix *p, struct rib *rib)

{
  struct sockaddr_in *mask = NULL;
  struct sockaddr_in sin_dest, sin_mask, sin_gate;
#ifdef __OpenBSD__
  struct sockaddr_mpls smpls;
#endif
  union sockunion *smplsp = NULL;
  struct nexthop *nexthop, *tnexthop;
  int recursing;
  int nexthop_num = 0;
  ifindex_t ifindex = 0;
  int gate = 0;
  int error;
  char prefix_buf[PREFIX_STRLEN];

  if (IS_ZEBRA_DEBUG_RIB)
    prefix2str (p, prefix_buf, sizeof(prefix_buf));
  memset (&sin_dest, 0, sizeof (struct sockaddr_in));
  sin_dest.sin_family = AF_INET;
#ifdef HAVE_STRUCT_SOCKADDR_IN_SIN_LEN
  sin_dest.sin_len = sizeof (struct sockaddr_in);
#endif /* HAVE_STRUCT_SOCKADDR_IN_SIN_LEN */
  sin_dest.sin_addr = p->u.prefix4;

  memset (&sin_mask, 0, sizeof (struct sockaddr_in));

  memset (&sin_gate, 0, sizeof (struct sockaddr_in));
  sin_gate.sin_family = AF_INET;
#ifdef HAVE_STRUCT_SOCKADDR_IN_SIN_LEN
  sin_gate.sin_len = sizeof (struct sockaddr_in);
#endif /* HAVE_STRUCT_SOCKADDR_IN_SIN_LEN */

  /* Make gateway. */
  for (ALL_NEXTHOPS_RO(rib->nexthop, nexthop, tnexthop, recursing))
    {
      if (CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_RECURSIVE))
        continue;

      gate = 0;
      char gate_buf[INET_ADDRSTRLEN] = "NULL";

      /*
       * XXX We need to refrain from kernel operations in some cases,
       * but this if statement seems overly cautious - what about
       * other than ADD and DELETE?
       */
      if ((cmd == RTM_ADD
	   && CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_ACTIVE))
	  || (cmd == RTM_DELETE
	      && CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_FIB)
	      ))
	{
	  if (nexthop->type == NEXTHOP_TYPE_IPV4 ||
	      nexthop->type == NEXTHOP_TYPE_IPV4_IFINDEX)
	    {
	      sin_gate.sin_addr = nexthop->gate.ipv4;
	      gate = 1;
	    }
	  if (nexthop->type == NEXTHOP_TYPE_IFINDEX
	      || nexthop->type == NEXTHOP_TYPE_IPV4_IFINDEX)
	    ifindex = nexthop->ifindex;
	  if (nexthop->type == NEXTHOP_TYPE_BLACKHOLE)
	    {
	      struct in_addr loopback;
	      loopback.s_addr = htonl (INADDR_LOOPBACK);
	      sin_gate.sin_addr = loopback;
	      gate = 1;
	    }

	  if (gate && p->prefixlen == 32)
	    mask = NULL;
	  else
	    {
	      masklen2ip (p->prefixlen, &sin_mask.sin_addr);
	      sin_mask.sin_family = AF_INET;
#ifdef HAVE_STRUCT_SOCKADDR_IN_SIN_LEN
	      sin_mask.sin_len = sin_masklen (sin_mask.sin_addr);
#endif /* HAVE_STRUCT_SOCKADDR_IN_SIN_LEN */
	      mask = &sin_mask;
	    }

#ifdef __OpenBSD__
	  if (nexthop->nh_label)
	    {
	      memset (&smpls, 0, sizeof (smpls));
	      smpls.smpls_len = sizeof (smpls);
	      smpls.smpls_family = AF_MPLS;
	      smpls.smpls_label =
		htonl (nexthop->nh_label->label[0] << MPLS_LABEL_OFFSET);
	      smplsp = (union sockunion *)&smpls;
	    }
#endif

	  error = rtm_write (cmd,
			     (union sockunion *)&sin_dest, 
			     (union sockunion *)mask, 
			     gate ? (union sockunion *)&sin_gate : NULL,
			     smplsp,
			     ifindex,
			     rib->flags,
			     rib->metric);

           if (IS_ZEBRA_DEBUG_RIB)
           {
             if (!gate)
             {
               zlog_debug ("%s: %s: attention! gate not found for rib %p",
                 __func__, prefix_buf, rib);
               rib_dump (p, NULL, rib);
             }
             else
               inet_ntop (AF_INET, &sin_gate.sin_addr, gate_buf, INET_ADDRSTRLEN);
           }
 
           switch (error)
           {
             /* We only flag nexthops as being in FIB if rtm_write() did its work. */
             case ZEBRA_ERR_NOERROR:
               nexthop_num++;
               if (IS_ZEBRA_DEBUG_RIB)
                 zlog_debug ("%s: %s: successfully did NH %s",
                   __func__, prefix_buf, gate_buf);
               if (cmd == RTM_ADD)
                 SET_FLAG (nexthop->flags, NEXTHOP_FLAG_FIB);
               break;
 
             /* The only valid case for this error is kernel's failure to install
              * a multipath route, which is common for FreeBSD. This should be
              * ignored silently, but logged as an error otherwise.
              */
             case ZEBRA_ERR_RTEXIST:
               if (cmd != RTM_ADD)
                 zlog_err ("%s: rtm_write() returned %d for command %d",
                   __func__, error, cmd);
               continue;
               break;
 
             /* Given that our NEXTHOP_FLAG_FIB matches real kernel FIB, it isn't
              * normal to get any other messages in ANY case.
              */
             case ZEBRA_ERR_RTNOEXIST:
             case ZEBRA_ERR_RTUNREACH:
             default:
               zlog_err ("%s: %s: rtm_write() unexpectedly returned %d for command %s",
                 __func__, prefix2str(p, prefix_buf, sizeof(prefix_buf)),
                 error, lookup (rtm_type_str, cmd));
               break;
           }
         } /* if (cmd and flags make sense) */
       else
         if (IS_ZEBRA_DEBUG_RIB)
           zlog_debug ("%s: odd command %s for flags %d",
             __func__, lookup (rtm_type_str, cmd), nexthop->flags);
     } /* for (ALL_NEXTHOPS_RO(...))*/
 
   /* If there was no useful nexthop, then complain. */
   if (nexthop_num == 0 && IS_ZEBRA_DEBUG_KERNEL)
     zlog_debug ("%s: No useful nexthops were found in RIB entry %p", __func__, rib);

  return 0; /*XXX*/
}

#ifdef SIN6_LEN
/* Calculate sin6_len value for netmask socket value. */
static int
sin6_masklen (struct in6_addr mask)
{
  struct sockaddr_in6 sin6;
  char *p, *lim;
  int len;

  if (IN6_IS_ADDR_UNSPECIFIED (&mask)) 
    return sizeof (long);

  sin6.sin6_addr = mask;
  len = sizeof (struct sockaddr_in6);

  lim = (char *) & sin6.sin6_addr;
  p = lim + sizeof (sin6.sin6_addr);

  while (*--p == 0 && p >= lim) 
    len--;

  return len;
}
#endif /* SIN6_LEN */

/* Interface between zebra message and rtm message. */
static int
kernel_rtm_ipv6 (int cmd, struct prefix *p, struct rib *rib)
{
  struct sockaddr_in6 *mask;
  struct sockaddr_in6 sin_dest, sin_mask, sin_gate;
  struct nexthop *nexthop, *tnexthop;
  int recursing;
  int nexthop_num = 0;
  ifindex_t ifindex = 0;
  int gate = 0;
  int error;

  memset (&sin_dest, 0, sizeof (struct sockaddr_in6));
  sin_dest.sin6_family = AF_INET6;
#ifdef SIN6_LEN
  sin_dest.sin6_len = sizeof (struct sockaddr_in6);
#endif /* SIN6_LEN */
  sin_dest.sin6_addr = p->u.prefix6;

  memset (&sin_mask, 0, sizeof (struct sockaddr_in6));

  memset (&sin_gate, 0, sizeof (struct sockaddr_in6));
  sin_gate.sin6_family = AF_INET6;
#ifdef HAVE_STRUCT_SOCKADDR_IN_SIN_LEN
  sin_gate.sin6_len = sizeof (struct sockaddr_in6);
#endif /* HAVE_STRUCT_SOCKADDR_IN_SIN_LEN */

  /* Make gateway. */
  for (ALL_NEXTHOPS_RO(rib->nexthop, nexthop, tnexthop, recursing))
    {
      if (CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_RECURSIVE))
	continue;

      gate = 0;

      if ((cmd == RTM_ADD
	   && CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_ACTIVE))
	  || (cmd == RTM_DELETE
#if 0
	      && CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_FIB)
#endif
	      ))
	{
	  if (nexthop->type == NEXTHOP_TYPE_IPV6
	      || nexthop->type == NEXTHOP_TYPE_IPV6_IFINDEX)
	    {
	      sin_gate.sin6_addr = nexthop->gate.ipv6;
	      gate = 1;
	    }
	  if (nexthop->type == NEXTHOP_TYPE_IFINDEX
	      || nexthop->type == NEXTHOP_TYPE_IPV6_IFINDEX)
	    ifindex = nexthop->ifindex;

	  if (cmd == RTM_ADD)
	    SET_FLAG (nexthop->flags, NEXTHOP_FLAG_FIB);
	}

      /* Under kame set interface index to link local address. */
#ifdef KAME

#define SET_IN6_LINKLOCAL_IFINDEX(a, i) \
      do { \
	(a).s6_addr[2] = ((i) >> 8) & 0xff; \
	(a).s6_addr[3] = (i) & 0xff; \
      } while (0)

      if (gate && IN6_IS_ADDR_LINKLOCAL(&sin_gate.sin6_addr))
	SET_IN6_LINKLOCAL_IFINDEX (sin_gate.sin6_addr, ifindex);
#endif /* KAME */

      if (gate && p->prefixlen == 128)
	mask = NULL;
      else
	{
	  masklen2ip6 (p->prefixlen, &sin_mask.sin6_addr);
	  sin_mask.sin6_family = AF_INET6;
#ifdef SIN6_LEN
	  sin_mask.sin6_len = sin6_masklen (sin_mask.sin6_addr);
#endif /* SIN6_LEN */
	  mask = &sin_mask;
	}

      error = rtm_write (cmd,
			(union sockunion *) &sin_dest,
			(union sockunion *) mask,
			gate ? (union sockunion *)&sin_gate : NULL,
			NULL,
			ifindex,
			rib->flags,
			rib->metric);

#if 0
      if (error)
	{
	  zlog_info ("kernel_rtm_ipv6(): nexthop %d add error=%d.",
	    nexthop_num, error);
	}
#else
      (void)error;
#endif

      nexthop_num++;
    }

  /* If there is no useful nexthop then return. */
  if (nexthop_num == 0)
    {
      if (IS_ZEBRA_DEBUG_KERNEL)
	zlog_debug ("kernel_rtm_ipv6(): No useful nexthop.");
      return 0;
    }

  return 0; /*XXX*/
}

static int
kernel_rtm (int cmd, struct prefix *p, struct rib *rib)
{
  switch (PREFIX_FAMILY(p))
    {
    case AF_INET:
      return kernel_rtm_ipv4 (cmd, p, rib);
    case AF_INET6:
      return kernel_rtm_ipv6 (cmd, p, rib);
    }
  return 0;
}

int
kernel_route_rib (struct prefix *p, struct prefix *src_p,
                  struct rib *old, struct rib *new)
{
  int route = 0;

  if (src_p && src_p->prefixlen)
    {
      zlog_err ("route add: IPv6 sourcedest routes unsupported!");
      return 1;
    }

  if (zserv_privs.change(ZPRIVS_RAISE))
    zlog_err("Can't raise privileges");

  if (old)
    route |= kernel_rtm (RTM_DELETE, p, old);

  if (new)
    route |= kernel_rtm (RTM_ADD, p, new);

  if (zserv_privs.change(ZPRIVS_LOWER))
    zlog_err("Can't lower privileges");

  return route;
}

int
kernel_neigh_update (int add, int ifindex, uint32_t addr, char *lla, int llalen)
{
  /* TODO */
  return 0;
}

extern int
kernel_get_ipmr_sg_stats (void *mroute)
{
  return 0;
}
Commit	Line	Data
718e3744	1	/*
	2	* Kernel routing table updates by routing socket.
	3	* Copyright (C) 1997, 98 Kunihiro Ishiguro
	4	*
	5	* This file is part of GNU Zebra.
	6	*
	7	* GNU Zebra is free software; you can redistribute it and/or modify it
	8	* under the terms of the GNU General Public License as published by the
	9	* Free Software Foundation; either version 2, or (at your option) any
	10	* later version.
	11	*
	12	* GNU Zebra is distributed in the hope that it will be useful, but
	13	* WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	15	* General Public License for more details.
	16	*
896014f4 DL	17	* You should have received a copy of the GNU General Public License along
	18	* with this program; see the file COPYING; if not, write to the Free Software
	19	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
718e3744	20	*/
	21
	22	#include <zebra.h>
fe6c7157	23	#ifdef __OpenBSD__
d3e2c74a RW	24	#include <netmpls/mpls.h>
d3e2c74a RW	25	#endif
718e3744	26
	27	#include "if.h"
	28	#include "prefix.h"
	29	#include "sockunion.h"
	30	#include "log.h"
edd7c245	31	#include "privs.h"
718e3744	32
	33	#include "zebra/debug.h"
	34	#include "zebra/rib.h"
6621ca86	35	#include "zebra/rt.h"
dc95824a	36	#include "zebra/kernel_socket.h"
d3e2c74a	37	#include "zebra/zebra_mpls.h"
718e3744	38
edd7c245	39	extern struct zebra_privs_t zserv_privs;
edd7c245	40
6621ca86	41	/* kernel socket export */
	42	extern int rtm_write (int message, union sockunion *dest,
	43	union sockunion mask, union sockunion gate,
d3e2c74a RW	44	union sockunion *mpls, unsigned int index,
d3e2c74a RW	45	int zebra_flags, int metric);
718e3744	46
746c4f02	47	#ifdef HAVE_STRUCT_SOCKADDR_IN_SIN_LEN
718e3744	48	/* Adjust netmask socket length. Return value is a adjusted sin_len
718e3744	49	value. */
6621ca86	50	static int
718e3744	51	sin_masklen (struct in_addr mask)
	52	{
	53	char p, lim;
	54	int len;
	55	struct sockaddr_in sin;
	56
	57	if (mask.s_addr == 0)
	58	return sizeof (long);
	59
	60	sin.sin_addr = mask;
	61	len = sizeof (struct sockaddr_in);
	62
	63	lim = (char *) &sin.sin_addr;
	64	p = lim + sizeof (sin.sin_addr);
	65
	66	while (*--p == 0 && p >= lim)
	67	len--;
	68	return len;
	69	}
746c4f02	70	#endif /* HAVE_STRUCT_SOCKADDR_IN_SIN_LEN */
718e3744	71
718e3744	72	/* Interface between zebra message and rtm message. */
6621ca86	73	static int
62ccf1e5	74	kernel_rtm_ipv4 (int cmd, struct prefix p, struct rib rib)
718e3744	75
718e3744	76	{
fa2b17e3	77	struct sockaddr_in *mask = NULL;
718e3744	78	struct sockaddr_in sin_dest, sin_mask, sin_gate;
fe6c7157	79	#ifdef __OpenBSD__
d3e2c74a RW	80	struct sockaddr_mpls smpls;
	81	#endif
	82	union sockunion *smplsp = NULL;
fa713d9e CF	83	struct nexthop nexthop, tnexthop;
fa713d9e CF	84	int recursing;
718e3744	85	int nexthop_num = 0;
b892f1dd	86	ifindex_t ifindex = 0;
718e3744	87	int gate = 0;
718e3744	88	int error;
35d921cc	89	char prefix_buf[PREFIX_STRLEN];
718e3744	90
dc95824a	91	if (IS_ZEBRA_DEBUG_RIB)
35d921cc	92	prefix2str (p, prefix_buf, sizeof(prefix_buf));
718e3744	93	memset (&sin_dest, 0, sizeof (struct sockaddr_in));
718e3744	94	sin_dest.sin_family = AF_INET;
6f0e3f6e	95	#ifdef HAVE_STRUCT_SOCKADDR_IN_SIN_LEN
718e3744	96	sin_dest.sin_len = sizeof (struct sockaddr_in);
6f0e3f6e	97	#endif /* HAVE_STRUCT_SOCKADDR_IN_SIN_LEN */
718e3744	98	sin_dest.sin_addr = p->u.prefix4;
	99
	100	memset (&sin_mask, 0, sizeof (struct sockaddr_in));
	101
	102	memset (&sin_gate, 0, sizeof (struct sockaddr_in));
	103	sin_gate.sin_family = AF_INET;
6f0e3f6e	104	#ifdef HAVE_STRUCT_SOCKADDR_IN_SIN_LEN
718e3744	105	sin_gate.sin_len = sizeof (struct sockaddr_in);
6f0e3f6e	106	#endif /* HAVE_STRUCT_SOCKADDR_IN_SIN_LEN */
718e3744	107
718e3744	108	/* Make gateway. */
fa713d9e	109	for (ALL_NEXTHOPS_RO(rib->nexthop, nexthop, tnexthop, recursing))
718e3744	110	{
fa713d9e CF	111	if (CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_RECURSIVE))
	112	continue;
	113
718e3744	114	gate = 0;
dc95824a	115	char gate_buf[INET_ADDRSTRLEN] = "NULL";
718e3744	116
dfdb8f18 GT	117	/*
	118	* XXX We need to refrain from kernel operations in some cases,
	119	* but this if statement seems overly cautious - what about
	120	* other than ADD and DELETE?
	121	*/
718e3744	122	if ((cmd == RTM_ADD
	123	&& CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_ACTIVE))
	124	\|\| (cmd == RTM_DELETE
718e3744	125	&& CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_FIB)
718e3744	126	))
718e3744	127	{
fa713d9e CF	128	if (nexthop->type == NEXTHOP_TYPE_IPV4 \|\|
fa713d9e CF	129	nexthop->type == NEXTHOP_TYPE_IPV4_IFINDEX)
718e3744	130	{
fa713d9e CF	131	sin_gate.sin_addr = nexthop->gate.ipv4;
fa713d9e CF	132	gate = 1;
718e3744	133	}
fa713d9e	134	if (nexthop->type == NEXTHOP_TYPE_IFINDEX
fa713d9e CF	135	\|\| nexthop->type == NEXTHOP_TYPE_IPV4_IFINDEX)
	136	ifindex = nexthop->ifindex;
	137	if (nexthop->type == NEXTHOP_TYPE_BLACKHOLE)
718e3744	138	{
fa713d9e CF	139	struct in_addr loopback;
	140	loopback.s_addr = htonl (INADDR_LOOPBACK);
	141	sin_gate.sin_addr = loopback;
	142	gate = 1;
dfdb8f18	143	}
718e3744	144
718e3744	145	if (gate && p->prefixlen == 32)
	146	mask = NULL;
	147	else
	148	{
	149	masklen2ip (p->prefixlen, &sin_mask.sin_addr);
6083e1f8	150	sin_mask.sin_family = AF_INET;
6f0e3f6e	151	#ifdef HAVE_STRUCT_SOCKADDR_IN_SIN_LEN
718e3744	152	sin_mask.sin_len = sin_masklen (sin_mask.sin_addr);
6f0e3f6e	153	#endif /* HAVE_STRUCT_SOCKADDR_IN_SIN_LEN */
718e3744	154	mask = &sin_mask;
718e3744	155	}
718e3744	156
fe6c7157	157	#ifdef __OpenBSD__
d3e2c74a RW	158	if (nexthop->nh_label)
	159	{
	160	memset (&smpls, 0, sizeof (smpls));
	161	smpls.smpls_len = sizeof (smpls);
	162	smpls.smpls_family = AF_MPLS;
	163	smpls.smpls_label =
	164	htonl (nexthop->nh_label->label[0] << MPLS_LABEL_OFFSET);
	165	smplsp = (union sockunion *)&smpls;
	166	}
	167	#endif
	168
dfdb8f18 GT	169	error = rtm_write (cmd,
	170	(union sockunion *)&sin_dest,
	171	(union sockunion *)mask,
	172	gate ? (union sockunion *)&sin_gate : NULL,
d3e2c74a	173	smplsp,
dfdb8f18 GT	174	ifindex,
	175	rib->flags,
	176	rib->metric);
718e3744	177
dc95824a DO	178	if (IS_ZEBRA_DEBUG_RIB)
	179	{
	180	if (!gate)
	181	{
35d921cc TT	182	zlog_debug ("%s: %s: attention! gate not found for rib %p",
35d921cc TT	183	__func__, prefix_buf, rib);
05737783	184	rib_dump (p, NULL, rib);
dc95824a DO	185	}
	186	else
	187	inet_ntop (AF_INET, &sin_gate.sin_addr, gate_buf, INET_ADDRSTRLEN);
	188	}
	189
	190	switch (error)
	191	{
	192	/* We only flag nexthops as being in FIB if rtm_write() did its work. */
	193	case ZEBRA_ERR_NOERROR:
	194	nexthop_num++;
	195	if (IS_ZEBRA_DEBUG_RIB)
35d921cc TT	196	zlog_debug ("%s: %s: successfully did NH %s",
35d921cc TT	197	__func__, prefix_buf, gate_buf);
dc95824a DO	198	if (cmd == RTM_ADD)
	199	SET_FLAG (nexthop->flags, NEXTHOP_FLAG_FIB);
	200	break;
	201
	202	/* The only valid case for this error is kernel's failure to install
	203	* a multipath route, which is common for FreeBSD. This should be
	204	* ignored silently, but logged as an error otherwise.
	205	*/
	206	case ZEBRA_ERR_RTEXIST:
	207	if (cmd != RTM_ADD)
	208	zlog_err ("%s: rtm_write() returned %d for command %d",
	209	__func__, error, cmd);
	210	continue;
	211	break;
	212
	213	/* Given that our NEXTHOP_FLAG_FIB matches real kernel FIB, it isn't
	214	* normal to get any other messages in ANY case.
	215	*/
	216	case ZEBRA_ERR_RTNOEXIST:
	217	case ZEBRA_ERR_RTUNREACH:
	218	default:
35d921cc TT	219	zlog_err ("%s: %s: rtm_write() unexpectedly returned %d for command %s",
	220	__func__, prefix2str(p, prefix_buf, sizeof(prefix_buf)),
	221	error, lookup (rtm_type_str, cmd));
dc95824a DO	222	break;
	223	}
	224	} /* if (cmd and flags make sense) */
	225	else
	226	if (IS_ZEBRA_DEBUG_RIB)
	227	zlog_debug ("%s: odd command %s for flags %d",
2d844524	228	__func__, lookup (rtm_type_str, cmd), nexthop->flags);
fa713d9e	229	} /* for (ALL_NEXTHOPS_RO(...))*/
dc95824a DO	230
	231	/* If there was no useful nexthop, then complain. */
	232	if (nexthop_num == 0 && IS_ZEBRA_DEBUG_KERNEL)
	233	zlog_debug ("%s: No useful nexthops were found in RIB entry %p", __func__, rib);
718e3744	234
	235	return 0; /XXX/
	236	}
	237
746c4f02	238	#ifdef SIN6_LEN
718e3744	239	/* Calculate sin6_len value for netmask socket value. */
6621ca86	240	static int
718e3744	241	sin6_masklen (struct in6_addr mask)
	242	{
	243	struct sockaddr_in6 sin6;
	244	char p, lim;
	245	int len;
	246
718e3744	247	if (IN6_IS_ADDR_UNSPECIFIED (&mask))
718e3744	248	return sizeof (long);
718e3744	249
	250	sin6.sin6_addr = mask;
	251	len = sizeof (struct sockaddr_in6);
	252
	253	lim = (char *) & sin6.sin6_addr;
	254	p = lim + sizeof (sin6.sin6_addr);
	255
	256	while (*--p == 0 && p >= lim)
	257	len--;
	258
	259	return len;
	260	}
746c4f02	261	#endif /* SIN6_LEN */
718e3744	262
718e3744	263	/* Interface between zebra message and rtm message. */
6621ca86	264	static int
62ccf1e5	265	kernel_rtm_ipv6 (int cmd, struct prefix p, struct rib rib)
718e3744	266	{
	267	struct sockaddr_in6 *mask;
	268	struct sockaddr_in6 sin_dest, sin_mask, sin_gate;
fa713d9e CF	269	struct nexthop nexthop, tnexthop;
fa713d9e CF	270	int recursing;
718e3744	271	int nexthop_num = 0;
b892f1dd	272	ifindex_t ifindex = 0;
718e3744	273	int gate = 0;
	274	int error;
	275
	276	memset (&sin_dest, 0, sizeof (struct sockaddr_in6));
	277	sin_dest.sin6_family = AF_INET6;
	278	#ifdef SIN6_LEN
	279	sin_dest.sin6_len = sizeof (struct sockaddr_in6);
	280	#endif /* SIN6_LEN */
	281	sin_dest.sin6_addr = p->u.prefix6;
	282
	283	memset (&sin_mask, 0, sizeof (struct sockaddr_in6));
	284
	285	memset (&sin_gate, 0, sizeof (struct sockaddr_in6));
	286	sin_gate.sin6_family = AF_INET6;
6f0e3f6e	287	#ifdef HAVE_STRUCT_SOCKADDR_IN_SIN_LEN
718e3744	288	sin_gate.sin6_len = sizeof (struct sockaddr_in6);
6f0e3f6e	289	#endif /* HAVE_STRUCT_SOCKADDR_IN_SIN_LEN */
718e3744	290
718e3744	291	/* Make gateway. */
fa713d9e	292	for (ALL_NEXTHOPS_RO(rib->nexthop, nexthop, tnexthop, recursing))
718e3744	293	{
fa713d9e CF	294	if (CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_RECURSIVE))
	295	continue;
	296
718e3744	297	gate = 0;
	298
	299	if ((cmd == RTM_ADD
	300	&& CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_ACTIVE))
	301	\|\| (cmd == RTM_DELETE
	302	#if 0
	303	&& CHECK_FLAG (nexthop->flags, NEXTHOP_FLAG_FIB)
	304	#endif
	305	))
	306	{
fa713d9e	307	if (nexthop->type == NEXTHOP_TYPE_IPV6
fa713d9e	308	\|\| nexthop->type == NEXTHOP_TYPE_IPV6_IFINDEX)
718e3744	309	{
fa713d9e CF	310	sin_gate.sin6_addr = nexthop->gate.ipv6;
fa713d9e CF	311	gate = 1;
718e3744	312	}
fa713d9e	313	if (nexthop->type == NEXTHOP_TYPE_IFINDEX
fa713d9e CF	314	\|\| nexthop->type == NEXTHOP_TYPE_IPV6_IFINDEX)
fa713d9e CF	315	ifindex = nexthop->ifindex;
718e3744	316
	317	if (cmd == RTM_ADD)
	318	SET_FLAG (nexthop->flags, NEXTHOP_FLAG_FIB);
	319	}
	320
	321	/* Under kame set interface index to link local address. */
	322	#ifdef KAME
	323
	324	#define SET_IN6_LINKLOCAL_IFINDEX(a, i) \
	325	do { \
	326	(a).s6_addr[2] = ((i) >> 8) & 0xff; \
	327	(a).s6_addr[3] = (i) & 0xff; \
	328	} while (0)
	329
	330	if (gate && IN6_IS_ADDR_LINKLOCAL(&sin_gate.sin6_addr))
	331	SET_IN6_LINKLOCAL_IFINDEX (sin_gate.sin6_addr, ifindex);
	332	#endif /* KAME */
	333
	334	if (gate && p->prefixlen == 128)
	335	mask = NULL;
	336	else
	337	{
	338	masklen2ip6 (p->prefixlen, &sin_mask.sin6_addr);
6fe70d1b	339	sin_mask.sin6_family = AF_INET6;
718e3744	340	#ifdef SIN6_LEN
	341	sin_mask.sin6_len = sin6_masklen (sin_mask.sin6_addr);
	342	#endif /* SIN6_LEN */
	343	mask = &sin_mask;
	344	}
	345
	346	error = rtm_write (cmd,
	347	(union sockunion *) &sin_dest,
	348	(union sockunion *) mask,
	349	gate ? (union sockunion *)&sin_gate : NULL,
d3e2c74a	350	NULL,
718e3744	351	ifindex,
	352	rib->flags,
	353	rib->metric);
	354
	355	#if 0
	356	if (error)
	357	{
be717a0a	358	zlog_info ("kernel_rtm_ipv6(): nexthop %d add error=%d.",
718e3744	359	nexthop_num, error);
718e3744	360	}
746c4f02 DL	361	#else
746c4f02 DL	362	(void)error;
718e3744	363	#endif
	364
	365	nexthop_num++;
	366	}
	367
	368	/* If there is no useful nexthop then return. */
	369	if (nexthop_num == 0)
	370	{
	371	if (IS_ZEBRA_DEBUG_KERNEL)
be717a0a	372	zlog_debug ("kernel_rtm_ipv6(): No useful nexthop.");
718e3744	373	return 0;
	374	}
	375
	376	return 0; /XXX/
	377	}
	378
62ccf1e5 TT	379	static int
	380	kernel_rtm (int cmd, struct prefix p, struct rib rib)
	381	{
	382	switch (PREFIX_FAMILY(p))
	383	{
	384	case AF_INET:
	385	return kernel_rtm_ipv4 (cmd, p, rib);
	386	case AF_INET6:
	387	return kernel_rtm_ipv6 (cmd, p, rib);
	388	}
	389	return 0;
	390	}
	391
718e3744	392	int
05737783 CF	393	kernel_route_rib (struct prefix p, struct prefix src_p,
05737783 CF	394	struct rib old, struct rib new)
718e3744	395	{
62ccf1e5	396	int route = 0;
edd7c245	397
05737783 CF	398	if (src_p && src_p->prefixlen)
05737783 CF	399	{
4525281a	400	zlog_err ("route add: IPv6 sourcedest routes unsupported!");
05737783 CF	401	return 1;
	402	}
	403
edd7c245	404	if (zserv_privs.change(ZPRIVS_RAISE))
4525281a	405	zlog_err("Can't raise privileges");
be717a0a	406
62ccf1e5 TT	407	if (old)
	408	route \|= kernel_rtm (RTM_DELETE, p, old);
	409
	410	if (new)
	411	route \|= kernel_rtm (RTM_ADD, p, new);
be717a0a	412
edd7c245	413	if (zserv_privs.change(ZPRIVS_LOWER))
4525281a	414	zlog_err("Can't lower privileges");
edd7c245	415
edd7c245	416	return route;
718e3744	417	}
6b8a5694 RW	418
	419	int
	420	kernel_neigh_update (int add, int ifindex, uint32_t addr, char *lla, int llalen)
	421	{
	422	/* TODO */
	423	return 0;
	424	}
1498c059	425
a7d3a72e	426	extern int
1498c059 DS	427	kernel_get_ipmr_sg_stats (void *mroute)
1498c059 DS	428	{
6f1d88a7	429	return 0;
1498c059	430	}