dn_route.c 46.3 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45
/*
 * 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 Functions (Endnode and Router)
 *
 * Authors:     Steve Whitehouse <SteveW@ACM.org>
 *              Eduardo Marcelo Serrat <emserrat@geocities.com>
 *
 * Changes:
 *              Steve Whitehouse : Fixes to allow "intra-ethernet" and
 *                                 "return-to-sender" bits on outgoing
 *                                 packets.
 *		Steve Whitehouse : Timeouts for cached routes.
 *              Steve Whitehouse : Use dst cache for input routes too.
 *              Steve Whitehouse : Fixed error values in dn_send_skb.
 *              Steve Whitehouse : Rework routing functions to better fit
 *                                 DECnet routing design
 *              Alexey Kuznetsov : New SMP locking
 *              Steve Whitehouse : More SMP locking changes & dn_cache_dump()
 *              Steve Whitehouse : Prerouting NF hook, now really is prerouting.
 *				   Fixed possible skb leak in rtnetlink funcs.
 *              Steve Whitehouse : Dave Miller's dynamic hash table sizing and
 *                                 Alexey Kuznetsov's finer grained locking
 *                                 from ipv4/route.c.
 *              Steve Whitehouse : Routing is now starting to look like a
 *                                 sensible set of code now, mainly due to
 *                                 my copying the IPv4 routing code. The
 *                                 hooks here are modified and will continue
 *                                 to evolve for a while.
 *              Steve Whitehouse : Real SMP at last :-) Also new netfilter
 *                                 stuff. Look out raw sockets your days
 *                                 are numbered!
 *              Steve Whitehouse : Added return-to-sender functions. Added
 *                                 backlog congestion level return codes.
 *		Steve Whitehouse : Fixed bug where routes were set up with
 *                                 no ref count on net devices.
 *              Steve Whitehouse : RCU for the route cache
 *              Steve Whitehouse : Preparations for the flow cache
 *              Steve Whitehouse : Prepare for nonlinear skbs
 */

/******************************************************************************
    (c) 1995-1998 E.M. Serrat		emserrat@geocities.com
46

L
Linus Torvalds 已提交
47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68
    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
    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.
*******************************************************************************/

#include <linux/errno.h>
#include <linux/types.h>
#include <linux/socket.h>
#include <linux/in.h>
#include <linux/kernel.h>
#include <linux/sockios.h>
#include <linux/net.h>
#include <linux/netdevice.h>
#include <linux/inet.h>
#include <linux/route.h>
#include <linux/in_route.h>
69
#include <linux/slab.h>
L
Linus Torvalds 已提交
70 71 72 73 74 75 76 77 78 79
#include <net/sock.h>
#include <linux/mm.h>
#include <linux/proc_fs.h>
#include <linux/seq_file.h>
#include <linux/init.h>
#include <linux/rtnetlink.h>
#include <linux/string.h>
#include <linux/netfilter_decnet.h>
#include <linux/rcupdate.h>
#include <linux/times.h>
80
#include <linux/export.h>
L
Linus Torvalds 已提交
81
#include <asm/errno.h>
82
#include <net/net_namespace.h>
83
#include <net/netlink.h>
L
Linus Torvalds 已提交
84 85 86
#include <net/neighbour.h>
#include <net/dst.h>
#include <net/flow.h>
87
#include <net/fib_rules.h>
L
Linus Torvalds 已提交
88 89 90 91 92 93 94 95 96
#include <net/dn.h>
#include <net/dn_dev.h>
#include <net/dn_nsp.h>
#include <net/dn_route.h>
#include <net/dn_neigh.h>
#include <net/dn_fib.h>

struct dn_rt_hash_bucket
{
97
	struct dn_route __rcu *chain;
L
Linus Torvalds 已提交
98
	spinlock_t lock;
99
};
L
Linus Torvalds 已提交
100 101 102 103 104 105 106 107 108 109 110 111

extern struct neigh_table dn_neigh_table;


static unsigned char dn_hiord_addr[6] = {0xAA,0x00,0x04,0x00,0x00,0x00};

static const int dn_rt_min_delay = 2 * HZ;
static const int dn_rt_max_delay = 10 * HZ;
static const int dn_rt_mtu_expires = 10 * 60 * HZ;

static unsigned long dn_rt_deadline;

112
static int dn_dst_gc(struct dst_ops *ops);
L
Linus Torvalds 已提交
113
static struct dst_entry *dn_dst_check(struct dst_entry *, __u32);
114
static unsigned int dn_dst_default_advmss(const struct dst_entry *dst);
115
static unsigned int dn_dst_mtu(const struct dst_entry *dst);
116
static void dn_dst_destroy(struct dst_entry *);
117
static void dn_dst_ifdown(struct dst_entry *, struct net_device *dev, int how);
L
Linus Torvalds 已提交
118 119 120
static struct dst_entry *dn_dst_negative_advice(struct dst_entry *);
static void dn_dst_link_failure(struct sk_buff *);
static void dn_dst_update_pmtu(struct dst_entry *dst, u32 mtu);
121 122 123
static struct neighbour *dn_dst_neigh_lookup(const struct dst_entry *dst,
					     struct sk_buff *skb,
					     const void *daddr);
L
Linus Torvalds 已提交
124 125 126 127
static int dn_route_input(struct sk_buff *);
static void dn_run_flush(unsigned long dummy);

static struct dn_rt_hash_bucket *dn_rt_hash_table;
128
static unsigned int dn_rt_hash_mask;
L
Linus Torvalds 已提交
129 130

static struct timer_list dn_route_timer;
131
static DEFINE_TIMER(dn_rt_flush_timer, dn_run_flush, 0, 0);
L
Linus Torvalds 已提交
132 133 134 135
int decnet_dst_gc_interval = 2;

static struct dst_ops dn_dst_ops = {
	.family =		PF_DECnet,
136
	.protocol =		cpu_to_be16(ETH_P_DNA_RT),
L
Linus Torvalds 已提交
137 138 139
	.gc_thresh =		128,
	.gc =			dn_dst_gc,
	.check =		dn_dst_check,
140
	.default_advmss =	dn_dst_default_advmss,
141
	.mtu =			dn_dst_mtu,
142 143
	.cow_metrics =		dst_cow_metrics_generic,
	.destroy =		dn_dst_destroy,
144
	.ifdown =		dn_dst_ifdown,
L
Linus Torvalds 已提交
145 146 147
	.negative_advice =	dn_dst_negative_advice,
	.link_failure =		dn_dst_link_failure,
	.update_pmtu =		dn_dst_update_pmtu,
148
	.neigh_lookup =		dn_dst_neigh_lookup,
L
Linus Torvalds 已提交
149 150
};

151 152
static void dn_dst_destroy(struct dst_entry *dst)
{
153 154 155 156
	struct dn_route *rt = (struct dn_route *) dst;

	if (rt->n)
		neigh_release(rt->n);
157 158 159
	dst_destroy_metrics_generic(dst);
}

160 161 162 163 164 165 166 167 168 169 170 171 172 173
static void dn_dst_ifdown(struct dst_entry *dst, struct net_device *dev, int how)
{
	if (how) {
		struct dn_route *rt = (struct dn_route *) dst;
		struct neighbour *n = rt->n;

		if (n && n->dev == dev) {
			n->dev = dev_net(dev)->loopback_dev;
			dev_hold(n->dev);
			dev_put(dev);
		}
	}
}

174
static __inline__ unsigned int dn_hash(__le16 src, __le16 dst)
L
Linus Torvalds 已提交
175
{
176
	__u16 tmp = (__u16 __force)(src ^ dst);
L
Linus Torvalds 已提交
177 178 179
	tmp ^= (tmp >> 3);
	tmp ^= (tmp >> 5);
	tmp ^= (tmp >> 10);
180
	return dn_rt_hash_mask & (unsigned int)tmp;
L
Linus Torvalds 已提交
181 182 183 184
}

static inline void dnrt_free(struct dn_route *rt)
{
185
	call_rcu_bh(&rt->dst.rcu_head, dst_rcu_free);
L
Linus Torvalds 已提交
186 187 188 189
}

static inline void dnrt_drop(struct dn_route *rt)
{
190 191
	dst_release(&rt->dst);
	call_rcu_bh(&rt->dst.rcu_head, dst_rcu_free);
L
Linus Torvalds 已提交
192 193 194 195 196
}

static void dn_dst_check_expire(unsigned long dummy)
{
	int i;
197 198
	struct dn_route *rt;
	struct dn_route __rcu **rtp;
L
Linus Torvalds 已提交
199 200 201
	unsigned long now = jiffies;
	unsigned long expire = 120 * HZ;

202
	for (i = 0; i <= dn_rt_hash_mask; i++) {
L
Linus Torvalds 已提交
203 204 205
		rtp = &dn_rt_hash_table[i].chain;

		spin_lock(&dn_rt_hash_table[i].lock);
206 207
		while ((rt = rcu_dereference_protected(*rtp,
						lockdep_is_held(&dn_rt_hash_table[i].lock))) != NULL) {
208 209 210
			if (atomic_read(&rt->dst.__refcnt) ||
					(now - rt->dst.lastuse) < expire) {
				rtp = &rt->dst.dn_next;
L
Linus Torvalds 已提交
211 212
				continue;
			}
213 214
			*rtp = rt->dst.dn_next;
			rt->dst.dn_next = NULL;
L
Linus Torvalds 已提交
215 216 217 218 219 220 221 222 223 224 225
			dnrt_free(rt);
		}
		spin_unlock(&dn_rt_hash_table[i].lock);

		if ((jiffies - now) > 0)
			break;
	}

	mod_timer(&dn_route_timer, now + decnet_dst_gc_interval * HZ);
}

226
static int dn_dst_gc(struct dst_ops *ops)
L
Linus Torvalds 已提交
227
{
228 229
	struct dn_route *rt;
	struct dn_route __rcu **rtp;
L
Linus Torvalds 已提交
230 231 232 233
	int i;
	unsigned long now = jiffies;
	unsigned long expire = 10 * HZ;

234
	for (i = 0; i <= dn_rt_hash_mask; i++) {
L
Linus Torvalds 已提交
235 236 237 238

		spin_lock_bh(&dn_rt_hash_table[i].lock);
		rtp = &dn_rt_hash_table[i].chain;

239 240
		while ((rt = rcu_dereference_protected(*rtp,
						lockdep_is_held(&dn_rt_hash_table[i].lock))) != NULL) {
241 242 243
			if (atomic_read(&rt->dst.__refcnt) ||
					(now - rt->dst.lastuse) < expire) {
				rtp = &rt->dst.dn_next;
L
Linus Torvalds 已提交
244 245
				continue;
			}
246 247
			*rtp = rt->dst.dn_next;
			rt->dst.dn_next = NULL;
L
Linus Torvalds 已提交
248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268
			dnrt_drop(rt);
			break;
		}
		spin_unlock_bh(&dn_rt_hash_table[i].lock);
	}

	return 0;
}

/*
 * The decnet standards don't impose a particular minimum mtu, what they
 * do insist on is that the routing layer accepts a datagram of at least
 * 230 bytes long. Here we have to subtract the routing header length from
 * 230 to get the minimum acceptable mtu. If there is no neighbour, then we
 * assume the worst and use a long header size.
 *
 * We update both the mtu and the advertised mss (i.e. the segment size we
 * advertise to the other end).
 */
static void dn_dst_update_pmtu(struct dst_entry *dst, u32 mtu)
{
269 270
	struct dn_route *rt = (struct dn_route *) dst;
	struct neighbour *n = rt->n;
L
Linus Torvalds 已提交
271
	u32 min_mtu = 230;
272 273 274
	struct dn_dev *dn;

	dn = n ? rcu_dereference_raw(n->dev->dn_ptr) : NULL;
L
Linus Torvalds 已提交
275 276 277 278 279 280

	if (dn && dn->use_long == 0)
		min_mtu -= 6;
	else
		min_mtu -= 21;

281
	if (dst_metric(dst, RTAX_MTU) > mtu && mtu >= min_mtu) {
L
Linus Torvalds 已提交
282
		if (!(dst_metric_locked(dst, RTAX_MTU))) {
283
			dst_metric_set(dst, RTAX_MTU, mtu);
L
Linus Torvalds 已提交
284 285 286 287
			dst_set_expires(dst, dn_rt_mtu_expires);
		}
		if (!(dst_metric_locked(dst, RTAX_ADVMSS))) {
			u32 mss = mtu - DN_MAX_NSP_DATA_HEADER;
288 289
			u32 existing_mss = dst_metric_raw(dst, RTAX_ADVMSS);
			if (!existing_mss || existing_mss > mss)
290
				dst_metric_set(dst, RTAX_ADVMSS, mss);
L
Linus Torvalds 已提交
291 292 293 294
		}
	}
}

295
/*
L
Linus Torvalds 已提交
296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312
 * When a route has been marked obsolete. (e.g. routing cache flush)
 */
static struct dst_entry *dn_dst_check(struct dst_entry *dst, __u32 cookie)
{
	return NULL;
}

static struct dst_entry *dn_dst_negative_advice(struct dst_entry *dst)
{
	dst_release(dst);
	return NULL;
}

static void dn_dst_link_failure(struct sk_buff *skb)
{
}

313
static inline int compare_keys(struct flowidn *fl1, struct flowidn *fl2)
L
Linus Torvalds 已提交
314
{
315 316 317 318 319 320
	return ((fl1->daddr ^ fl2->daddr) |
		(fl1->saddr ^ fl2->saddr) |
		(fl1->flowidn_mark ^ fl2->flowidn_mark) |
		(fl1->flowidn_scope ^ fl2->flowidn_scope) |
		(fl1->flowidn_oif ^ fl2->flowidn_oif) |
		(fl1->flowidn_iif ^ fl2->flowidn_iif)) == 0;
L
Linus Torvalds 已提交
321 322
}

323
static int dn_insert_route(struct dn_route *rt, unsigned int hash, struct dn_route **rp)
L
Linus Torvalds 已提交
324
{
325 326
	struct dn_route *rth;
	struct dn_route __rcu **rthp;
L
Linus Torvalds 已提交
327 328 329 330 331
	unsigned long now = jiffies;

	rthp = &dn_rt_hash_table[hash].chain;

	spin_lock_bh(&dn_rt_hash_table[hash].lock);
332 333
	while ((rth = rcu_dereference_protected(*rthp,
						lockdep_is_held(&dn_rt_hash_table[hash].lock))) != NULL) {
334
		if (compare_keys(&rth->fld, &rt->fld)) {
L
Linus Torvalds 已提交
335
			/* Put it first */
336 337
			*rthp = rth->dst.dn_next;
			rcu_assign_pointer(rth->dst.dn_next,
L
Linus Torvalds 已提交
338 339 340
					   dn_rt_hash_table[hash].chain);
			rcu_assign_pointer(dn_rt_hash_table[hash].chain, rth);

341
			dst_use(&rth->dst, now);
L
Linus Torvalds 已提交
342 343 344 345 346 347
			spin_unlock_bh(&dn_rt_hash_table[hash].lock);

			dnrt_drop(rt);
			*rp = rth;
			return 0;
		}
348
		rthp = &rth->dst.dn_next;
L
Linus Torvalds 已提交
349 350
	}

351
	rcu_assign_pointer(rt->dst.dn_next, dn_rt_hash_table[hash].chain);
L
Linus Torvalds 已提交
352
	rcu_assign_pointer(dn_rt_hash_table[hash].chain, rt);
353

354
	dst_use(&rt->dst, now);
L
Linus Torvalds 已提交
355 356 357 358 359
	spin_unlock_bh(&dn_rt_hash_table[hash].lock);
	*rp = rt;
	return 0;
}

R
Roel Kluin 已提交
360
static void dn_run_flush(unsigned long dummy)
L
Linus Torvalds 已提交
361 362 363 364
{
	int i;
	struct dn_route *rt, *next;

365
	for (i = 0; i < dn_rt_hash_mask; i++) {
L
Linus Torvalds 已提交
366 367
		spin_lock_bh(&dn_rt_hash_table[i].lock);

368
		if ((rt = xchg((struct dn_route **)&dn_rt_hash_table[i].chain, NULL)) == NULL)
L
Linus Torvalds 已提交
369 370
			goto nothing_to_declare;

371 372 373
		for(; rt; rt = next) {
			next = rcu_dereference_raw(rt->dst.dn_next);
			RCU_INIT_POINTER(rt->dst.dn_next, NULL);
L
Linus Torvalds 已提交
374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426
			dst_free((struct dst_entry *)rt);
		}

nothing_to_declare:
		spin_unlock_bh(&dn_rt_hash_table[i].lock);
	}
}

static DEFINE_SPINLOCK(dn_rt_flush_lock);

void dn_rt_cache_flush(int delay)
{
	unsigned long now = jiffies;
	int user_mode = !in_interrupt();

	if (delay < 0)
		delay = dn_rt_min_delay;

	spin_lock_bh(&dn_rt_flush_lock);

	if (del_timer(&dn_rt_flush_timer) && delay > 0 && dn_rt_deadline) {
		long tmo = (long)(dn_rt_deadline - now);

		if (user_mode && tmo < dn_rt_max_delay - dn_rt_min_delay)
			tmo = 0;

		if (delay > tmo)
			delay = tmo;
	}

	if (delay <= 0) {
		spin_unlock_bh(&dn_rt_flush_lock);
		dn_run_flush(0);
		return;
	}

	if (dn_rt_deadline == 0)
		dn_rt_deadline = now + dn_rt_max_delay;

	dn_rt_flush_timer.expires = now + delay;
	add_timer(&dn_rt_flush_timer);
	spin_unlock_bh(&dn_rt_flush_lock);
}

/**
 * dn_return_short - Return a short packet to its sender
 * @skb: The packet to return
 *
 */
static int dn_return_short(struct sk_buff *skb)
{
	struct dn_skb_cb *cb;
	unsigned char *ptr;
427 428
	__le16 *src;
	__le16 *dst;
L
Linus Torvalds 已提交
429 430

	/* Add back headers */
431
	skb_push(skb, skb->data - skb_network_header(skb));
L
Linus Torvalds 已提交
432 433 434 435 436 437 438 439 440

	if ((skb = skb_unshare(skb, GFP_ATOMIC)) == NULL)
		return NET_RX_DROP;

	cb = DN_SKB_CB(skb);
	/* Skip packet length and point to flags */
	ptr = skb->data + 2;
	*ptr++ = (cb->rt_flags & ~DN_RT_F_RQR) | DN_RT_F_RTS;

441
	dst = (__le16 *)ptr;
L
Linus Torvalds 已提交
442
	ptr += 2;
443
	src = (__le16 *)ptr;
L
Linus Torvalds 已提交
444 445 446
	ptr += 2;
	*ptr = 0; /* Zero hop count */

447
	swap(*src, *dst);
L
Linus Torvalds 已提交
448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466

	skb->pkt_type = PACKET_OUTGOING;
	dn_rt_finish_output(skb, NULL, NULL);
	return NET_RX_SUCCESS;
}

/**
 * dn_return_long - Return a long packet to its sender
 * @skb: The long format packet to return
 *
 */
static int dn_return_long(struct sk_buff *skb)
{
	struct dn_skb_cb *cb;
	unsigned char *ptr;
	unsigned char *src_addr, *dst_addr;
	unsigned char tmp[ETH_ALEN];

	/* Add back all headers */
467
	skb_push(skb, skb->data - skb_network_header(skb));
L
Linus Torvalds 已提交
468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507

	if ((skb = skb_unshare(skb, GFP_ATOMIC)) == NULL)
		return NET_RX_DROP;

	cb = DN_SKB_CB(skb);
	/* Ignore packet length and point to flags */
	ptr = skb->data + 2;

	/* Skip padding */
	if (*ptr & DN_RT_F_PF) {
		char padlen = (*ptr & ~DN_RT_F_PF);
		ptr += padlen;
	}

	*ptr++ = (cb->rt_flags & ~DN_RT_F_RQR) | DN_RT_F_RTS;
	ptr += 2;
	dst_addr = ptr;
	ptr += 8;
	src_addr = ptr;
	ptr += 6;
	*ptr = 0; /* Zero hop count */

	/* Swap source and destination */
	memcpy(tmp, src_addr, ETH_ALEN);
	memcpy(src_addr, dst_addr, ETH_ALEN);
	memcpy(dst_addr, tmp, ETH_ALEN);

	skb->pkt_type = PACKET_OUTGOING;
	dn_rt_finish_output(skb, dst_addr, src_addr);
	return NET_RX_SUCCESS;
}

/**
 * dn_route_rx_packet - Try and find a route for an incoming packet
 * @skb: The packet to find a route for
 *
 * Returns: result of input function if route is found, error code otherwise
 */
static int dn_route_rx_packet(struct sk_buff *skb)
{
508
	struct dn_skb_cb *cb;
L
Linus Torvalds 已提交
509 510 511 512 513
	int err;

	if ((err = dn_route_input(skb)) == 0)
		return dst_input(skb);

514
	cb = DN_SKB_CB(skb);
L
Linus Torvalds 已提交
515 516
	if (decnet_debug_level & 4) {
		char *devname = skb->dev ? skb->dev->name : "???";
517

L
Linus Torvalds 已提交
518 519
		printk(KERN_DEBUG
			"DECnet: dn_route_rx_packet: rt_flags=0x%02x dev=%s len=%d src=0x%04hx dst=0x%04hx err=%d type=%d\n",
520
			(int)cb->rt_flags, devname, skb->len,
521
			le16_to_cpu(cb->src), le16_to_cpu(cb->dst),
L
Linus Torvalds 已提交
522 523 524 525
			err, skb->pkt_type);
	}

	if ((skb->pkt_type == PACKET_HOST) && (cb->rt_flags & DN_RT_F_RQR)) {
J
Joe Perches 已提交
526 527 528 529 530
		switch (cb->rt_flags & DN_RT_PKT_MSK) {
		case DN_RT_PKT_SHORT:
			return dn_return_short(skb);
		case DN_RT_PKT_LONG:
			return dn_return_long(skb);
L
Linus Torvalds 已提交
531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546
		}
	}

	kfree_skb(skb);
	return NET_RX_DROP;
}

static int dn_route_rx_long(struct sk_buff *skb)
{
	struct dn_skb_cb *cb = DN_SKB_CB(skb);
	unsigned char *ptr = skb->data;

	if (!pskb_may_pull(skb, 21)) /* 20 for long header, 1 for shortest nsp */
		goto drop_it;

	skb_pull(skb, 20);
547
	skb_reset_transport_header(skb);
L
Linus Torvalds 已提交
548

549 550
	/* Destination info */
	ptr += 2;
551
	cb->dst = dn_eth2dn(ptr);
552 553 554
	if (memcmp(ptr, dn_hiord_addr, 4) != 0)
		goto drop_it;
	ptr += 6;
L
Linus Torvalds 已提交
555 556


557 558
	/* Source info */
	ptr += 2;
559
	cb->src = dn_eth2dn(ptr);
560 561 562 563 564 565
	if (memcmp(ptr, dn_hiord_addr, 4) != 0)
		goto drop_it;
	ptr += 6;
	/* Other junk */
	ptr++;
	cb->hops = *ptr++; /* Visit Count */
L
Linus Torvalds 已提交
566

567 568
	return NF_HOOK(NFPROTO_DECNET, NF_DN_PRE_ROUTING, skb, skb->dev, NULL,
		       dn_route_rx_packet);
L
Linus Torvalds 已提交
569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585

drop_it:
	kfree_skb(skb);
	return NET_RX_DROP;
}



static int dn_route_rx_short(struct sk_buff *skb)
{
	struct dn_skb_cb *cb = DN_SKB_CB(skb);
	unsigned char *ptr = skb->data;

	if (!pskb_may_pull(skb, 6)) /* 5 for short header + 1 for shortest nsp */
		goto drop_it;

	skb_pull(skb, 5);
586
	skb_reset_transport_header(skb);
L
Linus Torvalds 已提交
587

588
	cb->dst = *(__le16 *)ptr;
589 590 591 592
	ptr += 2;
	cb->src = *(__le16 *)ptr;
	ptr += 2;
	cb->hops = *ptr & 0x3f;
L
Linus Torvalds 已提交
593

594 595
	return NF_HOOK(NFPROTO_DECNET, NF_DN_PRE_ROUTING, skb, skb->dev, NULL,
		       dn_route_rx_packet);
L
Linus Torvalds 已提交
596 597

drop_it:
598 599
	kfree_skb(skb);
	return NET_RX_DROP;
L
Linus Torvalds 已提交
600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618
}

static int dn_route_discard(struct sk_buff *skb)
{
	/*
	 * I know we drop the packet here, but thats considered success in
	 * this case
	 */
	kfree_skb(skb);
	return NET_RX_SUCCESS;
}

static int dn_route_ptp_hello(struct sk_buff *skb)
{
	dn_dev_hello(skb);
	dn_neigh_pointopoint_hello(skb);
	return NET_RX_SUCCESS;
}

D
David S. Miller 已提交
619
int dn_route_rcv(struct sk_buff *skb, struct net_device *dev, struct packet_type *pt, struct net_device *orig_dev)
L
Linus Torvalds 已提交
620 621 622
{
	struct dn_skb_cb *cb;
	unsigned char flags = 0;
623
	__u16 len = le16_to_cpu(*(__le16 *)skb->data);
624
	struct dn_dev *dn = rcu_dereference(dev->dn_ptr);
L
Linus Torvalds 已提交
625 626
	unsigned char padlen = 0;

627
	if (!net_eq(dev_net(dev), &init_net))
628 629
		goto dump_it;

L
Linus Torvalds 已提交
630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662
	if (dn == NULL)
		goto dump_it;

	if ((skb = skb_share_check(skb, GFP_ATOMIC)) == NULL)
		goto out;

	if (!pskb_may_pull(skb, 3))
		goto dump_it;

	skb_pull(skb, 2);

	if (len > skb->len)
		goto dump_it;

	skb_trim(skb, len);

	flags = *skb->data;

	cb = DN_SKB_CB(skb);
	cb->stamp = jiffies;
	cb->iif = dev->ifindex;

	/*
	 * If we have padding, remove it.
	 */
	if (flags & DN_RT_F_PF) {
		padlen = flags & ~DN_RT_F_PF;
		if (!pskb_may_pull(skb, padlen + 1))
			goto dump_it;
		skb_pull(skb, padlen);
		flags = *skb->data;
	}

663
	skb_reset_network_header(skb);
L
Linus Torvalds 已提交
664 665 666 667 668 669 670 671 672 673

	/*
	 * Weed out future version DECnet
	 */
	if (flags & DN_RT_F_VER)
		goto dump_it;

	cb->rt_flags = flags;

	if (decnet_debug_level & 1)
674
		printk(KERN_DEBUG
L
Linus Torvalds 已提交
675
			"dn_route_rcv: got 0x%02x from %s [%d %d %d]\n",
676
			(int)flags, (dev) ? dev->name : "???", len, skb->len,
L
Linus Torvalds 已提交
677 678
			padlen);

679
	if (flags & DN_RT_PKT_CNTL) {
H
Herbert Xu 已提交
680
		if (unlikely(skb_linearize(skb)))
L
Linus Torvalds 已提交
681 682
			goto dump_it;

J
Joe Perches 已提交
683 684 685 686 687 688 689
		switch (flags & DN_RT_CNTL_MSK) {
		case DN_RT_PKT_INIT:
			dn_dev_init_pkt(skb);
			break;
		case DN_RT_PKT_VERI:
			dn_dev_veri_pkt(skb);
			break;
L
Linus Torvalds 已提交
690 691 692 693 694
		}

		if (dn->parms.state != DN_DEV_S_RU)
			goto dump_it;

J
Joe Perches 已提交
695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714
		switch (flags & DN_RT_CNTL_MSK) {
		case DN_RT_PKT_HELO:
			return NF_HOOK(NFPROTO_DECNET, NF_DN_HELLO,
				       skb, skb->dev, NULL,
				       dn_route_ptp_hello);

		case DN_RT_PKT_L1RT:
		case DN_RT_PKT_L2RT:
			return NF_HOOK(NFPROTO_DECNET, NF_DN_ROUTE,
				       skb, skb->dev, NULL,
				       dn_route_discard);
		case DN_RT_PKT_ERTH:
			return NF_HOOK(NFPROTO_DECNET, NF_DN_HELLO,
				       skb, skb->dev, NULL,
				       dn_neigh_router_hello);

		case DN_RT_PKT_EEDH:
			return NF_HOOK(NFPROTO_DECNET, NF_DN_HELLO,
				       skb, skb->dev, NULL,
				       dn_neigh_endnode_hello);
715 716
		}
	} else {
L
Linus Torvalds 已提交
717 718 719 720 721
		if (dn->parms.state != DN_DEV_S_RU)
			goto dump_it;

		skb_pull(skb, 1); /* Pull flags */

J
Joe Perches 已提交
722 723 724 725 726
		switch (flags & DN_RT_PKT_MSK) {
		case DN_RT_PKT_LONG:
			return dn_route_rx_long(skb);
		case DN_RT_PKT_SHORT:
			return dn_route_rx_short(skb);
L
Linus Torvalds 已提交
727
		}
728
	}
L
Linus Torvalds 已提交
729 730 731 732 733 734 735

dump_it:
	kfree_skb(skb);
out:
	return NET_RX_DROP;
}

736 737 738
static int dn_to_neigh_output(struct sk_buff *skb)
{
	struct dst_entry *dst = skb_dst(skb);
739 740
	struct dn_route *rt = (struct dn_route *) dst;
	struct neighbour *n = rt->n;
741 742 743 744

	return n->output(n, skb);
}

L
Linus Torvalds 已提交
745 746
static int dn_output(struct sk_buff *skb)
{
E
Eric Dumazet 已提交
747
	struct dst_entry *dst = skb_dst(skb);
L
Linus Torvalds 已提交
748 749 750 751 752 753
	struct dn_route *rt = (struct dn_route *)dst;
	struct net_device *dev = dst->dev;
	struct dn_skb_cb *cb = DN_SKB_CB(skb);

	int err = -EINVAL;

754
	if (rt->n == NULL)
L
Linus Torvalds 已提交
755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770
		goto error;

	skb->dev = dev;

	cb->src = rt->rt_saddr;
	cb->dst = rt->rt_daddr;

	/*
	 * Always set the Intra-Ethernet bit on all outgoing packets
	 * originated on this node. Only valid flag from upper layers
	 * is return-to-sender-requested. Set hop count to 0 too.
	 */
	cb->rt_flags &= ~DN_RT_F_RQR;
	cb->rt_flags |= DN_RT_F_IE;
	cb->hops = 0;

771
	return NF_HOOK(NFPROTO_DECNET, NF_DN_LOCAL_OUT, skb, NULL, dev,
772
		       dn_to_neigh_output);
L
Linus Torvalds 已提交
773 774

error:
775
	net_dbg_ratelimited("dn_output: This should not happen\n");
L
Linus Torvalds 已提交
776 777 778 779 780 781 782 783 784

	kfree_skb(skb);

	return err;
}

static int dn_forward(struct sk_buff *skb)
{
	struct dn_skb_cb *cb = DN_SKB_CB(skb);
E
Eric Dumazet 已提交
785
	struct dst_entry *dst = skb_dst(skb);
786
	struct dn_dev *dn_db = rcu_dereference(dst->dev->dn_ptr);
L
Linus Torvalds 已提交
787 788 789 790 791 792 793 794 795 796
	struct dn_route *rt;
	int header_len;
#ifdef CONFIG_NETFILTER
	struct net_device *dev = skb->dev;
#endif

	if (skb->pkt_type != PACKET_HOST)
		goto drop;

	/* Ensure that we have enough space for headers */
E
Eric Dumazet 已提交
797
	rt = (struct dn_route *)skb_dst(skb);
L
Linus Torvalds 已提交
798
	header_len = dn_db->use_long ? 21 : 6;
799
	if (skb_cow(skb, LL_RESERVED_SPACE(rt->dst.dev)+header_len))
L
Linus Torvalds 已提交
800 801 802 803 804 805 806 807
		goto drop;

	/*
	 * Hop count exceeded.
	 */
	if (++cb->hops > 30)
		goto drop;

808
	skb->dev = rt->dst.dev;
L
Linus Torvalds 已提交
809 810 811 812 813 814 815 816 817 818

	/*
	 * If packet goes out same interface it came in on, then set
	 * the Intra-Ethernet bit. This has no effect for short
	 * packets, so we don't need to test for them here.
	 */
	cb->rt_flags &= ~DN_RT_F_IE;
	if (rt->rt_flags & RTCF_DOREDIRECT)
		cb->rt_flags |= DN_RT_F_IE;

819
	return NF_HOOK(NFPROTO_DECNET, NF_DN_FORWARD, skb, dev, skb->dev,
820
		       dn_to_neigh_output);
L
Linus Torvalds 已提交
821 822 823 824 825 826 827 828 829 830 831 832

drop:
	kfree_skb(skb);
	return NET_RX_DROP;
}

/*
 * Used to catch bugs. This should never normally get
 * called.
 */
static int dn_rt_bug(struct sk_buff *skb)
{
833
	struct dn_skb_cb *cb = DN_SKB_CB(skb);
L
Linus Torvalds 已提交
834

835 836
	net_dbg_ratelimited("dn_rt_bug: skb from:%04x to:%04x\n",
			    le16_to_cpu(cb->src), le16_to_cpu(cb->dst));
L
Linus Torvalds 已提交
837 838 839

	kfree_skb(skb);

840
	return NET_RX_DROP;
L
Linus Torvalds 已提交
841 842
}

843 844 845 846 847
static unsigned int dn_dst_default_advmss(const struct dst_entry *dst)
{
	return dn_mss_from_pmtu(dst->dev, dst_mtu(dst));
}

848
static unsigned int dn_dst_mtu(const struct dst_entry *dst)
849
{
850 851 852
	unsigned int mtu = dst_metric_raw(dst, RTAX_MTU);

	return mtu ? : dst->dev->mtu;
853 854
}

855 856 857
static struct neighbour *dn_dst_neigh_lookup(const struct dst_entry *dst,
					     struct sk_buff *skb,
					     const void *daddr)
858 859 860 861
{
	return __neigh_lookup_errno(&dn_neigh_table, daddr, dst->dev);
}

L
Linus Torvalds 已提交
862 863 864
static int dn_rt_set_next_hop(struct dn_route *rt, struct dn_fib_res *res)
{
	struct dn_fib_info *fi = res->fi;
865
	struct net_device *dev = rt->dst.dev;
866
	unsigned int mss_metric;
L
Linus Torvalds 已提交
867 868 869 870 871 872
	struct neighbour *n;

	if (fi) {
		if (DN_FIB_RES_GW(*res) &&
		    DN_FIB_RES_NH(*res).nh_scope == RT_SCOPE_LINK)
			rt->rt_gateway = DN_FIB_RES_GW(*res);
873
		dst_init_metrics(&rt->dst, fi->fib_metrics, true);
L
Linus Torvalds 已提交
874 875 876
	}
	rt->rt_type = res->type;

877
	if (dev != NULL && rt->n == NULL) {
L
Linus Torvalds 已提交
878 879 880
		n = __neigh_lookup_errno(&dn_neigh_table, &rt->rt_gateway, dev);
		if (IS_ERR(n))
			return PTR_ERR(n);
881
		rt->n = n;
L
Linus Torvalds 已提交
882 883
	}

884
	if (dst_metric(&rt->dst, RTAX_MTU) > rt->dst.dev->mtu)
885
		dst_metric_set(&rt->dst, RTAX_MTU, rt->dst.dev->mtu);
886 887
	mss_metric = dst_metric_raw(&rt->dst, RTAX_ADVMSS);
	if (mss_metric) {
888
		unsigned int mss = dn_mss_from_pmtu(dev, dst_mtu(&rt->dst));
889
		if (mss_metric > mss)
890 891
			dst_metric_set(&rt->dst, RTAX_ADVMSS, mss);
	}
L
Linus Torvalds 已提交
892 893 894
	return 0;
}

895
static inline int dn_match_addr(__le16 addr1, __le16 addr2)
L
Linus Torvalds 已提交
896
{
897
	__u16 tmp = le16_to_cpu(addr1) ^ le16_to_cpu(addr2);
L
Linus Torvalds 已提交
898 899 900 901 902 903 904 905
	int match = 16;
	while(tmp) {
		tmp >>= 1;
		match--;
	}
	return match;
}

906
static __le16 dnet_select_source(const struct net_device *dev, __le16 daddr, int scope)
L
Linus Torvalds 已提交
907
{
908
	__le16 saddr = 0;
909
	struct dn_dev *dn_db;
L
Linus Torvalds 已提交
910 911 912 913
	struct dn_ifaddr *ifa;
	int best_match = 0;
	int ret;

914 915 916 917 918
	rcu_read_lock();
	dn_db = rcu_dereference(dev->dn_ptr);
	for (ifa = rcu_dereference(dn_db->ifa_list);
	     ifa != NULL;
	     ifa = rcu_dereference(ifa->ifa_next)) {
L
Linus Torvalds 已提交
919 920 921 922 923 924 925 926 927 928 929 930
		if (ifa->ifa_scope > scope)
			continue;
		if (!daddr) {
			saddr = ifa->ifa_local;
			break;
		}
		ret = dn_match_addr(daddr, ifa->ifa_local);
		if (ret > best_match)
			saddr = ifa->ifa_local;
		if (best_match == 0)
			saddr = ifa->ifa_local;
	}
931
	rcu_read_unlock();
L
Linus Torvalds 已提交
932 933 934 935

	return saddr;
}

936
static inline __le16 __dn_fib_res_prefsrc(struct dn_fib_res *res)
L
Linus Torvalds 已提交
937 938 939 940
{
	return dnet_select_source(DN_FIB_RES_DEV(*res), DN_FIB_RES_GW(*res), res->scope);
}

941
static inline __le16 dn_fib_rules_map_destination(__le16 daddr, struct dn_fib_res *res)
L
Linus Torvalds 已提交
942
{
943
	__le16 mask = dnet_make_mask(res->prefixlen);
L
Linus Torvalds 已提交
944 945 946
	return (daddr&~mask)|res->fi->fib_nh->nh_gw;
}

947
static int dn_route_output_slow(struct dst_entry **pprt, const struct flowidn *oldflp, int try_hard)
L
Linus Torvalds 已提交
948
{
949 950 951 952 953 954 955
	struct flowidn fld = {
		.daddr = oldflp->daddr,
		.saddr = oldflp->saddr,
		.flowidn_scope = RT_SCOPE_UNIVERSE,
		.flowidn_mark = oldflp->flowidn_mark,
		.flowidn_iif = init_net.loopback_dev->ifindex,
		.flowidn_oif = oldflp->flowidn_oif,
956
	};
L
Linus Torvalds 已提交
957
	struct dn_route *rt = NULL;
958
	struct net_device *dev_out = NULL, *dev;
L
Linus Torvalds 已提交
959
	struct neighbour *neigh = NULL;
960 961
	unsigned int hash;
	unsigned int flags = 0;
L
Linus Torvalds 已提交
962 963 964
	struct dn_fib_res res = { .fi = NULL, .type = RTN_UNICAST };
	int err;
	int free_res = 0;
965
	__le16 gateway = 0;
L
Linus Torvalds 已提交
966 967 968 969

	if (decnet_debug_level & 16)
		printk(KERN_DEBUG
		       "dn_route_output_slow: dst=%04x src=%04x mark=%d"
970 971 972 973
		       " iif=%d oif=%d\n", le16_to_cpu(oldflp->daddr),
		       le16_to_cpu(oldflp->saddr),
		       oldflp->flowidn_mark, init_net.loopback_dev->ifindex,
		       oldflp->flowidn_oif);
L
Linus Torvalds 已提交
974 975

	/* If we have an output interface, verify its a DECnet device */
976 977
	if (oldflp->flowidn_oif) {
		dev_out = dev_get_by_index(&init_net, oldflp->flowidn_oif);
L
Linus Torvalds 已提交
978 979 980 981 982 983 984 985 986 987
		err = -ENODEV;
		if (dev_out && dev_out->dn_ptr == NULL) {
			dev_put(dev_out);
			dev_out = NULL;
		}
		if (dev_out == NULL)
			goto out;
	}

	/* If we have a source address, verify that its a local address */
988
	if (oldflp->saddr) {
L
Linus Torvalds 已提交
989 990 991
		err = -EADDRNOTAVAIL;

		if (dev_out) {
992
			if (dn_dev_islocal(dev_out, oldflp->saddr))
L
Linus Torvalds 已提交
993 994 995 996
				goto source_ok;
			dev_put(dev_out);
			goto out;
		}
997 998
		rcu_read_lock();
		for_each_netdev_rcu(&init_net, dev) {
999
			if (!dev->dn_ptr)
L
Linus Torvalds 已提交
1000
				continue;
1001
			if (!dn_dev_islocal(dev, oldflp->saddr))
1002
				continue;
1003
			if ((dev->flags & IFF_LOOPBACK) &&
1004 1005
			    oldflp->daddr &&
			    !dn_dev_islocal(dev, oldflp->daddr))
1006
				continue;
1007 1008

			dev_out = dev;
1009
			break;
L
Linus Torvalds 已提交
1010
		}
1011
		rcu_read_unlock();
L
Linus Torvalds 已提交
1012 1013 1014 1015 1016 1017 1018 1019
		if (dev_out == NULL)
			goto out;
		dev_hold(dev_out);
source_ok:
		;
	}

	/* No destination? Assume its local */
1020 1021
	if (!fld.daddr) {
		fld.daddr = fld.saddr;
L
Linus Torvalds 已提交
1022 1023 1024 1025

		err = -EADDRNOTAVAIL;
		if (dev_out)
			dev_put(dev_out);
1026
		dev_out = init_net.loopback_dev;
L
Linus Torvalds 已提交
1027
		dev_hold(dev_out);
1028 1029 1030
		if (!fld.daddr) {
			fld.daddr =
			fld.saddr = dnet_select_source(dev_out, 0,
L
Linus Torvalds 已提交
1031
						       RT_SCOPE_HOST);
1032
			if (!fld.daddr)
L
Linus Torvalds 已提交
1033 1034
				goto out;
		}
1035
		fld.flowidn_oif = init_net.loopback_dev->ifindex;
L
Linus Torvalds 已提交
1036 1037 1038 1039 1040 1041 1042
		res.type = RTN_LOCAL;
		goto make_route;
	}

	if (decnet_debug_level & 16)
		printk(KERN_DEBUG
		       "dn_route_output_slow: initial checks complete."
1043
		       " dst=%o4x src=%04x oif=%d try_hard=%d\n",
1044 1045
		       le16_to_cpu(fld.daddr), le16_to_cpu(fld.saddr),
		       fld.flowidn_oif, try_hard);
L
Linus Torvalds 已提交
1046 1047 1048 1049 1050 1051 1052

	/*
	 * N.B. If the kernel is compiled without router support then
	 * dn_fib_lookup() will evaluate to non-zero so this if () block
	 * will always be executed.
	 */
	err = -ESRCH;
1053
	if (try_hard || (err = dn_fib_lookup(&fld, &res)) != 0) {
L
Linus Torvalds 已提交
1054 1055 1056 1057
		struct dn_dev *dn_db;
		if (err != -ESRCH)
			goto out;
		/*
1058
		 * Here the fallback is basically the standard algorithm for
L
Linus Torvalds 已提交
1059 1060 1061 1062 1063
		 * routing in endnodes which is described in the DECnet routing
		 * docs
		 *
		 * If we are not trying hard, look in neighbour cache.
		 * The result is tested to ensure that if a specific output
1064
		 * device/source address was requested, then we honour that
L
Linus Torvalds 已提交
1065 1066 1067
		 * here
		 */
		if (!try_hard) {
1068
			neigh = neigh_lookup_nodev(&dn_neigh_table, &init_net, &fld.daddr);
L
Linus Torvalds 已提交
1069
			if (neigh) {
1070 1071 1072
				if ((oldflp->flowidn_oif &&
				    (neigh->dev->ifindex != oldflp->flowidn_oif)) ||
				    (oldflp->saddr &&
L
Linus Torvalds 已提交
1073
				    (!dn_dev_islocal(neigh->dev,
1074
						     oldflp->saddr)))) {
L
Linus Torvalds 已提交
1075 1076 1077 1078 1079
					neigh_release(neigh);
					neigh = NULL;
				} else {
					if (dev_out)
						dev_put(dev_out);
1080
					if (dn_dev_islocal(neigh->dev, fld.daddr)) {
1081
						dev_out = init_net.loopback_dev;
L
Linus Torvalds 已提交
1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097
						res.type = RTN_LOCAL;
					} else {
						dev_out = neigh->dev;
					}
					dev_hold(dev_out);
					goto select_source;
				}
			}
		}

		/* Not there? Perhaps its a local address */
		if (dev_out == NULL)
			dev_out = dn_dev_get_default();
		err = -ENODEV;
		if (dev_out == NULL)
			goto out;
1098
		dn_db = rcu_dereference_raw(dev_out->dn_ptr);
L
Linus Torvalds 已提交
1099
		/* Possible improvement - check all devices for local addr */
1100
		if (dn_dev_islocal(dev_out, fld.daddr)) {
L
Linus Torvalds 已提交
1101
			dev_put(dev_out);
1102
			dev_out = init_net.loopback_dev;
L
Linus Torvalds 已提交
1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115
			dev_hold(dev_out);
			res.type = RTN_LOCAL;
			goto select_source;
		}
		/* Not local either.... try sending it to the default router */
		neigh = neigh_clone(dn_db->router);
		BUG_ON(neigh && neigh->dev != dev_out);

		/* Ok then, we assume its directly connected and move on */
select_source:
		if (neigh)
			gateway = ((struct dn_neigh *)neigh)->addr;
		if (gateway == 0)
1116 1117 1118 1119 1120 1121 1122
			gateway = fld.daddr;
		if (fld.saddr == 0) {
			fld.saddr = dnet_select_source(dev_out, gateway,
						       res.type == RTN_LOCAL ?
						       RT_SCOPE_HOST :
						       RT_SCOPE_LINK);
			if (fld.saddr == 0 && res.type != RTN_LOCAL)
L
Linus Torvalds 已提交
1123 1124
				goto e_addr;
		}
1125
		fld.flowidn_oif = dev_out->ifindex;
L
Linus Torvalds 已提交
1126 1127 1128 1129 1130 1131 1132 1133
		goto make_route;
	}
	free_res = 1;

	if (res.type == RTN_NAT)
		goto e_inval;

	if (res.type == RTN_LOCAL) {
1134 1135
		if (!fld.saddr)
			fld.saddr = fld.daddr;
L
Linus Torvalds 已提交
1136 1137
		if (dev_out)
			dev_put(dev_out);
1138
		dev_out = init_net.loopback_dev;
L
Linus Torvalds 已提交
1139
		dev_hold(dev_out);
1140
		fld.flowidn_oif = dev_out->ifindex;
L
Linus Torvalds 已提交
1141 1142 1143 1144 1145 1146
		if (res.fi)
			dn_fib_info_put(res.fi);
		res.fi = NULL;
		goto make_route;
	}

1147 1148
	if (res.fi->fib_nhs > 1 && fld.flowidn_oif == 0)
		dn_fib_select_multipath(&fld, &res);
L
Linus Torvalds 已提交
1149

1150
	/*
L
Linus Torvalds 已提交
1151 1152 1153 1154
	 * We could add some logic to deal with default routes here and
	 * get rid of some of the special casing above.
	 */

1155 1156
	if (!fld.saddr)
		fld.saddr = DN_FIB_RES_PREFSRC(res);
1157

L
Linus Torvalds 已提交
1158 1159 1160 1161
	if (dev_out)
		dev_put(dev_out);
	dev_out = DN_FIB_RES_DEV(res);
	dev_hold(dev_out);
1162
	fld.flowidn_oif = dev_out->ifindex;
L
Linus Torvalds 已提交
1163 1164 1165 1166 1167 1168
	gateway = DN_FIB_RES_GW(res);

make_route:
	if (dev_out->flags & IFF_LOOPBACK)
		flags |= RTCF_LOCAL;

1169
	rt = dst_alloc(&dn_dst_ops, dev_out, 1, 0, DST_HOST);
L
Linus Torvalds 已提交
1170 1171 1172
	if (rt == NULL)
		goto e_nobufs;

1173
	memset(&rt->fld, 0, sizeof(rt->fld));
1174 1175 1176 1177 1178
	rt->fld.saddr        = oldflp->saddr;
	rt->fld.daddr        = oldflp->daddr;
	rt->fld.flowidn_oif  = oldflp->flowidn_oif;
	rt->fld.flowidn_iif  = 0;
	rt->fld.flowidn_mark = oldflp->flowidn_mark;
L
Linus Torvalds 已提交
1179

1180 1181 1182 1183
	rt->rt_saddr      = fld.saddr;
	rt->rt_daddr      = fld.daddr;
	rt->rt_gateway    = gateway ? gateway : fld.daddr;
	rt->rt_local_src  = fld.saddr;
L
Linus Torvalds 已提交
1184

1185 1186
	rt->rt_dst_map    = fld.daddr;
	rt->rt_src_map    = fld.saddr;
L
Linus Torvalds 已提交
1187

1188
	rt->n = neigh;
L
Linus Torvalds 已提交
1189 1190
	neigh = NULL;

1191 1192 1193
	rt->dst.lastuse = jiffies;
	rt->dst.output  = dn_output;
	rt->dst.input   = dn_rt_bug;
L
Linus Torvalds 已提交
1194 1195
	rt->rt_flags      = flags;
	if (flags & RTCF_LOCAL)
1196
		rt->dst.input = dn_nsp_rx;
L
Linus Torvalds 已提交
1197 1198 1199 1200 1201

	err = dn_rt_set_next_hop(rt, &res);
	if (err)
		goto e_neighbour;

1202
	hash = dn_hash(rt->fld.saddr, rt->fld.daddr);
L
Linus Torvalds 已提交
1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215
	dn_insert_route(rt, hash, (struct dn_route **)pprt);

done:
	if (neigh)
		neigh_release(neigh);
	if (free_res)
		dn_fib_res_put(&res);
	if (dev_out)
		dev_put(dev_out);
out:
	return err;

e_addr:
1216 1217
	err = -EADDRNOTAVAIL;
	goto done;
L
Linus Torvalds 已提交
1218 1219 1220 1221 1222 1223 1224
e_inval:
	err = -EINVAL;
	goto done;
e_nobufs:
	err = -ENOBUFS;
	goto done;
e_neighbour:
1225
	dst_free(&rt->dst);
L
Linus Torvalds 已提交
1226 1227 1228 1229 1230 1231 1232
	goto e_nobufs;
}


/*
 * N.B. The flags may be moved into the flowi at some future stage.
 */
1233
static int __dn_route_output_key(struct dst_entry **pprt, const struct flowidn *flp, int flags)
L
Linus Torvalds 已提交
1234
{
1235
	unsigned int hash = dn_hash(flp->saddr, flp->daddr);
L
Linus Torvalds 已提交
1236 1237 1238 1239
	struct dn_route *rt = NULL;

	if (!(flags & MSG_TRYHARD)) {
		rcu_read_lock_bh();
1240
		for (rt = rcu_dereference_bh(dn_rt_hash_table[hash].chain); rt;
1241
			rt = rcu_dereference_bh(rt->dst.dn_next)) {
1242 1243 1244
			if ((flp->daddr == rt->fld.daddr) &&
			    (flp->saddr == rt->fld.saddr) &&
			    (flp->flowidn_mark == rt->fld.flowidn_mark) &&
1245
			    dn_is_output_route(rt) &&
1246
			    (rt->fld.flowidn_oif == flp->flowidn_oif)) {
1247
				dst_use(&rt->dst, jiffies);
L
Linus Torvalds 已提交
1248
				rcu_read_unlock_bh();
1249
				*pprt = &rt->dst;
L
Linus Torvalds 已提交
1250 1251 1252 1253 1254 1255 1256 1257 1258
				return 0;
			}
		}
		rcu_read_unlock_bh();
	}

	return dn_route_output_slow(pprt, flp, flags);
}

1259
static int dn_route_output_key(struct dst_entry **pprt, struct flowidn *flp, int flags)
L
Linus Torvalds 已提交
1260 1261 1262 1263
{
	int err;

	err = __dn_route_output_key(pprt, flp, flags);
1264 1265 1266
	if (err == 0 && flp->flowidn_proto) {
		*pprt = xfrm_lookup(&init_net, *pprt,
				    flowidn_to_flowi(flp), NULL, 0);
1267 1268 1269 1270
		if (IS_ERR(*pprt)) {
			err = PTR_ERR(*pprt);
			*pprt = NULL;
		}
L
Linus Torvalds 已提交
1271 1272 1273 1274
	}
	return err;
}

1275
int dn_route_output_sock(struct dst_entry **pprt, struct flowidn *fl, struct sock *sk, int flags)
L
Linus Torvalds 已提交
1276 1277 1278 1279
{
	int err;

	err = __dn_route_output_key(pprt, fl, flags & MSG_TRYHARD);
1280
	if (err == 0 && fl->flowidn_proto) {
1281
		if (!(flags & MSG_DONTWAIT))
1282 1283 1284
			fl->flowidn_flags |= FLOWI_FLAG_CAN_SLEEP;
		*pprt = xfrm_lookup(&init_net, *pprt,
				    flowidn_to_flowi(fl), sk, 0);
1285 1286 1287 1288
		if (IS_ERR(*pprt)) {
			err = PTR_ERR(*pprt);
			*pprt = NULL;
		}
L
Linus Torvalds 已提交
1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300
	}
	return err;
}

static int dn_route_input_slow(struct sk_buff *skb)
{
	struct dn_route *rt = NULL;
	struct dn_skb_cb *cb = DN_SKB_CB(skb);
	struct net_device *in_dev = skb->dev;
	struct net_device *out_dev = NULL;
	struct dn_dev *dn_db;
	struct neighbour *neigh = NULL;
1301
	unsigned int hash;
L
Linus Torvalds 已提交
1302
	int flags = 0;
1303 1304
	__le16 gateway = 0;
	__le16 local_src = 0;
1305 1306 1307 1308 1309 1310
	struct flowidn fld = {
		.daddr = cb->dst,
		.saddr = cb->src,
		.flowidn_scope = RT_SCOPE_UNIVERSE,
		.flowidn_mark = skb->mark,
		.flowidn_iif = skb->dev->ifindex,
1311
	};
L
Linus Torvalds 已提交
1312 1313 1314 1315 1316 1317
	struct dn_fib_res res = { .fi = NULL, .type = RTN_UNREACHABLE };
	int err = -EINVAL;
	int free_res = 0;

	dev_hold(in_dev);

1318
	if ((dn_db = rcu_dereference(in_dev->dn_ptr)) == NULL)
L
Linus Torvalds 已提交
1319 1320 1321
		goto out;

	/* Zero source addresses are not allowed */
1322
	if (fld.saddr == 0)
L
Linus Torvalds 已提交
1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335
		goto out;

	/*
	 * In this case we've just received a packet from a source
	 * outside ourselves pretending to come from us. We don't
	 * allow it any further to prevent routing loops, spoofing and
	 * other nasties. Loopback packets already have the dst attached
	 * so this only affects packets which have originated elsewhere.
	 */
	err  = -ENOTUNIQ;
	if (dn_dev_islocal(in_dev, cb->src))
		goto out;

1336
	err = dn_fib_lookup(&fld, &res);
L
Linus Torvalds 已提交
1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347
	if (err) {
		if (err != -ESRCH)
			goto out;
		/*
		 * Is the destination us ?
		 */
		if (!dn_dev_islocal(in_dev, cb->dst))
			goto e_inval;

		res.type = RTN_LOCAL;
	} else {
1348
		__le16 src_map = fld.saddr;
L
Linus Torvalds 已提交
1349 1350 1351 1352
		free_res = 1;

		out_dev = DN_FIB_RES_DEV(res);
		if (out_dev == NULL) {
1353
			net_crit_ratelimited("Bug in dn_route_input_slow() No output device\n");
L
Linus Torvalds 已提交
1354 1355 1356 1357 1358
			goto e_inval;
		}
		dev_hold(out_dev);

		if (res.r)
1359
			src_map = fld.saddr; /* no NAT support for now */
L
Linus Torvalds 已提交
1360 1361 1362

		gateway = DN_FIB_RES_GW(res);
		if (res.type == RTN_NAT) {
1363
			fld.daddr = dn_fib_rules_map_destination(fld.daddr, &res);
L
Linus Torvalds 已提交
1364 1365
			dn_fib_res_put(&res);
			free_res = 0;
1366
			if (dn_fib_lookup(&fld, &res))
L
Linus Torvalds 已提交
1367 1368 1369 1370 1371
				goto e_inval;
			free_res = 1;
			if (res.type != RTN_UNICAST)
				goto e_inval;
			flags |= RTCF_DNAT;
1372
			gateway = fld.daddr;
L
Linus Torvalds 已提交
1373
		}
1374
		fld.saddr = src_map;
L
Linus Torvalds 已提交
1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387
	}

	switch(res.type) {
	case RTN_UNICAST:
		/*
		 * Forwarding check here, we only check for forwarding
		 * being turned off, if you want to only forward intra
		 * area, its up to you to set the routing tables up
		 * correctly.
		 */
		if (dn_db->parms.forwarding == 0)
			goto e_inval;

1388 1389
		if (res.fi->fib_nhs > 1 && fld.flowidn_oif == 0)
			dn_fib_select_multipath(&fld, &res);
L
Linus Torvalds 已提交
1390

1391
		/*
L
Linus Torvalds 已提交
1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406
		 * Check for out_dev == in_dev. We use the RTCF_DOREDIRECT
		 * flag as a hint to set the intra-ethernet bit when
		 * forwarding. If we've got NAT in operation, we don't do
		 * this optimisation.
		 */
		if (out_dev == in_dev && !(flags & RTCF_NAT))
			flags |= RTCF_DOREDIRECT;

		local_src = DN_FIB_RES_PREFSRC(res);

	case RTN_BLACKHOLE:
	case RTN_UNREACHABLE:
		break;
	case RTN_LOCAL:
		flags |= RTCF_LOCAL;
1407 1408
		fld.saddr = cb->dst;
		fld.daddr = cb->src;
L
Linus Torvalds 已提交
1409 1410 1411 1412 1413 1414

		/* Routing tables gave us a gateway */
		if (gateway)
			goto make_route;

		/* Packet was intra-ethernet, so we know its on-link */
1415
		if (cb->rt_flags & DN_RT_F_IE) {
L
Linus Torvalds 已提交
1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436
			gateway = cb->src;
			flags |= RTCF_DIRECTSRC;
			goto make_route;
		}

		/* Use the default router if there is one */
		neigh = neigh_clone(dn_db->router);
		if (neigh) {
			gateway = ((struct dn_neigh *)neigh)->addr;
			goto make_route;
		}

		/* Close eyes and pray */
		gateway = cb->src;
		flags |= RTCF_DIRECTSRC;
		goto make_route;
	default:
		goto e_inval;
	}

make_route:
1437
	rt = dst_alloc(&dn_dst_ops, out_dev, 0, 0, DST_HOST);
L
Linus Torvalds 已提交
1438 1439 1440
	if (rt == NULL)
		goto e_nobufs;

1441
	memset(&rt->fld, 0, sizeof(rt->fld));
1442 1443 1444
	rt->rt_saddr      = fld.saddr;
	rt->rt_daddr      = fld.daddr;
	rt->rt_gateway    = fld.daddr;
L
Linus Torvalds 已提交
1445 1446 1447 1448
	if (gateway)
		rt->rt_gateway = gateway;
	rt->rt_local_src  = local_src ? local_src : rt->rt_saddr;

1449 1450
	rt->rt_dst_map    = fld.daddr;
	rt->rt_src_map    = fld.saddr;
L
Linus Torvalds 已提交
1451

1452 1453 1454 1455 1456
	rt->fld.saddr        = cb->src;
	rt->fld.daddr        = cb->dst;
	rt->fld.flowidn_oif  = 0;
	rt->fld.flowidn_iif  = in_dev->ifindex;
	rt->fld.flowidn_mark = fld.flowidn_mark;
L
Linus Torvalds 已提交
1457

1458
	rt->n = neigh;
1459 1460
	rt->dst.lastuse = jiffies;
	rt->dst.output = dn_rt_bug;
J
Joe Perches 已提交
1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474
	switch (res.type) {
	case RTN_UNICAST:
		rt->dst.input = dn_forward;
		break;
	case RTN_LOCAL:
		rt->dst.output = dn_output;
		rt->dst.input = dn_nsp_rx;
		rt->dst.dev = in_dev;
		flags |= RTCF_LOCAL;
		break;
	default:
	case RTN_UNREACHABLE:
	case RTN_BLACKHOLE:
		rt->dst.input = dst_discard;
L
Linus Torvalds 已提交
1475 1476 1477 1478 1479 1480 1481
	}
	rt->rt_flags = flags;

	err = dn_rt_set_next_hop(rt, &res);
	if (err)
		goto e_neighbour;

1482
	hash = dn_hash(rt->fld.saddr, rt->fld.daddr);
E
Eric Dumazet 已提交
1483
	dn_insert_route(rt, hash, &rt);
1484
	skb_dst_set(skb, &rt->dst);
L
Linus Torvalds 已提交
1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505

done:
	if (neigh)
		neigh_release(neigh);
	if (free_res)
		dn_fib_res_put(&res);
	dev_put(in_dev);
	if (out_dev)
		dev_put(out_dev);
out:
	return err;

e_inval:
	err = -EINVAL;
	goto done;

e_nobufs:
	err = -ENOBUFS;
	goto done;

e_neighbour:
1506
	dst_free(&rt->dst);
L
Linus Torvalds 已提交
1507 1508 1509
	goto done;
}

R
Roel Kluin 已提交
1510
static int dn_route_input(struct sk_buff *skb)
L
Linus Torvalds 已提交
1511 1512 1513
{
	struct dn_route *rt;
	struct dn_skb_cb *cb = DN_SKB_CB(skb);
1514
	unsigned int hash = dn_hash(cb->src, cb->dst);
L
Linus Torvalds 已提交
1515

E
Eric Dumazet 已提交
1516
	if (skb_dst(skb))
L
Linus Torvalds 已提交
1517 1518 1519 1520
		return 0;

	rcu_read_lock();
	for(rt = rcu_dereference(dn_rt_hash_table[hash].chain); rt != NULL;
1521
	    rt = rcu_dereference(rt->dst.dn_next)) {
1522 1523 1524 1525 1526
		if ((rt->fld.saddr == cb->src) &&
		    (rt->fld.daddr == cb->dst) &&
		    (rt->fld.flowidn_oif == 0) &&
		    (rt->fld.flowidn_mark == skb->mark) &&
		    (rt->fld.flowidn_iif == cb->iif)) {
1527
			dst_use(&rt->dst, jiffies);
L
Linus Torvalds 已提交
1528
			rcu_read_unlock();
E
Eric Dumazet 已提交
1529
			skb_dst_set(skb, (struct dst_entry *)rt);
L
Linus Torvalds 已提交
1530 1531 1532 1533 1534 1535 1536 1537
			return 0;
		}
	}
	rcu_read_unlock();

	return dn_route_input_slow(skb);
}

1538 1539
static int dn_rt_fill_info(struct sk_buff *skb, u32 pid, u32 seq,
			   int event, int nowait, unsigned int flags)
L
Linus Torvalds 已提交
1540
{
E
Eric Dumazet 已提交
1541
	struct dn_route *rt = (struct dn_route *)skb_dst(skb);
L
Linus Torvalds 已提交
1542 1543
	struct rtmsg *r;
	struct nlmsghdr *nlh;
1544
	long expires;
L
Linus Torvalds 已提交
1545

1546 1547
	nlh = nlmsg_put(skb, pid, seq, event, sizeof(*r), flags);
	if (!nlh)
1548 1549
		return -EMSGSIZE;

1550
	r = nlmsg_data(nlh);
L
Linus Torvalds 已提交
1551 1552 1553 1554 1555 1556 1557 1558 1559
	r->rtm_family = AF_DECnet;
	r->rtm_dst_len = 16;
	r->rtm_src_len = 0;
	r->rtm_tos = 0;
	r->rtm_table = RT_TABLE_MAIN;
	r->rtm_type = rt->rt_type;
	r->rtm_flags = (rt->rt_flags & ~0xFFFF) | RTM_F_CLONED;
	r->rtm_scope = RT_SCOPE_UNIVERSE;
	r->rtm_protocol = RTPROT_UNSPEC;
1560

L
Linus Torvalds 已提交
1561 1562
	if (rt->rt_flags & RTCF_NOTIFY)
		r->rtm_flags |= RTM_F_NOTIFY;
1563 1564 1565 1566 1567

	if (nla_put_u32(skb, RTA_TABLE, RT_TABLE_MAIN) < 0 ||
	    nla_put_le16(skb, RTA_DST, rt->rt_daddr) < 0)
		goto errout;

1568
	if (rt->fld.saddr) {
L
Linus Torvalds 已提交
1569
		r->rtm_src_len = 16;
1570 1571
		if (nla_put_le16(skb, RTA_SRC, rt->fld.saddr) < 0)
			goto errout;
L
Linus Torvalds 已提交
1572
	}
1573 1574 1575 1576
	if (rt->dst.dev &&
	    nla_put_u32(skb, RTA_OIF, rt->dst.dev->ifindex) < 0)
		goto errout;

L
Linus Torvalds 已提交
1577 1578 1579 1580 1581
	/*
	 * Note to self - change this if input routes reverse direction when
	 * they deal only with inputs and not with replies like they do
	 * currently.
	 */
1582 1583 1584 1585 1586 1587 1588
	if (nla_put_le16(skb, RTA_PREFSRC, rt->rt_local_src) < 0)
		goto errout;

	if (rt->rt_daddr != rt->rt_gateway &&
	    nla_put_le16(skb, RTA_GATEWAY, rt->rt_gateway) < 0)
		goto errout;

1589
	if (rtnetlink_put_metrics(skb, dst_metrics_ptr(&rt->dst)) < 0)
1590 1591
		goto errout;

1592 1593 1594
	expires = rt->dst.expires ? rt->dst.expires - jiffies : 0;
	if (rtnl_put_cacheinfo(skb, &rt->dst, 0, 0, 0, expires,
			       rt->dst.error) < 0)
1595
		goto errout;
L
Linus Torvalds 已提交
1596

1597 1598 1599
	if (dn_is_input_route(rt) &&
	    nla_put_u32(skb, RTA_IIF, rt->fld.flowidn_iif) < 0)
		goto errout;
L
Linus Torvalds 已提交
1600

1601 1602 1603 1604 1605
	return nlmsg_end(skb, nlh);

errout:
	nlmsg_cancel(skb, nlh);
	return -EMSGSIZE;
L
Linus Torvalds 已提交
1606 1607 1608 1609 1610
}

/*
 * This is called by both endnodes and routers now.
 */
1611
static int dn_cache_getroute(struct sk_buff *in_skb, struct nlmsghdr *nlh, void *arg)
L
Linus Torvalds 已提交
1612
{
1613
	struct net *net = sock_net(in_skb->sk);
L
Linus Torvalds 已提交
1614
	struct rtattr **rta = arg;
1615
	struct rtmsg *rtm = nlmsg_data(nlh);
L
Linus Torvalds 已提交
1616 1617 1618 1619
	struct dn_route *rt = NULL;
	struct dn_skb_cb *cb;
	int err;
	struct sk_buff *skb;
1620
	struct flowidn fld;
L
Linus Torvalds 已提交
1621

O
Octavian Purdila 已提交
1622
	if (!net_eq(net, &init_net))
1623 1624
		return -EINVAL;

1625 1626
	memset(&fld, 0, sizeof(fld));
	fld.flowidn_proto = DNPROTO_NSP;
L
Linus Torvalds 已提交
1627

1628
	skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
L
Linus Torvalds 已提交
1629 1630
	if (skb == NULL)
		return -ENOBUFS;
1631
	skb_reset_mac_header(skb);
L
Linus Torvalds 已提交
1632 1633 1634
	cb = DN_SKB_CB(skb);

	if (rta[RTA_SRC-1])
1635
		memcpy(&fld.saddr, RTA_DATA(rta[RTA_SRC-1]), 2);
L
Linus Torvalds 已提交
1636
	if (rta[RTA_DST-1])
1637
		memcpy(&fld.daddr, RTA_DATA(rta[RTA_DST-1]), 2);
L
Linus Torvalds 已提交
1638
	if (rta[RTA_IIF-1])
1639
		memcpy(&fld.flowidn_iif, RTA_DATA(rta[RTA_IIF-1]), sizeof(int));
L
Linus Torvalds 已提交
1640

1641
	if (fld.flowidn_iif) {
L
Linus Torvalds 已提交
1642
		struct net_device *dev;
1643
		if ((dev = dev_get_by_index(&init_net, fld.flowidn_iif)) == NULL) {
L
Linus Torvalds 已提交
1644 1645 1646 1647 1648 1649 1650 1651
			kfree_skb(skb);
			return -ENODEV;
		}
		if (!dev->dn_ptr) {
			dev_put(dev);
			kfree_skb(skb);
			return -ENODEV;
		}
1652
		skb->protocol = htons(ETH_P_DNA_RT);
L
Linus Torvalds 已提交
1653
		skb->dev = dev;
1654 1655
		cb->src = fld.saddr;
		cb->dst = fld.daddr;
L
Linus Torvalds 已提交
1656 1657 1658 1659
		local_bh_disable();
		err = dn_route_input(skb);
		local_bh_enable();
		memset(cb, 0, sizeof(struct dn_skb_cb));
E
Eric Dumazet 已提交
1660
		rt = (struct dn_route *)skb_dst(skb);
1661 1662
		if (!err && -rt->dst.error)
			err = rt->dst.error;
L
Linus Torvalds 已提交
1663 1664 1665 1666
	} else {
		int oif = 0;
		if (rta[RTA_OIF - 1])
			memcpy(&oif, RTA_DATA(rta[RTA_OIF - 1]), sizeof(int));
1667 1668
		fld.flowidn_oif = oif;
		err = dn_route_output_key((struct dst_entry **)&rt, &fld, 0);
L
Linus Torvalds 已提交
1669 1670 1671 1672 1673 1674 1675
	}

	if (skb->dev)
		dev_put(skb->dev);
	skb->dev = NULL;
	if (err)
		goto out_free;
1676
	skb_dst_set(skb, &rt->dst);
L
Linus Torvalds 已提交
1677 1678 1679
	if (rtm->rtm_flags & RTM_F_NOTIFY)
		rt->rt_flags |= RTCF_NOTIFY;

1680
	err = dn_rt_fill_info(skb, NETLINK_CB(in_skb).pid, nlh->nlmsg_seq, RTM_NEWROUTE, 0, 0);
L
Linus Torvalds 已提交
1681 1682 1683 1684 1685 1686 1687 1688

	if (err == 0)
		goto out_free;
	if (err < 0) {
		err = -EMSGSIZE;
		goto out_free;
	}

1689
	return rtnl_unicast(skb, &init_net, NETLINK_CB(in_skb).pid);
L
Linus Torvalds 已提交
1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701

out_free:
	kfree_skb(skb);
	return err;
}

/*
 * For routers, this is called from dn_fib_dump, but for endnodes its
 * called directly from the rtnetlink dispatch table.
 */
int dn_cache_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
1702
	struct net *net = sock_net(skb->sk);
L
Linus Torvalds 已提交
1703 1704 1705
	struct dn_route *rt;
	int h, s_h;
	int idx, s_idx;
1706
	struct rtmsg *rtm;
L
Linus Torvalds 已提交
1707

O
Octavian Purdila 已提交
1708
	if (!net_eq(net, &init_net))
1709 1710
		return 0;

1711
	if (nlmsg_len(cb->nlh) < sizeof(struct rtmsg))
L
Linus Torvalds 已提交
1712
		return -EINVAL;
1713 1714 1715

	rtm = nlmsg_data(cb->nlh);
	if (!(rtm->rtm_flags & RTM_F_CLONED))
L
Linus Torvalds 已提交
1716 1717 1718 1719 1720 1721 1722 1723 1724 1725
		return 0;

	s_h = cb->args[0];
	s_idx = idx = cb->args[1];
	for(h = 0; h <= dn_rt_hash_mask; h++) {
		if (h < s_h)
			continue;
		if (h > s_h)
			s_idx = 0;
		rcu_read_lock_bh();
1726
		for(rt = rcu_dereference_bh(dn_rt_hash_table[h].chain), idx = 0;
L
Linus Torvalds 已提交
1727
			rt;
1728
			rt = rcu_dereference_bh(rt->dst.dn_next), idx++) {
L
Linus Torvalds 已提交
1729 1730
			if (idx < s_idx)
				continue;
1731
			skb_dst_set(skb, dst_clone(&rt->dst));
L
Linus Torvalds 已提交
1732
			if (dn_rt_fill_info(skb, NETLINK_CB(cb->skb).pid,
1733
					cb->nlh->nlmsg_seq, RTM_NEWROUTE,
1734
					1, NLM_F_MULTI) <= 0) {
E
Eric Dumazet 已提交
1735
				skb_dst_drop(skb);
L
Linus Torvalds 已提交
1736 1737 1738
				rcu_read_unlock_bh();
				goto done;
			}
E
Eric Dumazet 已提交
1739
			skb_dst_drop(skb);
L
Linus Torvalds 已提交
1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761
		}
		rcu_read_unlock_bh();
	}

done:
	cb->args[0] = h;
	cb->args[1] = idx;
	return skb->len;
}

#ifdef CONFIG_PROC_FS
struct dn_rt_cache_iter_state {
	int bucket;
};

static struct dn_route *dn_rt_cache_get_first(struct seq_file *seq)
{
	struct dn_route *rt = NULL;
	struct dn_rt_cache_iter_state *s = seq->private;

	for(s->bucket = dn_rt_hash_mask; s->bucket >= 0; --s->bucket) {
		rcu_read_lock_bh();
1762
		rt = rcu_dereference_bh(dn_rt_hash_table[s->bucket].chain);
L
Linus Torvalds 已提交
1763 1764 1765 1766
		if (rt)
			break;
		rcu_read_unlock_bh();
	}
1767
	return rt;
L
Linus Torvalds 已提交
1768 1769 1770 1771
}

static struct dn_route *dn_rt_cache_get_next(struct seq_file *seq, struct dn_route *rt)
{
1772
	struct dn_rt_cache_iter_state *s = seq->private;
L
Linus Torvalds 已提交
1773

1774 1775
	rt = rcu_dereference_bh(rt->dst.dn_next);
	while (!rt) {
L
Linus Torvalds 已提交
1776 1777 1778 1779
		rcu_read_unlock_bh();
		if (--s->bucket < 0)
			break;
		rcu_read_lock_bh();
1780
		rt = rcu_dereference_bh(dn_rt_hash_table[s->bucket].chain);
L
Linus Torvalds 已提交
1781
	}
1782
	return rt;
L
Linus Torvalds 已提交
1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814
}

static void *dn_rt_cache_seq_start(struct seq_file *seq, loff_t *pos)
{
	struct dn_route *rt = dn_rt_cache_get_first(seq);

	if (rt) {
		while(*pos && (rt = dn_rt_cache_get_next(seq, rt)))
			--*pos;
	}
	return *pos ? NULL : rt;
}

static void *dn_rt_cache_seq_next(struct seq_file *seq, void *v, loff_t *pos)
{
	struct dn_route *rt = dn_rt_cache_get_next(seq, v);
	++*pos;
	return rt;
}

static void dn_rt_cache_seq_stop(struct seq_file *seq, void *v)
{
	if (v)
		rcu_read_unlock_bh();
}

static int dn_rt_cache_seq_show(struct seq_file *seq, void *v)
{
	struct dn_route *rt = v;
	char buf1[DN_ASCBUF_LEN], buf2[DN_ASCBUF_LEN];

	seq_printf(seq, "%-8s %-7s %-7s %04d %04d %04d\n",
1815 1816 1817 1818 1819
		   rt->dst.dev ? rt->dst.dev->name : "*",
		   dn_addr2asc(le16_to_cpu(rt->rt_daddr), buf1),
		   dn_addr2asc(le16_to_cpu(rt->rt_saddr), buf2),
		   atomic_read(&rt->dst.__refcnt),
		   rt->dst.__use, 0);
L
Linus Torvalds 已提交
1820
	return 0;
1821
}
L
Linus Torvalds 已提交
1822

1823
static const struct seq_operations dn_rt_cache_seq_ops = {
L
Linus Torvalds 已提交
1824 1825 1826 1827 1828 1829 1830 1831
	.start	= dn_rt_cache_seq_start,
	.next	= dn_rt_cache_seq_next,
	.stop	= dn_rt_cache_seq_stop,
	.show	= dn_rt_cache_seq_show,
};

static int dn_rt_cache_seq_open(struct inode *inode, struct file *file)
{
1832 1833
	return seq_open_private(file, &dn_rt_cache_seq_ops,
			sizeof(struct dn_rt_cache_iter_state));
L
Linus Torvalds 已提交
1834 1835
}

1836
static const struct file_operations dn_rt_cache_seq_fops = {
L
Linus Torvalds 已提交
1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849
	.owner	 = THIS_MODULE,
	.open	 = dn_rt_cache_seq_open,
	.read	 = seq_read,
	.llseek	 = seq_lseek,
	.release = seq_release_private,
};

#endif /* CONFIG_PROC_FS */

void __init dn_route_init(void)
{
	int i, goal, order;

A
Alexey Dobriyan 已提交
1850 1851
	dn_dst_ops.kmem_cachep =
		kmem_cache_create("dn_dst_cache", sizeof(struct dn_route), 0,
1852
				  SLAB_HWCACHE_ALIGN|SLAB_PANIC, NULL);
1853
	dst_entries_init(&dn_dst_ops);
1854
	setup_timer(&dn_route_timer, dn_dst_check_expire, 0);
L
Linus Torvalds 已提交
1855 1856 1857
	dn_route_timer.expires = jiffies + decnet_dst_gc_interval * HZ;
	add_timer(&dn_route_timer);

1858
	goal = totalram_pages >> (26 - PAGE_SHIFT);
L
Linus Torvalds 已提交
1859 1860 1861 1862

	for(order = 0; (1UL << order) < goal; order++)
		/* NOTHING */;

1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878
	/*
	 * Only want 1024 entries max, since the table is very, very unlikely
	 * to be larger than that.
	 */
	while(order && ((((1UL << order) * PAGE_SIZE) /
				sizeof(struct dn_rt_hash_bucket)) >= 2048))
		order--;

	do {
		dn_rt_hash_mask = (1UL << order) * PAGE_SIZE /
			sizeof(struct dn_rt_hash_bucket);
		while(dn_rt_hash_mask & (dn_rt_hash_mask - 1))
			dn_rt_hash_mask--;
		dn_rt_hash_table = (struct dn_rt_hash_bucket *)
			__get_free_pages(GFP_ATOMIC, order);
	} while (dn_rt_hash_table == NULL && --order > 0);
L
Linus Torvalds 已提交
1879 1880

	if (!dn_rt_hash_table)
1881
		panic("Failed to allocate DECnet route cache hash table\n");
L
Linus Torvalds 已提交
1882

1883 1884 1885
	printk(KERN_INFO
		"DECnet: Routing cache hash table of %u buckets, %ldKbytes\n",
		dn_rt_hash_mask,
L
Linus Torvalds 已提交
1886 1887 1888
		(long)(dn_rt_hash_mask*sizeof(struct dn_rt_hash_bucket))/1024);

	dn_rt_hash_mask--;
1889 1890 1891 1892
	for(i = 0; i <= dn_rt_hash_mask; i++) {
		spin_lock_init(&dn_rt_hash_table[i].lock);
		dn_rt_hash_table[i].chain = NULL;
	}
L
Linus Torvalds 已提交
1893

1894
	dn_dst_ops.gc_thresh = (dn_rt_hash_mask + 1);
L
Linus Torvalds 已提交
1895

1896
	proc_net_fops_create(&init_net, "decnet_cache", S_IRUGO, &dn_rt_cache_seq_fops);
1897 1898

#ifdef CONFIG_DECNET_ROUTER
1899 1900
	rtnl_register(PF_DECnet, RTM_GETROUTE, dn_cache_getroute,
		      dn_fib_dump, NULL);
1901 1902
#else
	rtnl_register(PF_DECnet, RTM_GETROUTE, dn_cache_getroute,
1903
		      dn_cache_dump, NULL);
1904
#endif
L
Linus Torvalds 已提交
1905 1906 1907 1908 1909 1910 1911
}

void __exit dn_route_cleanup(void)
{
	del_timer(&dn_route_timer);
	dn_run_flush(0);

1912
	proc_net_remove(&init_net, "decnet_cache");
1913
	dst_entries_destroy(&dn_dst_ops);
L
Linus Torvalds 已提交
1914 1915
}