[net-next-2.6.git] / net / decnet / dn_fib.c

/*
 * DECnet       An implementation of the DECnet protocol suite for the LINUX
 *              operating system.  DECnet is implemented using the  BSD Socket
 *              interface as the means of communication with the user level.
 *
 *              DECnet Routing Forwarding Information Base (Glue/Info List)
 *
 * Author:      Steve Whitehouse <SteveW@ACM.org>
 *
 *
 * Changes:
 *              Alexey Kuznetsov : SMP locking changes
 *              Steve Whitehouse : Rewrote it... Well to be more correct, I
 *                                 copied most of it from the ipv4 fib code.
 *              Steve Whitehouse : Updated it in style and fixed a few bugs
 *                                 which were fixed in the ipv4 code since
 *                                 this code was copied from it.
 *
 */
#include <linux/string.h>
#include <linux/net.h>
#include <linux/socket.h>
#include <linux/slab.h>
#include <linux/sockios.h>
#include <linux/init.h>
#include <linux/skbuff.h>
#include <linux/netlink.h>
#include <linux/rtnetlink.h>
#include <linux/proc_fs.h>
#include <linux/netdevice.h>
#include <linux/timer.h>
#include <linux/spinlock.h>
#include <asm/atomic.h>
#include <asm/uaccess.h>
#include <net/neighbour.h>
#include <net/dst.h>
#include <net/flow.h>
#include <net/fib_rules.h>
#include <net/dn.h>
#include <net/dn_route.h>
#include <net/dn_fib.h>
#include <net/dn_neigh.h>
#include <net/dn_dev.h>

#define RT_MIN_TABLE 1

#define for_fib_info() { struct dn_fib_info *fi;\
	for(fi = dn_fib_info_list; fi; fi = fi->fib_next)
#define endfor_fib_info() }

#define for_nexthops(fi) { int nhsel; const struct dn_fib_nh *nh;\
	for(nhsel = 0, nh = (fi)->fib_nh; nhsel < (fi)->fib_nhs; nh++, nhsel++)

#define change_nexthops(fi) { int nhsel; struct dn_fib_nh *nh;\
	for(nhsel = 0, nh = (struct dn_fib_nh *)((fi)->fib_nh); nhsel < (fi)->fib_nhs; nh++, nhsel++)

#define endfor_nexthops(fi) }

static DEFINE_SPINLOCK(dn_fib_multipath_lock);
static struct dn_fib_info *dn_fib_info_list;
static DEFINE_SPINLOCK(dn_fib_info_lock);

static struct
{
	int error;
	u8 scope;
} dn_fib_props[RTN_MAX+1] = {
	[RTN_UNSPEC] =      { .error = 0,       .scope = RT_SCOPE_NOWHERE },
	[RTN_UNICAST] =     { .error = 0,       .scope = RT_SCOPE_UNIVERSE },
	[RTN_LOCAL] =       { .error = 0,       .scope = RT_SCOPE_HOST },
	[RTN_BROADCAST] =   { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
	[RTN_ANYCAST] =     { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
	[RTN_MULTICAST] =   { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
	[RTN_BLACKHOLE] =   { .error = -EINVAL, .scope = RT_SCOPE_UNIVERSE },
	[RTN_UNREACHABLE] = { .error = -EHOSTUNREACH, .scope = RT_SCOPE_UNIVERSE },
	[RTN_PROHIBIT] =    { .error = -EACCES, .scope = RT_SCOPE_UNIVERSE },
	[RTN_THROW] =       { .error = -EAGAIN, .scope = RT_SCOPE_UNIVERSE },
	[RTN_NAT] =         { .error = 0,       .scope = RT_SCOPE_NOWHERE },
	[RTN_XRESOLVE] =    { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
};

static int dn_fib_sync_down(__le16 local, struct net_device *dev, int force);
static int dn_fib_sync_up(struct net_device *dev);

void dn_fib_free_info(struct dn_fib_info *fi)
{
	if (fi->fib_dead == 0) {
		printk(KERN_DEBUG "DECnet: BUG! Attempt to free alive dn_fib_info\n");
		return;
	}

	change_nexthops(fi) {
		if (nh->nh_dev)
			dev_put(nh->nh_dev);
		nh->nh_dev = NULL;
	} endfor_nexthops(fi);
	kfree(fi);
}

void dn_fib_release_info(struct dn_fib_info *fi)
{
	spin_lock(&dn_fib_info_lock);
	if (fi && --fi->fib_treeref == 0) {
		if (fi->fib_next)
			fi->fib_next->fib_prev = fi->fib_prev;
		if (fi->fib_prev)
			fi->fib_prev->fib_next = fi->fib_next;
		if (fi == dn_fib_info_list)
			dn_fib_info_list = fi->fib_next;
		fi->fib_dead = 1;
		dn_fib_info_put(fi);
	}
	spin_unlock(&dn_fib_info_lock);
}

static inline int dn_fib_nh_comp(const struct dn_fib_info *fi, const struct dn_fib_info *ofi)
{
	const struct dn_fib_nh *onh = ofi->fib_nh;

	for_nexthops(fi) {
		if (nh->nh_oif != onh->nh_oif ||
			nh->nh_gw != onh->nh_gw ||
			nh->nh_scope != onh->nh_scope ||
			nh->nh_weight != onh->nh_weight ||
			((nh->nh_flags^onh->nh_flags)&~RTNH_F_DEAD))
				return -1;
		onh++;
	} endfor_nexthops(fi);
	return 0;
}

static inline struct dn_fib_info *dn_fib_find_info(const struct dn_fib_info *nfi)
{
	for_fib_info() {
		if (fi->fib_nhs != nfi->fib_nhs)
			continue;
		if (nfi->fib_protocol == fi->fib_protocol &&
			nfi->fib_prefsrc == fi->fib_prefsrc &&
			nfi->fib_priority == fi->fib_priority &&
			memcmp(nfi->fib_metrics, fi->fib_metrics, sizeof(fi->fib_metrics)) == 0 &&
			((nfi->fib_flags^fi->fib_flags)&~RTNH_F_DEAD) == 0 &&
			(nfi->fib_nhs == 0 || dn_fib_nh_comp(fi, nfi) == 0))
				return fi;
	} endfor_fib_info();
	return NULL;
}

__le16 dn_fib_get_attr16(struct rtattr *attr, int attrlen, int type)
{
	while(RTA_OK(attr,attrlen)) {
		if (attr->rta_type == type)
			return *(__le16*)RTA_DATA(attr);
		attr = RTA_NEXT(attr, attrlen);
	}

	return 0;
}

static int dn_fib_count_nhs(struct rtattr *rta)
{
	int nhs = 0;
	struct rtnexthop *nhp = RTA_DATA(rta);
	int nhlen = RTA_PAYLOAD(rta);

	while(nhlen >= (int)sizeof(struct rtnexthop)) {
		if ((nhlen -= nhp->rtnh_len) < 0)
			return 0;
		nhs++;
		nhp = RTNH_NEXT(nhp);
	}

	return nhs;
}

static int dn_fib_get_nhs(struct dn_fib_info *fi, const struct rtattr *rta, const struct rtmsg *r)
{
	struct rtnexthop *nhp = RTA_DATA(rta);
	int nhlen = RTA_PAYLOAD(rta);

	change_nexthops(fi) {
		int attrlen = nhlen - sizeof(struct rtnexthop);
		if (attrlen < 0 || (nhlen -= nhp->rtnh_len) < 0)
			return -EINVAL;

		nh->nh_flags  = (r->rtm_flags&~0xFF) | nhp->rtnh_flags;
		nh->nh_oif    = nhp->rtnh_ifindex;
		nh->nh_weight = nhp->rtnh_hops + 1;

		if (attrlen) {
			nh->nh_gw = dn_fib_get_attr16(RTNH_DATA(nhp), attrlen, RTA_GATEWAY);
		}
		nhp = RTNH_NEXT(nhp);
	} endfor_nexthops(fi);

	return 0;
}


static int dn_fib_check_nh(const struct rtmsg *r, struct dn_fib_info *fi, struct dn_fib_nh *nh)
{
	int err;

	if (nh->nh_gw) {
		struct flowi fl;
		struct dn_fib_res res;

		if (nh->nh_flags&RTNH_F_ONLINK) {
			struct net_device *dev;

			if (r->rtm_scope >= RT_SCOPE_LINK)
				return -EINVAL;
			if (dnet_addr_type(nh->nh_gw) != RTN_UNICAST)
				return -EINVAL;
			if ((dev = __dev_get_by_index(&init_net, nh->nh_oif)) == NULL)
				return -ENODEV;
			if (!(dev->flags&IFF_UP))
				return -ENETDOWN;
			nh->nh_dev = dev;
			dev_hold(dev);
			nh->nh_scope = RT_SCOPE_LINK;
			return 0;
		}

		memset(&fl, 0, sizeof(fl));
		fl.fld_dst = nh->nh_gw;
		fl.oif = nh->nh_oif;
		fl.fld_scope = r->rtm_scope + 1;

		if (fl.fld_scope < RT_SCOPE_LINK)
			fl.fld_scope = RT_SCOPE_LINK;

		if ((err = dn_fib_lookup(&fl, &res)) != 0)
			return err;

		err = -EINVAL;
		if (res.type != RTN_UNICAST && res.type != RTN_LOCAL)
			goto out;
		nh->nh_scope = res.scope;
		nh->nh_oif = DN_FIB_RES_OIF(res);
		nh->nh_dev = DN_FIB_RES_DEV(res);
		if (nh->nh_dev == NULL)
			goto out;
		dev_hold(nh->nh_dev);
		err = -ENETDOWN;
		if (!(nh->nh_dev->flags & IFF_UP))
			goto out;
		err = 0;
out:
		dn_fib_res_put(&res);
		return err;
	} else {
		struct net_device *dev;

		if (nh->nh_flags&(RTNH_F_PERVASIVE|RTNH_F_ONLINK))
			return -EINVAL;

		dev = __dev_get_by_index(&init_net, nh->nh_oif);
		if (dev == NULL || dev->dn_ptr == NULL)
			return -ENODEV;
		if (!(dev->flags&IFF_UP))
			return -ENETDOWN;
		nh->nh_dev = dev;
		dev_hold(nh->nh_dev);
		nh->nh_scope = RT_SCOPE_HOST;
	}

	return 0;
}


struct dn_fib_info *dn_fib_create_info(const struct rtmsg *r, struct dn_kern_rta *rta, const struct nlmsghdr *nlh, int *errp)
{
	int err;
	struct dn_fib_info *fi = NULL;
	struct dn_fib_info *ofi;
	int nhs = 1;

	if (r->rtm_type > RTN_MAX)
		goto err_inval;

	if (dn_fib_props[r->rtm_type].scope > r->rtm_scope)
		goto err_inval;

	if (rta->rta_mp) {
		nhs = dn_fib_count_nhs(rta->rta_mp);
		if (nhs == 0)
			goto err_inval;
	}

	fi = kzalloc(sizeof(*fi)+nhs*sizeof(struct dn_fib_nh), GFP_KERNEL);
	err = -ENOBUFS;
	if (fi == NULL)
		goto failure;

	fi->fib_protocol = r->rtm_protocol;
	fi->fib_nhs = nhs;
	fi->fib_flags = r->rtm_flags;
	if (rta->rta_priority)
		fi->fib_priority = *rta->rta_priority;
	if (rta->rta_mx) {
		int attrlen = RTA_PAYLOAD(rta->rta_mx);
		struct rtattr *attr = RTA_DATA(rta->rta_mx);

		while(RTA_OK(attr, attrlen)) {
			unsigned flavour = attr->rta_type;
			if (flavour) {
				if (flavour > RTAX_MAX)
					goto err_inval;
				fi->fib_metrics[flavour-1] = *(unsigned*)RTA_DATA(attr);
			}
			attr = RTA_NEXT(attr, attrlen);
		}
	}
	if (rta->rta_prefsrc)
		memcpy(&fi->fib_prefsrc, rta->rta_prefsrc, 2);

	if (rta->rta_mp) {
		if ((err = dn_fib_get_nhs(fi, rta->rta_mp, r)) != 0)
			goto failure;
		if (rta->rta_oif && fi->fib_nh->nh_oif != *rta->rta_oif)
			goto err_inval;
		if (rta->rta_gw && memcmp(&fi->fib_nh->nh_gw, rta->rta_gw, 2))
			goto err_inval;
	} else {
		struct dn_fib_nh *nh = fi->fib_nh;
		if (rta->rta_oif)
			nh->nh_oif = *rta->rta_oif;
		if (rta->rta_gw)
			memcpy(&nh->nh_gw, rta->rta_gw, 2);
		nh->nh_flags = r->rtm_flags;
		nh->nh_weight = 1;
	}

	if (r->rtm_type == RTN_NAT) {
		if (rta->rta_gw == NULL || nhs != 1 || rta->rta_oif)
			goto err_inval;
		memcpy(&fi->fib_nh->nh_gw, rta->rta_gw, 2);
		goto link_it;
	}

	if (dn_fib_props[r->rtm_type].error) {
		if (rta->rta_gw || rta->rta_oif || rta->rta_mp)
			goto err_inval;
		goto link_it;
	}

	if (r->rtm_scope > RT_SCOPE_HOST)
		goto err_inval;

	if (r->rtm_scope == RT_SCOPE_HOST) {
		struct dn_fib_nh *nh = fi->fib_nh;

		/* Local address is added */
		if (nhs != 1 || nh->nh_gw)
			goto err_inval;
		nh->nh_scope = RT_SCOPE_NOWHERE;
		nh->nh_dev = dev_get_by_index(&init_net, fi->fib_nh->nh_oif);
		err = -ENODEV;
		if (nh->nh_dev == NULL)
			goto failure;
	} else {
		change_nexthops(fi) {
			if ((err = dn_fib_check_nh(r, fi, nh)) != 0)
				goto failure;
		} endfor_nexthops(fi)
	}

	if (fi->fib_prefsrc) {
		if (r->rtm_type != RTN_LOCAL || rta->rta_dst == NULL ||
		    memcmp(&fi->fib_prefsrc, rta->rta_dst, 2))
			if (dnet_addr_type(fi->fib_prefsrc) != RTN_LOCAL)
				goto err_inval;
	}

link_it:
	if ((ofi = dn_fib_find_info(fi)) != NULL) {
		fi->fib_dead = 1;
		dn_fib_free_info(fi);
		ofi->fib_treeref++;
		return ofi;
	}

	fi->fib_treeref++;
	atomic_inc(&fi->fib_clntref);
	spin_lock(&dn_fib_info_lock);
	fi->fib_next = dn_fib_info_list;
	fi->fib_prev = NULL;
	if (dn_fib_info_list)
		dn_fib_info_list->fib_prev = fi;
	dn_fib_info_list = fi;
	spin_unlock(&dn_fib_info_lock);
	return fi;

err_inval:
	err = -EINVAL;

failure:
	*errp = err;
	if (fi) {
		fi->fib_dead = 1;
		dn_fib_free_info(fi);
	}

	return NULL;
}

int dn_fib_semantic_match(int type, struct dn_fib_info *fi, const struct flowi *fl, struct dn_fib_res *res)
{
	int err = dn_fib_props[type].error;

	if (err == 0) {
		if (fi->fib_flags & RTNH_F_DEAD)
			return 1;

		res->fi = fi;

		switch(type) {
			case RTN_NAT:
				DN_FIB_RES_RESET(*res);
				atomic_inc(&fi->fib_clntref);
				return 0;
			case RTN_UNICAST:
			case RTN_LOCAL:
				for_nexthops(fi) {
					if (nh->nh_flags & RTNH_F_DEAD)
						continue;
					if (!fl->oif || fl->oif == nh->nh_oif)
						break;
				}
				if (nhsel < fi->fib_nhs) {
					res->nh_sel = nhsel;
					atomic_inc(&fi->fib_clntref);
					return 0;
				}
				endfor_nexthops(fi);
				res->fi = NULL;
				return 1;
			default:
				if (net_ratelimit())
					 printk("DECnet: impossible routing event : dn_fib_semantic_match type=%d\n", type);
				res->fi = NULL;
				return -EINVAL;
		}
	}
	return err;
}

void dn_fib_select_multipath(const struct flowi *fl, struct dn_fib_res *res)
{
	struct dn_fib_info *fi = res->fi;
	int w;

	spin_lock_bh(&dn_fib_multipath_lock);
	if (fi->fib_power <= 0) {
		int power = 0;
		change_nexthops(fi) {
			if (!(nh->nh_flags&RTNH_F_DEAD)) {
				power += nh->nh_weight;
				nh->nh_power = nh->nh_weight;
			}
		} endfor_nexthops(fi);
		fi->fib_power = power;
		if (power < 0) {
			spin_unlock_bh(&dn_fib_multipath_lock);
			res->nh_sel = 0;
			return;
		}
	}

	w = jiffies % fi->fib_power;

	change_nexthops(fi) {
		if (!(nh->nh_flags&RTNH_F_DEAD) && nh->nh_power) {
			if ((w -= nh->nh_power) <= 0) {
				nh->nh_power--;
				fi->fib_power--;
				res->nh_sel = nhsel;
				spin_unlock_bh(&dn_fib_multipath_lock);
				return;
			}
		}
	} endfor_nexthops(fi);
	res->nh_sel = 0;
	spin_unlock_bh(&dn_fib_multipath_lock);
}


static int dn_fib_check_attr(struct rtmsg *r, struct rtattr **rta)
{
	int i;

	for(i = 1; i <= RTA_MAX; i++) {
		struct rtattr *attr = rta[i-1];
		if (attr) {
			if (RTA_PAYLOAD(attr) < 4 && RTA_PAYLOAD(attr) != 2)
				return -EINVAL;
			if (i != RTA_MULTIPATH && i != RTA_METRICS &&
			    i != RTA_TABLE)
				rta[i-1] = (struct rtattr *)RTA_DATA(attr);
		}
	}

	return 0;
}

static int dn_fib_rtm_delroute(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg)
{
	struct net *net = sock_net(skb->sk);
	struct dn_fib_table *tb;
	struct rtattr **rta = arg;
	struct rtmsg *r = NLMSG_DATA(nlh);

	if (!net_eq(net, &init_net))
		return -EINVAL;

	if (dn_fib_check_attr(r, rta))
		return -EINVAL;

	tb = dn_fib_get_table(rtm_get_table(rta, r->rtm_table), 0);
	if (tb)
		return tb->delete(tb, r, (struct dn_kern_rta *)rta, nlh, &NETLINK_CB(skb));

	return -ESRCH;
}

static int dn_fib_rtm_newroute(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg)
{
	struct net *net = sock_net(skb->sk);
	struct dn_fib_table *tb;
	struct rtattr **rta = arg;
	struct rtmsg *r = NLMSG_DATA(nlh);

	if (!net_eq(net, &init_net))
		return -EINVAL;

	if (dn_fib_check_attr(r, rta))
		return -EINVAL;

	tb = dn_fib_get_table(rtm_get_table(rta, r->rtm_table), 1);
	if (tb)
		return tb->insert(tb, r, (struct dn_kern_rta *)rta, nlh, &NETLINK_CB(skb));

	return -ENOBUFS;
}

static void fib_magic(int cmd, int type, __le16 dst, int dst_len, struct dn_ifaddr *ifa)
{
	struct dn_fib_table *tb;
	struct {
		struct nlmsghdr nlh;
		struct rtmsg rtm;
	} req;
	struct dn_kern_rta rta;

	memset(&req.rtm, 0, sizeof(req.rtm));
	memset(&rta, 0, sizeof(rta));

	if (type == RTN_UNICAST)
		tb = dn_fib_get_table(RT_MIN_TABLE, 1);
	else
		tb = dn_fib_get_table(RT_TABLE_LOCAL, 1);

	if (tb == NULL)
		return;

	req.nlh.nlmsg_len = sizeof(req);
	req.nlh.nlmsg_type = cmd;
	req.nlh.nlmsg_flags = NLM_F_REQUEST|NLM_F_CREATE|NLM_F_APPEND;
	req.nlh.nlmsg_pid = 0;
	req.nlh.nlmsg_seq = 0;

	req.rtm.rtm_dst_len = dst_len;
	req.rtm.rtm_table = tb->n;
	req.rtm.rtm_protocol = RTPROT_KERNEL;
	req.rtm.rtm_scope = (type != RTN_LOCAL ? RT_SCOPE_LINK : RT_SCOPE_HOST);
	req.rtm.rtm_type = type;

	rta.rta_dst = &dst;
	rta.rta_prefsrc = &ifa->ifa_local;
	rta.rta_oif = &ifa->ifa_dev->dev->ifindex;

	if (cmd == RTM_NEWROUTE)
		tb->insert(tb, &req.rtm, &rta, &req.nlh, NULL);
	else
		tb->delete(tb, &req.rtm, &rta, &req.nlh, NULL);
}

static void dn_fib_add_ifaddr(struct dn_ifaddr *ifa)
{

	fib_magic(RTM_NEWROUTE, RTN_LOCAL, ifa->ifa_local, 16, ifa);

#if 0
	if (!(dev->flags&IFF_UP))
		return;
	/* In the future, we will want to add default routes here */

#endif
}

static void dn_fib_del_ifaddr(struct dn_ifaddr *ifa)
{
	int found_it = 0;
	struct net_device *dev;
	struct dn_dev *dn_db;
	struct dn_ifaddr *ifa2;

	ASSERT_RTNL();

	/* Scan device list */
	rcu_read_lock();
	for_each_netdev_rcu(&init_net, dev) {
		dn_db = rcu_dereference(dev->dn_ptr);
		if (dn_db == NULL)
			continue;
		for (ifa2 = rcu_dereference(dn_db->ifa_list);
		     ifa2 != NULL;
		     ifa2 = rcu_dereference(ifa2->ifa_next)) {
			if (ifa2->ifa_local == ifa->ifa_local) {
				found_it = 1;
				break;
			}
		}
	}
	rcu_read_unlock();

	if (found_it == 0) {
		fib_magic(RTM_DELROUTE, RTN_LOCAL, ifa->ifa_local, 16, ifa);

		if (dnet_addr_type(ifa->ifa_local) != RTN_LOCAL) {
			if (dn_fib_sync_down(ifa->ifa_local, NULL, 0))
				dn_fib_flush();
		}
	}
}

static void dn_fib_disable_addr(struct net_device *dev, int force)
{
	if (dn_fib_sync_down(0, dev, force))
		dn_fib_flush();
	dn_rt_cache_flush(0);
	neigh_ifdown(&dn_neigh_table, dev);
}

static int dn_fib_dnaddr_event(struct notifier_block *this, unsigned long event, void *ptr)
{
	struct dn_ifaddr *ifa = (struct dn_ifaddr *)ptr;

	switch(event) {
		case NETDEV_UP:
			dn_fib_add_ifaddr(ifa);
			dn_fib_sync_up(ifa->ifa_dev->dev);
			dn_rt_cache_flush(-1);
			break;
		case NETDEV_DOWN:
			dn_fib_del_ifaddr(ifa);
			if (ifa->ifa_dev && ifa->ifa_dev->ifa_list == NULL) {
				dn_fib_disable_addr(ifa->ifa_dev->dev, 1);
			} else {
				dn_rt_cache_flush(-1);
			}
			break;
	}
	return NOTIFY_DONE;
}

static int dn_fib_sync_down(__le16 local, struct net_device *dev, int force)
{
	int ret = 0;
	int scope = RT_SCOPE_NOWHERE;

	if (force)
		scope = -1;

	for_fib_info() {
		/*
		 * This makes no sense for DECnet.... we will almost
		 * certainly have more than one local address the same
		 * over all our interfaces. It needs thinking about
		 * some more.
		 */
		if (local && fi->fib_prefsrc == local) {
			fi->fib_flags |= RTNH_F_DEAD;
			ret++;
		} else if (dev && fi->fib_nhs) {
			int dead = 0;

			change_nexthops(fi) {
				if (nh->nh_flags&RTNH_F_DEAD)
					dead++;
				else if (nh->nh_dev == dev &&
						nh->nh_scope != scope) {
					spin_lock_bh(&dn_fib_multipath_lock);
					nh->nh_flags |= RTNH_F_DEAD;
					fi->fib_power -= nh->nh_power;
					nh->nh_power = 0;
					spin_unlock_bh(&dn_fib_multipath_lock);
					dead++;
				}
			} endfor_nexthops(fi)
			if (dead == fi->fib_nhs) {
				fi->fib_flags |= RTNH_F_DEAD;
				ret++;
			}
		}
	} endfor_fib_info();
	return ret;
}


static int dn_fib_sync_up(struct net_device *dev)
{
	int ret = 0;

	if (!(dev->flags&IFF_UP))
		return 0;

	for_fib_info() {
		int alive = 0;

		change_nexthops(fi) {
			if (!(nh->nh_flags&RTNH_F_DEAD)) {
				alive++;
				continue;
			}
			if (nh->nh_dev == NULL || !(nh->nh_dev->flags&IFF_UP))
				continue;
			if (nh->nh_dev != dev || dev->dn_ptr == NULL)
				continue;
			alive++;
			spin_lock_bh(&dn_fib_multipath_lock);
			nh->nh_power = 0;
			nh->nh_flags &= ~RTNH_F_DEAD;
			spin_unlock_bh(&dn_fib_multipath_lock);
		} endfor_nexthops(fi);

		if (alive > 0) {
			fi->fib_flags &= ~RTNH_F_DEAD;
			ret++;
		}
	} endfor_fib_info();
	return ret;
}

static struct notifier_block dn_fib_dnaddr_notifier = {
	.notifier_call = dn_fib_dnaddr_event,
};

void __exit dn_fib_cleanup(void)
{
	dn_fib_table_cleanup();
	dn_fib_rules_cleanup();

	unregister_dnaddr_notifier(&dn_fib_dnaddr_notifier);
}


void __init dn_fib_init(void)
{
	dn_fib_table_init();
	dn_fib_rules_init();

	register_dnaddr_notifier(&dn_fib_dnaddr_notifier);

	rtnl_register(PF_DECnet, RTM_NEWROUTE, dn_fib_rtm_newroute, NULL);
	rtnl_register(PF_DECnet, RTM_DELROUTE, dn_fib_rtm_delroute, NULL);
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* DECnet An implementation of the DECnet protocol suite for the LINUX
	3	* operating system. DECnet is implemented using the BSD Socket
	4	* interface as the means of communication with the user level.
	5	*
	6	* DECnet Routing Forwarding Information Base (Glue/Info List)
	7	*
	8	* Author: Steve Whitehouse <SteveW@ACM.org>
	9	*
	10	*
	11	* Changes:
	12	* Alexey Kuznetsov : SMP locking changes
	13	* Steve Whitehouse : Rewrote it... Well to be more correct, I
	14	* copied most of it from the ipv4 fib code.
	15	* Steve Whitehouse : Updated it in style and fixed a few bugs
	16	* which were fixed in the ipv4 code since
	17	* this code was copied from it.
	18	*
	19	*/
1da177e4 LT	20	#include <linux/string.h>
	21	#include <linux/net.h>
	22	#include <linux/socket.h>
5a0e3ad6	23	#include <linux/slab.h>
1da177e4 LT	24	#include <linux/sockios.h>
	25	#include <linux/init.h>
	26	#include <linux/skbuff.h>
	27	#include <linux/netlink.h>
	28	#include <linux/rtnetlink.h>
	29	#include <linux/proc_fs.h>
	30	#include <linux/netdevice.h>
	31	#include <linux/timer.h>
	32	#include <linux/spinlock.h>
	33	#include <asm/atomic.h>
	34	#include <asm/uaccess.h>
	35	#include <net/neighbour.h>
	36	#include <net/dst.h>
	37	#include <net/flow.h>
a8731cbf	38	#include <net/fib_rules.h>
1da177e4 LT	39	#include <net/dn.h>
	40	#include <net/dn_route.h>
	41	#include <net/dn_fib.h>
	42	#include <net/dn_neigh.h>
	43	#include <net/dn_dev.h>
	44
	45	#define RT_MIN_TABLE 1
	46
	47	#define for_fib_info() { struct dn_fib_info *fi;\
	48	for(fi = dn_fib_info_list; fi; fi = fi->fib_next)
	49	#define endfor_fib_info() }
	50
	51	#define for_nexthops(fi) { int nhsel; const struct dn_fib_nh *nh;\
	52	for(nhsel = 0, nh = (fi)->fib_nh; nhsel < (fi)->fib_nhs; nh++, nhsel++)
	53
	54	#define change_nexthops(fi) { int nhsel; struct dn_fib_nh *nh;\
	55	for(nhsel = 0, nh = (struct dn_fib_nh *)((fi)->fib_nh); nhsel < (fi)->fib_nhs; nh++, nhsel++)
	56
	57	#define endfor_nexthops(fi) }
	58
1da177e4 LT	59	static DEFINE_SPINLOCK(dn_fib_multipath_lock);
1da177e4 LT	60	static struct dn_fib_info *dn_fib_info_list;
a22ec367	61	static DEFINE_SPINLOCK(dn_fib_info_lock);
1da177e4 LT	62
	63	static struct
	64	{
	65	int error;
	66	u8 scope;
a9791011	67	} dn_fib_props[RTN_MAX+1] = {
1da177e4 LT	68	[RTN_UNSPEC] = { .error = 0, .scope = RT_SCOPE_NOWHERE },
	69	[RTN_UNICAST] = { .error = 0, .scope = RT_SCOPE_UNIVERSE },
	70	[RTN_LOCAL] = { .error = 0, .scope = RT_SCOPE_HOST },
	71	[RTN_BROADCAST] = { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
	72	[RTN_ANYCAST] = { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
	73	[RTN_MULTICAST] = { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
	74	[RTN_BLACKHOLE] = { .error = -EINVAL, .scope = RT_SCOPE_UNIVERSE },
	75	[RTN_UNREACHABLE] = { .error = -EHOSTUNREACH, .scope = RT_SCOPE_UNIVERSE },
	76	[RTN_PROHIBIT] = { .error = -EACCES, .scope = RT_SCOPE_UNIVERSE },
	77	[RTN_THROW] = { .error = -EAGAIN, .scope = RT_SCOPE_UNIVERSE },
	78	[RTN_NAT] = { .error = 0, .scope = RT_SCOPE_NOWHERE },
	79	[RTN_XRESOLVE] = { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
	80	};
	81
2aa7f36c AB	82	static int dn_fib_sync_down(__le16 local, struct net_device *dev, int force);
	83	static int dn_fib_sync_up(struct net_device *dev);
	84
1da177e4 LT	85	void dn_fib_free_info(struct dn_fib_info *fi)
	86	{
	87	if (fi->fib_dead == 0) {
	88	printk(KERN_DEBUG "DECnet: BUG! Attempt to free alive dn_fib_info\n");
	89	return;
	90	}
	91
	92	change_nexthops(fi) {
	93	if (nh->nh_dev)
	94	dev_put(nh->nh_dev);
	95	nh->nh_dev = NULL;
	96	} endfor_nexthops(fi);
	97	kfree(fi);
	98	}
	99
	100	void dn_fib_release_info(struct dn_fib_info *fi)
	101	{
a22ec367	102	spin_lock(&dn_fib_info_lock);
1da177e4 LT	103	if (fi && --fi->fib_treeref == 0) {
	104	if (fi->fib_next)
	105	fi->fib_next->fib_prev = fi->fib_prev;
	106	if (fi->fib_prev)
	107	fi->fib_prev->fib_next = fi->fib_next;
	108	if (fi == dn_fib_info_list)
	109	dn_fib_info_list = fi->fib_next;
	110	fi->fib_dead = 1;
	111	dn_fib_info_put(fi);
	112	}
a22ec367	113	spin_unlock(&dn_fib_info_lock);
1da177e4 LT	114	}
	115
	116	static inline int dn_fib_nh_comp(const struct dn_fib_info fi, const struct dn_fib_info ofi)
	117	{
	118	const struct dn_fib_nh *onh = ofi->fib_nh;
	119
	120	for_nexthops(fi) {
	121	if (nh->nh_oif != onh->nh_oif \|\|
	122	nh->nh_gw != onh->nh_gw \|\|
	123	nh->nh_scope != onh->nh_scope \|\|
	124	nh->nh_weight != onh->nh_weight \|\|
	125	((nh->nh_flags^onh->nh_flags)&~RTNH_F_DEAD))
	126	return -1;
	127	onh++;
	128	} endfor_nexthops(fi);
	129	return 0;
	130	}
	131
	132	static inline struct dn_fib_info dn_fib_find_info(const struct dn_fib_info nfi)
	133	{
	134	for_fib_info() {
	135	if (fi->fib_nhs != nfi->fib_nhs)
	136	continue;
	137	if (nfi->fib_protocol == fi->fib_protocol &&
	138	nfi->fib_prefsrc == fi->fib_prefsrc &&
	139	nfi->fib_priority == fi->fib_priority &&
	140	memcmp(nfi->fib_metrics, fi->fib_metrics, sizeof(fi->fib_metrics)) == 0 &&
	141	((nfi->fib_flags^fi->fib_flags)&~RTNH_F_DEAD) == 0 &&
	142	(nfi->fib_nhs == 0 \|\| dn_fib_nh_comp(fi, nfi) == 0))
	143	return fi;
	144	} endfor_fib_info();
	145	return NULL;
	146	}
	147
c4ea94ab	148	__le16 dn_fib_get_attr16(struct rtattr *attr, int attrlen, int type)
1da177e4 LT	149	{
	150	while(RTA_OK(attr,attrlen)) {
	151	if (attr->rta_type == type)
c4ea94ab	152	return (__le16)RTA_DATA(attr);
1da177e4 LT	153	attr = RTA_NEXT(attr, attrlen);
	154	}
	155
	156	return 0;
	157	}
	158
	159	static int dn_fib_count_nhs(struct rtattr *rta)
	160	{
	161	int nhs = 0;
	162	struct rtnexthop *nhp = RTA_DATA(rta);
	163	int nhlen = RTA_PAYLOAD(rta);
	164
	165	while(nhlen >= (int)sizeof(struct rtnexthop)) {
	166	if ((nhlen -= nhp->rtnh_len) < 0)
	167	return 0;
	168	nhs++;
	169	nhp = RTNH_NEXT(nhp);
	170	}
	171
	172	return nhs;
	173	}
	174
	175	static int dn_fib_get_nhs(struct dn_fib_info fi, const struct rtattr rta, const struct rtmsg *r)
	176	{
	177	struct rtnexthop *nhp = RTA_DATA(rta);
	178	int nhlen = RTA_PAYLOAD(rta);
	179
	180	change_nexthops(fi) {
	181	int attrlen = nhlen - sizeof(struct rtnexthop);
	182	if (attrlen < 0 \|\| (nhlen -= nhp->rtnh_len) < 0)
	183	return -EINVAL;
	184
	185	nh->nh_flags = (r->rtm_flags&~0xFF) \| nhp->rtnh_flags;
	186	nh->nh_oif = nhp->rtnh_ifindex;
	187	nh->nh_weight = nhp->rtnh_hops + 1;
	188
	189	if (attrlen) {
	190	nh->nh_gw = dn_fib_get_attr16(RTNH_DATA(nhp), attrlen, RTA_GATEWAY);
	191	}
	192	nhp = RTNH_NEXT(nhp);
	193	} endfor_nexthops(fi);
	194
	195	return 0;
	196	}
	197
	198
	199	static int dn_fib_check_nh(const struct rtmsg r, struct dn_fib_info fi, struct dn_fib_nh *nh)
	200	{
	201	int err;
	202
	203	if (nh->nh_gw) {
	204	struct flowi fl;
	205	struct dn_fib_res res;
	206
1da177e4 LT	207	if (nh->nh_flags&RTNH_F_ONLINK) {
	208	struct net_device *dev;
	209
	210	if (r->rtm_scope >= RT_SCOPE_LINK)
	211	return -EINVAL;
	212	if (dnet_addr_type(nh->nh_gw) != RTN_UNICAST)
	213	return -EINVAL;
881d966b	214	if ((dev = __dev_get_by_index(&init_net, nh->nh_oif)) == NULL)
1da177e4 LT	215	return -ENODEV;
	216	if (!(dev->flags&IFF_UP))
	217	return -ENETDOWN;
	218	nh->nh_dev = dev;
	219	dev_hold(dev);
	220	nh->nh_scope = RT_SCOPE_LINK;
	221	return 0;
	222	}
	223
	224	memset(&fl, 0, sizeof(fl));
	225	fl.fld_dst = nh->nh_gw;
	226	fl.oif = nh->nh_oif;
	227	fl.fld_scope = r->rtm_scope + 1;
	228
	229	if (fl.fld_scope < RT_SCOPE_LINK)
	230	fl.fld_scope = RT_SCOPE_LINK;
	231
	232	if ((err = dn_fib_lookup(&fl, &res)) != 0)
	233	return err;
	234
	235	err = -EINVAL;
	236	if (res.type != RTN_UNICAST && res.type != RTN_LOCAL)
	237	goto out;
	238	nh->nh_scope = res.scope;
	239	nh->nh_oif = DN_FIB_RES_OIF(res);
	240	nh->nh_dev = DN_FIB_RES_DEV(res);
	241	if (nh->nh_dev == NULL)
	242	goto out;
	243	dev_hold(nh->nh_dev);
	244	err = -ENETDOWN;
	245	if (!(nh->nh_dev->flags & IFF_UP))
	246	goto out;
	247	err = 0;
	248	out:
	249	dn_fib_res_put(&res);
	250	return err;
	251	} else {
	252	struct net_device *dev;
	253
	254	if (nh->nh_flags&(RTNH_F_PERVASIVE\|RTNH_F_ONLINK))
	255	return -EINVAL;
	256
881d966b	257	dev = __dev_get_by_index(&init_net, nh->nh_oif);
1da177e4 LT	258	if (dev == NULL \|\| dev->dn_ptr == NULL)
	259	return -ENODEV;
	260	if (!(dev->flags&IFF_UP))
	261	return -ENETDOWN;
	262	nh->nh_dev = dev;
	263	dev_hold(nh->nh_dev);
	264	nh->nh_scope = RT_SCOPE_HOST;
	265	}
	266
	267	return 0;
	268	}
	269
	270
	271	struct dn_fib_info dn_fib_create_info(const struct rtmsg r, struct dn_kern_rta rta, const struct nlmsghdr nlh, int *errp)
	272	{
	273	int err;
	274	struct dn_fib_info *fi = NULL;
	275	struct dn_fib_info *ofi;
	276	int nhs = 1;
	277
a9791011 TG	278	if (r->rtm_type > RTN_MAX)
	279	goto err_inval;
	280
1da177e4 LT	281	if (dn_fib_props[r->rtm_type].scope > r->rtm_scope)
	282	goto err_inval;
	283
	284	if (rta->rta_mp) {
	285	nhs = dn_fib_count_nhs(rta->rta_mp);
	286	if (nhs == 0)
	287	goto err_inval;
	288	}
	289
0da974f4	290	fi = kzalloc(sizeof(fi)+nhssizeof(struct dn_fib_nh), GFP_KERNEL);
1da177e4 LT	291	err = -ENOBUFS;
	292	if (fi == NULL)
	293	goto failure;
1da177e4 LT	294
	295	fi->fib_protocol = r->rtm_protocol;
	296	fi->fib_nhs = nhs;
	297	fi->fib_flags = r->rtm_flags;
	298	if (rta->rta_priority)
	299	fi->fib_priority = *rta->rta_priority;
	300	if (rta->rta_mx) {
	301	int attrlen = RTA_PAYLOAD(rta->rta_mx);
	302	struct rtattr *attr = RTA_DATA(rta->rta_mx);
	303
	304	while(RTA_OK(attr, attrlen)) {
	305	unsigned flavour = attr->rta_type;
	306	if (flavour) {
	307	if (flavour > RTAX_MAX)
	308	goto err_inval;
	309	fi->fib_metrics[flavour-1] = (unsigned)RTA_DATA(attr);
	310	}
	311	attr = RTA_NEXT(attr, attrlen);
	312	}
	313	}
	314	if (rta->rta_prefsrc)
	315	memcpy(&fi->fib_prefsrc, rta->rta_prefsrc, 2);
	316
	317	if (rta->rta_mp) {
	318	if ((err = dn_fib_get_nhs(fi, rta->rta_mp, r)) != 0)
	319	goto failure;
	320	if (rta->rta_oif && fi->fib_nh->nh_oif != *rta->rta_oif)
	321	goto err_inval;
	322	if (rta->rta_gw && memcmp(&fi->fib_nh->nh_gw, rta->rta_gw, 2))
	323	goto err_inval;
	324	} else {
	325	struct dn_fib_nh *nh = fi->fib_nh;
	326	if (rta->rta_oif)
	327	nh->nh_oif = *rta->rta_oif;
	328	if (rta->rta_gw)
	329	memcpy(&nh->nh_gw, rta->rta_gw, 2);
	330	nh->nh_flags = r->rtm_flags;
	331	nh->nh_weight = 1;
	332	}
	333
	334	if (r->rtm_type == RTN_NAT) {
	335	if (rta->rta_gw == NULL \|\| nhs != 1 \|\| rta->rta_oif)
	336	goto err_inval;
	337	memcpy(&fi->fib_nh->nh_gw, rta->rta_gw, 2);
	338	goto link_it;
	339	}
	340
	341	if (dn_fib_props[r->rtm_type].error) {
	342	if (rta->rta_gw \|\| rta->rta_oif \|\| rta->rta_mp)
	343	goto err_inval;
	344	goto link_it;
	345	}
	346
	347	if (r->rtm_scope > RT_SCOPE_HOST)
	348	goto err_inval;
	349
	350	if (r->rtm_scope == RT_SCOPE_HOST) {
	351	struct dn_fib_nh *nh = fi->fib_nh;
	352
	353	/* Local address is added */
	354	if (nhs != 1 \|\| nh->nh_gw)
	355	goto err_inval;
	356	nh->nh_scope = RT_SCOPE_NOWHERE;
881d966b	357	nh->nh_dev = dev_get_by_index(&init_net, fi->fib_nh->nh_oif);
1da177e4 LT	358	err = -ENODEV;
	359	if (nh->nh_dev == NULL)
	360	goto failure;
	361	} else {
	362	change_nexthops(fi) {
	363	if ((err = dn_fib_check_nh(r, fi, nh)) != 0)
	364	goto failure;
	365	} endfor_nexthops(fi)
	366	}
	367
	368	if (fi->fib_prefsrc) {
	369	if (r->rtm_type != RTN_LOCAL \|\| rta->rta_dst == NULL \|\|
	370	memcmp(&fi->fib_prefsrc, rta->rta_dst, 2))
	371	if (dnet_addr_type(fi->fib_prefsrc) != RTN_LOCAL)
	372	goto err_inval;
	373	}
	374
	375	link_it:
	376	if ((ofi = dn_fib_find_info(fi)) != NULL) {
	377	fi->fib_dead = 1;
	378	dn_fib_free_info(fi);
	379	ofi->fib_treeref++;
	380	return ofi;
	381	}
	382
	383	fi->fib_treeref++;
	384	atomic_inc(&fi->fib_clntref);
a22ec367	385	spin_lock(&dn_fib_info_lock);
1da177e4 LT	386	fi->fib_next = dn_fib_info_list;
	387	fi->fib_prev = NULL;
	388	if (dn_fib_info_list)
	389	dn_fib_info_list->fib_prev = fi;
	390	dn_fib_info_list = fi;
a22ec367	391	spin_unlock(&dn_fib_info_lock);
1da177e4 LT	392	return fi;
	393
	394	err_inval:
	395	err = -EINVAL;
	396
	397	failure:
	398	*errp = err;
	399	if (fi) {
	400	fi->fib_dead = 1;
	401	dn_fib_free_info(fi);
	402	}
	403
	404	return NULL;
	405	}
	406
	407	int dn_fib_semantic_match(int type, struct dn_fib_info fi, const struct flowi fl, struct dn_fib_res *res)
	408	{
	409	int err = dn_fib_props[type].error;
	410
	411	if (err == 0) {
	412	if (fi->fib_flags & RTNH_F_DEAD)
	413	return 1;
	414
	415	res->fi = fi;
	416
	417	switch(type) {
	418	case RTN_NAT:
	419	DN_FIB_RES_RESET(*res);
	420	atomic_inc(&fi->fib_clntref);
	421	return 0;
	422	case RTN_UNICAST:
	423	case RTN_LOCAL:
	424	for_nexthops(fi) {
	425	if (nh->nh_flags & RTNH_F_DEAD)
	426	continue;
	427	if (!fl->oif \|\| fl->oif == nh->nh_oif)
	428	break;
	429	}
	430	if (nhsel < fi->fib_nhs) {
	431	res->nh_sel = nhsel;
	432	atomic_inc(&fi->fib_clntref);
	433	return 0;
	434	}
	435	endfor_nexthops(fi);
	436	res->fi = NULL;
	437	return 1;
	438	default:
	439	if (net_ratelimit())
	440	printk("DECnet: impossible routing event : dn_fib_semantic_match type=%d\n", type);
	441	res->fi = NULL;
	442	return -EINVAL;
	443	}
	444	}
	445	return err;
	446	}
	447
	448	void dn_fib_select_multipath(const struct flowi fl, struct dn_fib_res res)
	449	{
	450	struct dn_fib_info *fi = res->fi;
	451	int w;
	452
	453	spin_lock_bh(&dn_fib_multipath_lock);
	454	if (fi->fib_power <= 0) {
	455	int power = 0;
456	change_nexthops(fi) {
457	if (!(nh->nh_flags&RTNH_F_DEAD)) {
458	power += nh->nh_weight;
459	nh->nh_power = nh->nh_weight;
460	}
461	} endfor_nexthops(fi);
462	fi->fib_power = power;
463	if (power < 0) {
464	spin_unlock_bh(&dn_fib_multipath_lock);
465	res->nh_sel = 0;
466	return;
467	}
468	}
469
470	w = jiffies % fi->fib_power;
471
472	change_nexthops(fi) {
473	if (!(nh->nh_flags&RTNH_F_DEAD) && nh->nh_power) {
474	if ((w -= nh->nh_power) <= 0) {
475	nh->nh_power--;
476	fi->fib_power--;
477	res->nh_sel = nhsel;
478	spin_unlock_bh(&dn_fib_multipath_lock);
479	return;
480	}
481	}
482	} endfor_nexthops(fi);
483	res->nh_sel = 0;
484	spin_unlock_bh(&dn_fib_multipath_lock);
485	}
486
487
488	static int dn_fib_check_attr(struct rtmsg r, struct rtattr *rta)
489	{
490	int i;
491
492	for(i = 1; i <= RTA_MAX; i++) {
493	struct rtattr *attr = rta[i-1];
494	if (attr) {
495	if (RTA_PAYLOAD(attr) < 4 && RTA_PAYLOAD(attr) != 2)
496	return -EINVAL;
9e762a4a PM	497	if (i != RTA_MULTIPATH && i != RTA_METRICS &&
9e762a4a PM	498	i != RTA_TABLE)
1da177e4 LT	499	rta[i-1] = (struct rtattr *)RTA_DATA(attr);
	500	}
	501	}
	502
	503	return 0;
	504	}
	505
fa34ddd7	506	static int dn_fib_rtm_delroute(struct sk_buff skb, struct nlmsghdr nlh, void *arg)
1da177e4	507	{
3b1e0a65	508	struct net *net = sock_net(skb->sk);
1da177e4 LT	509	struct dn_fib_table *tb;
	510	struct rtattr **rta = arg;
	511	struct rtmsg *r = NLMSG_DATA(nlh);
	512
09ad9bc7	513	if (!net_eq(net, &init_net))
b854272b DL	514	return -EINVAL;
b854272b DL	515
1da177e4 LT	516	if (dn_fib_check_attr(r, rta))
	517	return -EINVAL;
	518
9e762a4a	519	tb = dn_fib_get_table(rtm_get_table(rta, r->rtm_table), 0);
1da177e4 LT	520	if (tb)
	521	return tb->delete(tb, r, (struct dn_kern_rta *)rta, nlh, &NETLINK_CB(skb));
	522
	523	return -ESRCH;
	524	}
	525
fa34ddd7	526	static int dn_fib_rtm_newroute(struct sk_buff skb, struct nlmsghdr nlh, void *arg)
1da177e4	527	{
3b1e0a65	528	struct net *net = sock_net(skb->sk);
1da177e4 LT	529	struct dn_fib_table *tb;
	530	struct rtattr **rta = arg;
	531	struct rtmsg *r = NLMSG_DATA(nlh);
	532
09ad9bc7	533	if (!net_eq(net, &init_net))
b854272b DL	534	return -EINVAL;
b854272b DL	535
1da177e4 LT	536	if (dn_fib_check_attr(r, rta))
	537	return -EINVAL;
	538
9e762a4a	539	tb = dn_fib_get_table(rtm_get_table(rta, r->rtm_table), 1);
429eb0fa	540	if (tb)
1da177e4 LT	541	return tb->insert(tb, r, (struct dn_kern_rta *)rta, nlh, &NETLINK_CB(skb));
	542
	543	return -ENOBUFS;
	544	}
	545
c4ea94ab	546	static void fib_magic(int cmd, int type, __le16 dst, int dst_len, struct dn_ifaddr *ifa)
1da177e4 LT	547	{
	548	struct dn_fib_table *tb;
	549	struct {
	550	struct nlmsghdr nlh;
	551	struct rtmsg rtm;
	552	} req;
	553	struct dn_kern_rta rta;
	554
	555	memset(&req.rtm, 0, sizeof(req.rtm));
	556	memset(&rta, 0, sizeof(rta));
	557
	558	if (type == RTN_UNICAST)
	559	tb = dn_fib_get_table(RT_MIN_TABLE, 1);
	560	else
	561	tb = dn_fib_get_table(RT_TABLE_LOCAL, 1);
	562
	563	if (tb == NULL)
	564	return;
	565
	566	req.nlh.nlmsg_len = sizeof(req);
	567	req.nlh.nlmsg_type = cmd;
	568	req.nlh.nlmsg_flags = NLM_F_REQUEST\|NLM_F_CREATE\|NLM_F_APPEND;
	569	req.nlh.nlmsg_pid = 0;
	570	req.nlh.nlmsg_seq = 0;
	571
	572	req.rtm.rtm_dst_len = dst_len;
	573	req.rtm.rtm_table = tb->n;
	574	req.rtm.rtm_protocol = RTPROT_KERNEL;
	575	req.rtm.rtm_scope = (type != RTN_LOCAL ? RT_SCOPE_LINK : RT_SCOPE_HOST);
	576	req.rtm.rtm_type = type;
	577
	578	rta.rta_dst = &dst;
	579	rta.rta_prefsrc = &ifa->ifa_local;
	580	rta.rta_oif = &ifa->ifa_dev->dev->ifindex;
	581
	582	if (cmd == RTM_NEWROUTE)
	583	tb->insert(tb, &req.rtm, &rta, &req.nlh, NULL);
	584	else
	585	tb->delete(tb, &req.rtm, &rta, &req.nlh, NULL);
	586	}
	587
	588	static void dn_fib_add_ifaddr(struct dn_ifaddr *ifa)
	589	{
	590
	591	fib_magic(RTM_NEWROUTE, RTN_LOCAL, ifa->ifa_local, 16, ifa);
	592
	593	#if 0
	594	if (!(dev->flags&IFF_UP))
	595	return;
	596	/* In the future, we will want to add default routes here */
	597
	598	#endif
	599	}
	600
	601	static void dn_fib_del_ifaddr(struct dn_ifaddr *ifa)
	602	{
	603	int found_it = 0;
	604	struct net_device *dev;
	605	struct dn_dev *dn_db;
	606	struct dn_ifaddr *ifa2;
	607
	608	ASSERT_RTNL();
	609
	610	/* Scan device list */
c6d14c84 ED	611	rcu_read_lock();
c6d14c84 ED	612	for_each_netdev_rcu(&init_net, dev) {
fc766e4c	613	dn_db = rcu_dereference(dev->dn_ptr);
1da177e4 LT	614	if (dn_db == NULL)
1da177e4 LT	615	continue;
fc766e4c ED	616	for (ifa2 = rcu_dereference(dn_db->ifa_list);
	617	ifa2 != NULL;
	618	ifa2 = rcu_dereference(ifa2->ifa_next)) {
1da177e4 LT	619	if (ifa2->ifa_local == ifa->ifa_local) {
	620	found_it = 1;
	621	break;
	622	}
	623	}
	624	}
c6d14c84	625	rcu_read_unlock();
1da177e4 LT	626
	627	if (found_it == 0) {
	628	fib_magic(RTM_DELROUTE, RTN_LOCAL, ifa->ifa_local, 16, ifa);
	629
	630	if (dnet_addr_type(ifa->ifa_local) != RTN_LOCAL) {
	631	if (dn_fib_sync_down(ifa->ifa_local, NULL, 0))
	632	dn_fib_flush();
	633	}
	634	}
	635	}
	636
	637	static void dn_fib_disable_addr(struct net_device *dev, int force)
	638	{
	639	if (dn_fib_sync_down(0, dev, force))
	640	dn_fib_flush();
	641	dn_rt_cache_flush(0);
	642	neigh_ifdown(&dn_neigh_table, dev);
	643	}
	644
	645	static int dn_fib_dnaddr_event(struct notifier_block this, unsigned long event, void ptr)
	646	{
	647	struct dn_ifaddr ifa = (struct dn_ifaddr )ptr;
	648
	649	switch(event) {
	650	case NETDEV_UP:
	651	dn_fib_add_ifaddr(ifa);
	652	dn_fib_sync_up(ifa->ifa_dev->dev);
	653	dn_rt_cache_flush(-1);
	654	break;
	655	case NETDEV_DOWN:
	656	dn_fib_del_ifaddr(ifa);
	657	if (ifa->ifa_dev && ifa->ifa_dev->ifa_list == NULL) {
	658	dn_fib_disable_addr(ifa->ifa_dev->dev, 1);
	659	} else {
	660	dn_rt_cache_flush(-1);
	661	}
	662	break;
	663	}
	664	return NOTIFY_DONE;
	665	}
	666
2aa7f36c	667	static int dn_fib_sync_down(__le16 local, struct net_device *dev, int force)
1da177e4	668	{
429eb0fa YH	669	int ret = 0;
	670	int scope = RT_SCOPE_NOWHERE;
	671
	672	if (force)
	673	scope = -1;
	674
	675	for_fib_info() {
	676	/*
	677	* This makes no sense for DECnet.... we will almost
	678	* certainly have more than one local address the same
	679	* over all our interfaces. It needs thinking about
	680	* some more.
	681	*/
	682	if (local && fi->fib_prefsrc == local) {
	683	fi->fib_flags \|= RTNH_F_DEAD;
	684	ret++;
	685	} else if (dev && fi->fib_nhs) {
	686	int dead = 0;
	687
	688	change_nexthops(fi) {
	689	if (nh->nh_flags&RTNH_F_DEAD)
	690	dead++;
	691	else if (nh->nh_dev == dev &&
	692	nh->nh_scope != scope) {
1da177e4	693	spin_lock_bh(&dn_fib_multipath_lock);
429eb0fa YH	694	nh->nh_flags \|= RTNH_F_DEAD;
	695	fi->fib_power -= nh->nh_power;
	696	nh->nh_power = 0;
1da177e4	697	spin_unlock_bh(&dn_fib_multipath_lock);
429eb0fa YH	698	dead++;
	699	}
	700	} endfor_nexthops(fi)
	701	if (dead == fi->fib_nhs) {
	702	fi->fib_flags \|= RTNH_F_DEAD;
	703	ret++;
	704	}
	705	}
	706	} endfor_fib_info();
	707	return ret;
1da177e4 LT	708	}
	709
	710
2aa7f36c	711	static int dn_fib_sync_up(struct net_device *dev)
1da177e4	712	{
429eb0fa YH	713	int ret = 0;
	714
	715	if (!(dev->flags&IFF_UP))
	716	return 0;
	717
	718	for_fib_info() {
	719	int alive = 0;
	720
	721	change_nexthops(fi) {
	722	if (!(nh->nh_flags&RTNH_F_DEAD)) {
	723	alive++;
	724	continue;
	725	}
	726	if (nh->nh_dev == NULL \|\| !(nh->nh_dev->flags&IFF_UP))
	727	continue;
	728	if (nh->nh_dev != dev \|\| dev->dn_ptr == NULL)
	729	continue;
	730	alive++;
1da177e4	731	spin_lock_bh(&dn_fib_multipath_lock);
429eb0fa YH	732	nh->nh_power = 0;
429eb0fa YH	733	nh->nh_flags &= ~RTNH_F_DEAD;
1da177e4	734	spin_unlock_bh(&dn_fib_multipath_lock);
429eb0fa YH	735	} endfor_nexthops(fi);
	736
	737	if (alive > 0) {
	738	fi->fib_flags &= ~RTNH_F_DEAD;
	739	ret++;
	740	}
	741	} endfor_fib_info();
	742	return ret;
1da177e4 LT	743	}
1da177e4 LT	744
1da177e4 LT	745	static struct notifier_block dn_fib_dnaddr_notifier = {
	746	.notifier_call = dn_fib_dnaddr_event,
	747	};
	748
	749	void __exit dn_fib_cleanup(void)
	750	{
	751	dn_fib_table_cleanup();
	752	dn_fib_rules_cleanup();
	753
	754	unregister_dnaddr_notifier(&dn_fib_dnaddr_notifier);
	755	}
	756
	757
	758	void __init dn_fib_init(void)
	759	{
1da177e4 LT	760	dn_fib_table_init();
	761	dn_fib_rules_init();
	762
	763	register_dnaddr_notifier(&dn_fib_dnaddr_notifier);
fa34ddd7 TG	764
	765	rtnl_register(PF_DECnet, RTM_NEWROUTE, dn_fib_rtm_newroute, NULL);
	766	rtnl_register(PF_DECnet, RTM_DELROUTE, dn_fib_rtm_delroute, NULL);
1da177e4 LT	767	}
	768
	769