[mirror_ubuntu-zesty-kernel.git] / net / ipx / ipx_route.c

/*
 *	Implements the IPX routing routines.
 *	Code moved from af_ipx.c.
 *
 *	Arnaldo Carvalho de Melo <acme@conectiva.com.br>, 2003
 *
 *	See net/ipx/ChangeLog.
 */

#include <linux/list.h>
#include <linux/route.h>
#include <linux/spinlock.h>

#include <net/ipx.h>
#include <net/sock.h>

LIST_HEAD(ipx_routes);
DEFINE_RWLOCK(ipx_routes_lock);

extern struct ipx_interface *ipx_internal_net;

extern __be16 ipx_cksum(struct ipxhdr *packet, int length);
extern struct ipx_interface *ipxitf_find_using_net(__be32 net);
extern int ipxitf_demux_socket(struct ipx_interface *intrfc,
			       struct sk_buff *skb, int copy);
extern int ipxitf_demux_socket(struct ipx_interface *intrfc,
			       struct sk_buff *skb, int copy);
extern int ipxitf_send(struct ipx_interface *intrfc, struct sk_buff *skb,
		       char *node);
extern struct ipx_interface *ipxitf_find_using_net(__be32 net);

struct ipx_route *ipxrtr_lookup(__be32 net)
{
	struct ipx_route *r;

	read_lock_bh(&ipx_routes_lock);
	list_for_each_entry(r, &ipx_routes, node)
		if (r->ir_net == net) {
			ipxrtr_hold(r);
			goto unlock;
		}
	r = NULL;
unlock:
	read_unlock_bh(&ipx_routes_lock);
	return r;
}

/*
 * Caller must hold a reference to intrfc
 */
int ipxrtr_add_route(__be32 network, struct ipx_interface *intrfc,
		     unsigned char *node)
{
	struct ipx_route *rt;
	int rc;

	/* Get a route structure; either existing or create */
	rt = ipxrtr_lookup(network);
	if (!rt) {
		rt = kmalloc(sizeof(*rt), GFP_ATOMIC);
		rc = -EAGAIN;
		if (!rt)
			goto out;

		atomic_set(&rt->refcnt, 1);
		ipxrtr_hold(rt);
		write_lock_bh(&ipx_routes_lock);
		list_add(&rt->node, &ipx_routes);
		write_unlock_bh(&ipx_routes_lock);
	} else {
		rc = -EEXIST;
		if (intrfc == ipx_internal_net)
			goto out_put;
	}

	rt->ir_net 	= network;
	rt->ir_intrfc 	= intrfc;
	if (!node) {
		memset(rt->ir_router_node, '\0', IPX_NODE_LEN);
		rt->ir_routed = 0;
	} else {
		memcpy(rt->ir_router_node, node, IPX_NODE_LEN);
		rt->ir_routed = 1;
	}

	rc = 0;
out_put:
	ipxrtr_put(rt);
out:
	return rc;
}

void ipxrtr_del_routes(struct ipx_interface *intrfc)
{
	struct ipx_route *r, *tmp;

	write_lock_bh(&ipx_routes_lock);
	list_for_each_entry_safe(r, tmp, &ipx_routes, node)
		if (r->ir_intrfc == intrfc) {
			list_del(&r->node);
			ipxrtr_put(r);
		}
	write_unlock_bh(&ipx_routes_lock);
}

static int ipxrtr_create(struct ipx_route_definition *rd)
{
	struct ipx_interface *intrfc;
	int rc = -ENETUNREACH;

	/* Find the appropriate interface */
	intrfc = ipxitf_find_using_net(rd->ipx_router_network);
	if (!intrfc)
		goto out;
	rc = ipxrtr_add_route(rd->ipx_network, intrfc, rd->ipx_router_node);
	ipxitf_put(intrfc);
out:
	return rc;
}

static int ipxrtr_delete(__be32 net)
{
	struct ipx_route *r, *tmp;
	int rc;

	write_lock_bh(&ipx_routes_lock);
	list_for_each_entry_safe(r, tmp, &ipx_routes, node)
		if (r->ir_net == net) {
			/* Directly connected; can't lose route */
			rc = -EPERM;
			if (!r->ir_routed)
				goto out;
			list_del(&r->node);
			ipxrtr_put(r);
			rc = 0;
			goto out;
		}
	rc = -ENOENT;
out:
	write_unlock_bh(&ipx_routes_lock);
	return rc;
}

/*
 * The skb has to be unshared, we'll end up calling ipxitf_send, that'll
 * modify the packet
 */
int ipxrtr_route_skb(struct sk_buff *skb)
{
	struct ipxhdr *ipx = ipx_hdr(skb);
	struct ipx_route *r = ipxrtr_lookup(IPX_SKB_CB(skb)->ipx_dest_net);

	if (!r) {	/* no known route */
		kfree_skb(skb);
		return 0;
	}

	ipxitf_hold(r->ir_intrfc);
	ipxitf_send(r->ir_intrfc, skb, r->ir_routed ?
			r->ir_router_node : ipx->ipx_dest.node);
	ipxitf_put(r->ir_intrfc);
	ipxrtr_put(r);

	return 0;
}

/*
 * Route an outgoing frame from a socket.
 */
int ipxrtr_route_packet(struct sock *sk, struct sockaddr_ipx *usipx,
			struct iovec *iov, size_t len, int noblock)
{
	struct sk_buff *skb;
	struct ipx_sock *ipxs = ipx_sk(sk);
	struct ipx_interface *intrfc;
	struct ipxhdr *ipx;
	size_t size;
	int ipx_offset;
	struct ipx_route *rt = NULL;
	int rc;

	/* Find the appropriate interface on which to send packet */
	if (!usipx->sipx_network && ipx_primary_net) {
		usipx->sipx_network = ipx_primary_net->if_netnum;
		intrfc = ipx_primary_net;
	} else {
		rt = ipxrtr_lookup(usipx->sipx_network);
		rc = -ENETUNREACH;
		if (!rt)
			goto out;
		intrfc = rt->ir_intrfc;
	}

	ipxitf_hold(intrfc);
	ipx_offset = intrfc->if_ipx_offset;
	size = sizeof(struct ipxhdr) + len + ipx_offset;

	skb = sock_alloc_send_skb(sk, size, noblock, &rc);
	if (!skb)
		goto out_put;

	skb_reserve(skb, ipx_offset);
	skb->sk = sk;

	/* Fill in IPX header */
	skb_reset_network_header(skb);
	skb_reset_transport_header(skb);
	skb_put(skb, sizeof(struct ipxhdr));
	ipx = ipx_hdr(skb);
	ipx->ipx_pktsize = htons(len + sizeof(struct ipxhdr));
	IPX_SKB_CB(skb)->ipx_tctrl = 0;
	ipx->ipx_type 	 = usipx->sipx_type;

	IPX_SKB_CB(skb)->last_hop.index = -1;
#ifdef CONFIG_IPX_INTERN
	IPX_SKB_CB(skb)->ipx_source_net = ipxs->intrfc->if_netnum;
	memcpy(ipx->ipx_source.node, ipxs->node, IPX_NODE_LEN);
#else
	rc = ntohs(ipxs->port);
	if (rc == 0x453 || rc == 0x452) {
		/* RIP/SAP special handling for mars_nwe */
		IPX_SKB_CB(skb)->ipx_source_net = intrfc->if_netnum;
		memcpy(ipx->ipx_source.node, intrfc->if_node, IPX_NODE_LEN);
	} else {
		IPX_SKB_CB(skb)->ipx_source_net = ipxs->intrfc->if_netnum;
		memcpy(ipx->ipx_source.node, ipxs->intrfc->if_node,
			IPX_NODE_LEN);
	}
#endif	/* CONFIG_IPX_INTERN */
	ipx->ipx_source.sock		= ipxs->port;
	IPX_SKB_CB(skb)->ipx_dest_net	= usipx->sipx_network;
	memcpy(ipx->ipx_dest.node, usipx->sipx_node, IPX_NODE_LEN);
	ipx->ipx_dest.sock		= usipx->sipx_port;

	rc = memcpy_fromiovec(skb_put(skb, len), iov, len);
	if (rc) {
		kfree_skb(skb);
		goto out_put;
	}

	/* Apply checksum. Not allowed on 802.3 links. */
	if (sk->sk_no_check || intrfc->if_dlink_type == htons(IPX_FRAME_8023))
		ipx->ipx_checksum = htons(0xFFFF);
	else
		ipx->ipx_checksum = ipx_cksum(ipx, len + sizeof(struct ipxhdr));

	rc = ipxitf_send(intrfc, skb, (rt && rt->ir_routed) ?
			 rt->ir_router_node : ipx->ipx_dest.node);
out_put:
	ipxitf_put(intrfc);
	if (rt)
		ipxrtr_put(rt);
out:
	return rc;
}

/*
 * We use a normal struct rtentry for route handling
 */
int ipxrtr_ioctl(unsigned int cmd, void __user *arg)
{
	struct rtentry rt;	/* Use these to behave like 'other' stacks */
	struct sockaddr_ipx *sg, *st;
	int rc = -EFAULT;

	if (copy_from_user(&rt, arg, sizeof(rt)))
		goto out;

	sg = (struct sockaddr_ipx *)&rt.rt_gateway;
	st = (struct sockaddr_ipx *)&rt.rt_dst;

	rc = -EINVAL;
	if (!(rt.rt_flags & RTF_GATEWAY) || /* Direct routes are fixed */
	    sg->sipx_family != AF_IPX ||
	    st->sipx_family != AF_IPX)
		goto out;

	switch (cmd) {
	case SIOCDELRT:
		rc = ipxrtr_delete(st->sipx_network);
		break;
	case SIOCADDRT: {
		struct ipx_route_definition f;
		f.ipx_network		= st->sipx_network;
		f.ipx_router_network	= sg->sipx_network;
		memcpy(f.ipx_router_node, sg->sipx_node, IPX_NODE_LEN);
		rc = ipxrtr_create(&f);
		break;
	}
	}

out:
	return rc;
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Implements the IPX routing routines.
	3	* Code moved from af_ipx.c.
	4	*
	5	* Arnaldo Carvalho de Melo <acme@conectiva.com.br>, 2003
	6	*
	7	* See net/ipx/ChangeLog.
	8	*/
	9
1da177e4 LT	10	#include <linux/list.h>
	11	#include <linux/route.h>
	12	#include <linux/spinlock.h>
	13
	14	#include <net/ipx.h>
	15	#include <net/sock.h>
	16
	17	LIST_HEAD(ipx_routes);
	18	DEFINE_RWLOCK(ipx_routes_lock);
	19
	20	extern struct ipx_interface *ipx_internal_net;
	21
02e60370	22	extern __be16 ipx_cksum(struct ipxhdr *packet, int length);
4833ed09	23	extern struct ipx_interface *ipxitf_find_using_net(__be32 net);
1da177e4 LT	24	extern int ipxitf_demux_socket(struct ipx_interface *intrfc,
	25	struct sk_buff *skb, int copy);
	26	extern int ipxitf_demux_socket(struct ipx_interface *intrfc,
	27	struct sk_buff *skb, int copy);
	28	extern int ipxitf_send(struct ipx_interface intrfc, struct sk_buff skb,
	29	char *node);
4833ed09	30	extern struct ipx_interface *ipxitf_find_using_net(__be32 net);
1da177e4	31
4833ed09	32	struct ipx_route *ipxrtr_lookup(__be32 net)
1da177e4 LT	33	{
	34	struct ipx_route *r;
	35
	36	read_lock_bh(&ipx_routes_lock);
	37	list_for_each_entry(r, &ipx_routes, node)
	38	if (r->ir_net == net) {
	39	ipxrtr_hold(r);
	40	goto unlock;
	41	}
	42	r = NULL;
	43	unlock:
	44	read_unlock_bh(&ipx_routes_lock);
	45	return r;
	46	}
	47
	48	/*
	49	* Caller must hold a reference to intrfc
	50	*/
4833ed09	51	int ipxrtr_add_route(__be32 network, struct ipx_interface *intrfc,
1da177e4 LT	52	unsigned char *node)
	53	{
	54	struct ipx_route *rt;
	55	int rc;
	56
	57	/* Get a route structure; either existing or create */
	58	rt = ipxrtr_lookup(network);
	59	if (!rt) {
	60	rt = kmalloc(sizeof(*rt), GFP_ATOMIC);
	61	rc = -EAGAIN;
	62	if (!rt)
	63	goto out;
	64
	65	atomic_set(&rt->refcnt, 1);
	66	ipxrtr_hold(rt);
	67	write_lock_bh(&ipx_routes_lock);
	68	list_add(&rt->node, &ipx_routes);
	69	write_unlock_bh(&ipx_routes_lock);
	70	} else {
	71	rc = -EEXIST;
	72	if (intrfc == ipx_internal_net)
	73	goto out_put;
	74	}
	75
	76	rt->ir_net = network;
	77	rt->ir_intrfc = intrfc;
	78	if (!node) {
	79	memset(rt->ir_router_node, '\0', IPX_NODE_LEN);
	80	rt->ir_routed = 0;
	81	} else {
	82	memcpy(rt->ir_router_node, node, IPX_NODE_LEN);
	83	rt->ir_routed = 1;
	84	}
	85
	86	rc = 0;
	87	out_put:
	88	ipxrtr_put(rt);
	89	out:
	90	return rc;
	91	}
	92
	93	void ipxrtr_del_routes(struct ipx_interface *intrfc)
	94	{
	95	struct ipx_route r, tmp;
	96
	97	write_lock_bh(&ipx_routes_lock);
	98	list_for_each_entry_safe(r, tmp, &ipx_routes, node)
	99	if (r->ir_intrfc == intrfc) {
	100	list_del(&r->node);
	101	ipxrtr_put(r);
	102	}
	103	write_unlock_bh(&ipx_routes_lock);
	104	}
	105
	106	static int ipxrtr_create(struct ipx_route_definition *rd)
	107	{
	108	struct ipx_interface *intrfc;
	109	int rc = -ENETUNREACH;
	110
	111	/* Find the appropriate interface */
	112	intrfc = ipxitf_find_using_net(rd->ipx_router_network);
	113	if (!intrfc)
	114	goto out;
	115	rc = ipxrtr_add_route(rd->ipx_network, intrfc, rd->ipx_router_node);
116	ipxitf_put(intrfc);
117	out:
118	return rc;
119	}
120
4833ed09	121	static int ipxrtr_delete(__be32 net)
1da177e4 LT	122	{
	123	struct ipx_route r, tmp;
	124	int rc;
	125
	126	write_lock_bh(&ipx_routes_lock);
	127	list_for_each_entry_safe(r, tmp, &ipx_routes, node)
	128	if (r->ir_net == net) {
	129	/* Directly connected; can't lose route */
	130	rc = -EPERM;
	131	if (!r->ir_routed)
	132	goto out;
	133	list_del(&r->node);
	134	ipxrtr_put(r);
	135	rc = 0;
	136	goto out;
	137	}
	138	rc = -ENOENT;
	139	out:
	140	write_unlock_bh(&ipx_routes_lock);
	141	return rc;
	142	}
	143
	144	/*
	145	* The skb has to be unshared, we'll end up calling ipxitf_send, that'll
	146	* modify the packet
	147	*/
	148	int ipxrtr_route_skb(struct sk_buff *skb)
	149	{
	150	struct ipxhdr *ipx = ipx_hdr(skb);
	151	struct ipx_route *r = ipxrtr_lookup(IPX_SKB_CB(skb)->ipx_dest_net);
	152
	153	if (!r) { /* no known route */
	154	kfree_skb(skb);
	155	return 0;
	156	}
	157
	158	ipxitf_hold(r->ir_intrfc);
	159	ipxitf_send(r->ir_intrfc, skb, r->ir_routed ?
	160	r->ir_router_node : ipx->ipx_dest.node);
	161	ipxitf_put(r->ir_intrfc);
	162	ipxrtr_put(r);
	163
	164	return 0;
	165	}
	166
	167	/*
	168	* Route an outgoing frame from a socket.
	169	*/
	170	int ipxrtr_route_packet(struct sock sk, struct sockaddr_ipx usipx,
	171	struct iovec *iov, size_t len, int noblock)
	172	{
	173	struct sk_buff *skb;
	174	struct ipx_sock *ipxs = ipx_sk(sk);
	175	struct ipx_interface *intrfc;
	176	struct ipxhdr *ipx;
	177	size_t size;
	178	int ipx_offset;
	179	struct ipx_route *rt = NULL;
	180	int rc;
	181
	182	/* Find the appropriate interface on which to send packet */
	183	if (!usipx->sipx_network && ipx_primary_net) {
	184	usipx->sipx_network = ipx_primary_net->if_netnum;
	185	intrfc = ipx_primary_net;
186	} else {
187	rt = ipxrtr_lookup(usipx->sipx_network);
188	rc = -ENETUNREACH;
189	if (!rt)
190	goto out;
191	intrfc = rt->ir_intrfc;
192	}
193
194	ipxitf_hold(intrfc);
195	ipx_offset = intrfc->if_ipx_offset;
196	size = sizeof(struct ipxhdr) + len + ipx_offset;
197
198	skb = sock_alloc_send_skb(sk, size, noblock, &rc);
199	if (!skb)
200	goto out_put;
201
202	skb_reserve(skb, ipx_offset);
203	skb->sk = sk;
204
205	/* Fill in IPX header */
7e28ecc2	206	skb_reset_network_header(skb);
badff6d0	207	skb_reset_transport_header(skb);
7e28ecc2	208	skb_put(skb, sizeof(struct ipxhdr));
1da177e4 LT	209	ipx = ipx_hdr(skb);
	210	ipx->ipx_pktsize = htons(len + sizeof(struct ipxhdr));
	211	IPX_SKB_CB(skb)->ipx_tctrl = 0;
	212	ipx->ipx_type = usipx->sipx_type;
	213
	214	IPX_SKB_CB(skb)->last_hop.index = -1;
	215	#ifdef CONFIG_IPX_INTERN
	216	IPX_SKB_CB(skb)->ipx_source_net = ipxs->intrfc->if_netnum;
	217	memcpy(ipx->ipx_source.node, ipxs->node, IPX_NODE_LEN);
	218	#else
	219	rc = ntohs(ipxs->port);
	220	if (rc == 0x453 \|\| rc == 0x452) {
	221	/* RIP/SAP special handling for mars_nwe */
	222	IPX_SKB_CB(skb)->ipx_source_net = intrfc->if_netnum;
	223	memcpy(ipx->ipx_source.node, intrfc->if_node, IPX_NODE_LEN);
	224	} else {
	225	IPX_SKB_CB(skb)->ipx_source_net = ipxs->intrfc->if_netnum;
	226	memcpy(ipx->ipx_source.node, ipxs->intrfc->if_node,
	227	IPX_NODE_LEN);
	228	}
	229	#endif /* CONFIG_IPX_INTERN */
	230	ipx->ipx_source.sock = ipxs->port;
	231	IPX_SKB_CB(skb)->ipx_dest_net = usipx->sipx_network;
	232	memcpy(ipx->ipx_dest.node, usipx->sipx_node, IPX_NODE_LEN);
	233	ipx->ipx_dest.sock = usipx->sipx_port;
	234
	235	rc = memcpy_fromiovec(skb_put(skb, len), iov, len);
	236	if (rc) {
	237	kfree_skb(skb);
	238	goto out_put;
981c0ff6	239	}
1da177e4 LT	240
1da177e4 LT	241	/* Apply checksum. Not allowed on 802.3 links. */
f8d59621	242	if (sk->sk_no_check \|\| intrfc->if_dlink_type == htons(IPX_FRAME_8023))
02e60370	243	ipx->ipx_checksum = htons(0xFFFF);
1da177e4 LT	244	else
	245	ipx->ipx_checksum = ipx_cksum(ipx, len + sizeof(struct ipxhdr));
	246
981c0ff6	247	rc = ipxitf_send(intrfc, skb, (rt && rt->ir_routed) ?
1da177e4 LT	248	rt->ir_router_node : ipx->ipx_dest.node);
	249	out_put:
	250	ipxitf_put(intrfc);
	251	if (rt)
	252	ipxrtr_put(rt);
	253	out:
	254	return rc;
	255	}
	256
	257	/*
	258	* We use a normal struct rtentry for route handling
	259	*/
	260	int ipxrtr_ioctl(unsigned int cmd, void __user *arg)
	261	{
	262	struct rtentry rt; /* Use these to behave like 'other' stacks */
	263	struct sockaddr_ipx sg, st;
	264	int rc = -EFAULT;
	265
	266	if (copy_from_user(&rt, arg, sizeof(rt)))
	267	goto out;
	268
	269	sg = (struct sockaddr_ipx *)&rt.rt_gateway;
	270	st = (struct sockaddr_ipx *)&rt.rt_dst;
	271
	272	rc = -EINVAL;
	273	if (!(rt.rt_flags & RTF_GATEWAY) \|\| /* Direct routes are fixed */
	274	sg->sipx_family != AF_IPX \|\|
	275	st->sipx_family != AF_IPX)
	276	goto out;
	277
	278	switch (cmd) {
	279	case SIOCDELRT:
	280	rc = ipxrtr_delete(st->sipx_network);
	281	break;
	282	case SIOCADDRT: {
	283	struct ipx_route_definition f;
	284	f.ipx_network = st->sipx_network;
	285	f.ipx_router_network = sg->sipx_network;
	286	memcpy(f.ipx_router_node, sg->sipx_node, IPX_NODE_LEN);
	287	rc = ipxrtr_create(&f);
	288	break;
	289	}
	290	}
	291
	292	out:
	293	return rc;
	294	}