xref: /openbmc/linux/net/x25/af_x25.c (revision 5a0e3ad6af8660be21ca98a971cd00f331318c05)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  *	X.25 Packet Layer release 002
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  *	This is ALPHA test software. This code may break your machine,
51da177e4SLinus Torvalds  *	randomly fail to work with new releases, misbehave and/or generally
61da177e4SLinus Torvalds  *	screw up. It might even work.
71da177e4SLinus Torvalds  *
81da177e4SLinus Torvalds  *	This code REQUIRES 2.1.15 or higher
91da177e4SLinus Torvalds  *
101da177e4SLinus Torvalds  *	This module:
111da177e4SLinus Torvalds  *		This module is free software; you can redistribute it and/or
121da177e4SLinus Torvalds  *		modify it under the terms of the GNU General Public License
131da177e4SLinus Torvalds  *		as published by the Free Software Foundation; either version
141da177e4SLinus Torvalds  *		2 of the License, or (at your option) any later version.
151da177e4SLinus Torvalds  *
161da177e4SLinus Torvalds  *	History
171da177e4SLinus Torvalds  *	X.25 001	Jonathan Naylor	Started coding.
181da177e4SLinus Torvalds  *	X.25 002	Jonathan Naylor	Centralised disconnect handling.
191da177e4SLinus Torvalds  *					New timer architecture.
201da177e4SLinus Torvalds  *	2000-03-11	Henner Eisen	MSG_EOR handling more POSIX compliant.
211da177e4SLinus Torvalds  *	2000-03-22	Daniela Squassoni Allowed disabling/enabling of
221da177e4SLinus Torvalds  *					  facilities negotiation and increased
231da177e4SLinus Torvalds  *					  the throughput upper limit.
241da177e4SLinus Torvalds  *	2000-08-27	Arnaldo C. Melo s/suser/capable/ + micro cleanups
251da177e4SLinus Torvalds  *	2000-09-04	Henner Eisen	Set sock->state in x25_accept().
261da177e4SLinus Torvalds  *					Fixed x25_output() related skb leakage.
271da177e4SLinus Torvalds  *	2000-10-02	Henner Eisen	Made x25_kick() single threaded per socket.
281da177e4SLinus Torvalds  *	2000-10-27	Henner Eisen    MSG_DONTWAIT for fragment allocation.
291da177e4SLinus Torvalds  *	2000-11-14	Henner Eisen    Closing datalink from NETDEV_GOING_DOWN
301da177e4SLinus Torvalds  *	2002-10-06	Arnaldo C. Melo Get rid of cli/sti, move proc stuff to
311da177e4SLinus Torvalds  *					x25_proc.c, using seq_file
32cb65d506SShaun Pereira  *	2005-04-02	Shaun Pereira	Selective sub address matching
33cb65d506SShaun Pereira  *					with call user data
34ebc3f64bSShaun Pereira  *	2005-04-15	Shaun Pereira	Fast select with no restriction on
35ebc3f64bSShaun Pereira  *					response
361da177e4SLinus Torvalds  */
371da177e4SLinus Torvalds 
381da177e4SLinus Torvalds #include <linux/module.h>
394fc268d2SRandy Dunlap #include <linux/capability.h>
401da177e4SLinus Torvalds #include <linux/errno.h>
411da177e4SLinus Torvalds #include <linux/kernel.h>
421da177e4SLinus Torvalds #include <linux/sched.h>
43405f5571SAlexey Dobriyan #include <linux/smp_lock.h>
441da177e4SLinus Torvalds #include <linux/timer.h>
451da177e4SLinus Torvalds #include <linux/string.h>
461da177e4SLinus Torvalds #include <linux/net.h>
471da177e4SLinus Torvalds #include <linux/netdevice.h>
481da177e4SLinus Torvalds #include <linux/if_arp.h>
491da177e4SLinus Torvalds #include <linux/skbuff.h>
50*5a0e3ad6STejun Heo #include <linux/slab.h>
511da177e4SLinus Torvalds #include <net/sock.h>
52c752f073SArnaldo Carvalho de Melo #include <net/tcp_states.h>
531da177e4SLinus Torvalds #include <asm/uaccess.h>
541da177e4SLinus Torvalds #include <linux/fcntl.h>
551da177e4SLinus Torvalds #include <linux/termios.h>	/* For TIOCINQ/OUTQ */
561da177e4SLinus Torvalds #include <linux/notifier.h>
571da177e4SLinus Torvalds #include <linux/init.h>
581b06e6baSShaun Pereira #include <linux/compat.h>
59a9288525Sandrew hendry #include <linux/ctype.h>
601b06e6baSShaun Pereira 
611da177e4SLinus Torvalds #include <net/x25.h>
621b06e6baSShaun Pereira #include <net/compat.h>
631da177e4SLinus Torvalds 
641da177e4SLinus Torvalds int sysctl_x25_restart_request_timeout = X25_DEFAULT_T20;
651da177e4SLinus Torvalds int sysctl_x25_call_request_timeout    = X25_DEFAULT_T21;
661da177e4SLinus Torvalds int sysctl_x25_reset_request_timeout   = X25_DEFAULT_T22;
671da177e4SLinus Torvalds int sysctl_x25_clear_request_timeout   = X25_DEFAULT_T23;
681da177e4SLinus Torvalds int sysctl_x25_ack_holdback_timeout    = X25_DEFAULT_T2;
6939e21c0dSAndrew Hendry int sysctl_x25_forward                 = 0;
701da177e4SLinus Torvalds 
711da177e4SLinus Torvalds HLIST_HEAD(x25_list);
721da177e4SLinus Torvalds DEFINE_RWLOCK(x25_list_lock);
731da177e4SLinus Torvalds 
7490ddc4f0SEric Dumazet static const struct proto_ops x25_proto_ops;
751da177e4SLinus Torvalds 
761da177e4SLinus Torvalds static struct x25_address null_x25_address = {"               "};
771da177e4SLinus Torvalds 
781b06e6baSShaun Pereira #ifdef CONFIG_COMPAT
791b06e6baSShaun Pereira struct compat_x25_subscrip_struct {
801b06e6baSShaun Pereira 	char device[200-sizeof(compat_ulong_t)];
811b06e6baSShaun Pereira 	compat_ulong_t global_facil_mask;
821b06e6baSShaun Pereira 	compat_uint_t extended;
831b06e6baSShaun Pereira };
841b06e6baSShaun Pereira #endif
851b06e6baSShaun Pereira 
861da177e4SLinus Torvalds int x25_addr_ntoa(unsigned char *p, struct x25_address *called_addr,
871da177e4SLinus Torvalds 		  struct x25_address *calling_addr)
881da177e4SLinus Torvalds {
896bf1574eSEric Dumazet 	unsigned int called_len, calling_len;
901da177e4SLinus Torvalds 	char *called, *calling;
916bf1574eSEric Dumazet 	unsigned int i;
921da177e4SLinus Torvalds 
931da177e4SLinus Torvalds 	called_len  = (*p >> 0) & 0x0F;
941da177e4SLinus Torvalds 	calling_len = (*p >> 4) & 0x0F;
951da177e4SLinus Torvalds 
961da177e4SLinus Torvalds 	called  = called_addr->x25_addr;
971da177e4SLinus Torvalds 	calling = calling_addr->x25_addr;
981da177e4SLinus Torvalds 	p++;
991da177e4SLinus Torvalds 
1001da177e4SLinus Torvalds 	for (i = 0; i < (called_len + calling_len); i++) {
1011da177e4SLinus Torvalds 		if (i < called_len) {
1021da177e4SLinus Torvalds 			if (i % 2 != 0) {
1031da177e4SLinus Torvalds 				*called++ = ((*p >> 0) & 0x0F) + '0';
1041da177e4SLinus Torvalds 				p++;
1051da177e4SLinus Torvalds 			} else {
1061da177e4SLinus Torvalds 				*called++ = ((*p >> 4) & 0x0F) + '0';
1071da177e4SLinus Torvalds 			}
1081da177e4SLinus Torvalds 		} else {
1091da177e4SLinus Torvalds 			if (i % 2 != 0) {
1101da177e4SLinus Torvalds 				*calling++ = ((*p >> 0) & 0x0F) + '0';
1111da177e4SLinus Torvalds 				p++;
1121da177e4SLinus Torvalds 			} else {
1131da177e4SLinus Torvalds 				*calling++ = ((*p >> 4) & 0x0F) + '0';
1141da177e4SLinus Torvalds 			}
1151da177e4SLinus Torvalds 		}
1161da177e4SLinus Torvalds 	}
1171da177e4SLinus Torvalds 
1181da177e4SLinus Torvalds 	*called = *calling = '\0';
1191da177e4SLinus Torvalds 
1201da177e4SLinus Torvalds 	return 1 + (called_len + calling_len + 1) / 2;
1211da177e4SLinus Torvalds }
1221da177e4SLinus Torvalds 
1231da177e4SLinus Torvalds int x25_addr_aton(unsigned char *p, struct x25_address *called_addr,
1241da177e4SLinus Torvalds 		  struct x25_address *calling_addr)
1251da177e4SLinus Torvalds {
1261da177e4SLinus Torvalds 	unsigned int called_len, calling_len;
1271da177e4SLinus Torvalds 	char *called, *calling;
1281da177e4SLinus Torvalds 	int i;
1291da177e4SLinus Torvalds 
1301da177e4SLinus Torvalds 	called  = called_addr->x25_addr;
1311da177e4SLinus Torvalds 	calling = calling_addr->x25_addr;
1321da177e4SLinus Torvalds 
1331da177e4SLinus Torvalds 	called_len  = strlen(called);
1341da177e4SLinus Torvalds 	calling_len = strlen(calling);
1351da177e4SLinus Torvalds 
1361da177e4SLinus Torvalds 	*p++ = (calling_len << 4) | (called_len << 0);
1371da177e4SLinus Torvalds 
1381da177e4SLinus Torvalds 	for (i = 0; i < (called_len + calling_len); i++) {
1391da177e4SLinus Torvalds 		if (i < called_len) {
1401da177e4SLinus Torvalds 			if (i % 2 != 0) {
1411da177e4SLinus Torvalds 				*p |= (*called++ - '0') << 0;
1421da177e4SLinus Torvalds 				p++;
1431da177e4SLinus Torvalds 			} else {
1441da177e4SLinus Torvalds 				*p = 0x00;
1451da177e4SLinus Torvalds 				*p |= (*called++ - '0') << 4;
1461da177e4SLinus Torvalds 			}
1471da177e4SLinus Torvalds 		} else {
1481da177e4SLinus Torvalds 			if (i % 2 != 0) {
1491da177e4SLinus Torvalds 				*p |= (*calling++ - '0') << 0;
1501da177e4SLinus Torvalds 				p++;
1511da177e4SLinus Torvalds 			} else {
1521da177e4SLinus Torvalds 				*p = 0x00;
1531da177e4SLinus Torvalds 				*p |= (*calling++ - '0') << 4;
1541da177e4SLinus Torvalds 			}
1551da177e4SLinus Torvalds 		}
1561da177e4SLinus Torvalds 	}
1571da177e4SLinus Torvalds 
1581da177e4SLinus Torvalds 	return 1 + (called_len + calling_len + 1) / 2;
1591da177e4SLinus Torvalds }
1601da177e4SLinus Torvalds 
1611da177e4SLinus Torvalds /*
1621da177e4SLinus Torvalds  *	Socket removal during an interrupt is now safe.
1631da177e4SLinus Torvalds  */
1641da177e4SLinus Torvalds static void x25_remove_socket(struct sock *sk)
1651da177e4SLinus Torvalds {
1661da177e4SLinus Torvalds 	write_lock_bh(&x25_list_lock);
1671da177e4SLinus Torvalds 	sk_del_node_init(sk);
1681da177e4SLinus Torvalds 	write_unlock_bh(&x25_list_lock);
1691da177e4SLinus Torvalds }
1701da177e4SLinus Torvalds 
1711da177e4SLinus Torvalds /*
1721da177e4SLinus Torvalds  *	Kill all bound sockets on a dropped device.
1731da177e4SLinus Torvalds  */
1741da177e4SLinus Torvalds static void x25_kill_by_device(struct net_device *dev)
1751da177e4SLinus Torvalds {
1761da177e4SLinus Torvalds 	struct sock *s;
1771da177e4SLinus Torvalds 	struct hlist_node *node;
1781da177e4SLinus Torvalds 
1791da177e4SLinus Torvalds 	write_lock_bh(&x25_list_lock);
1801da177e4SLinus Torvalds 
1811da177e4SLinus Torvalds 	sk_for_each(s, node, &x25_list)
1821da177e4SLinus Torvalds 		if (x25_sk(s)->neighbour && x25_sk(s)->neighbour->dev == dev)
1831da177e4SLinus Torvalds 			x25_disconnect(s, ENETUNREACH, 0, 0);
1841da177e4SLinus Torvalds 
1851da177e4SLinus Torvalds 	write_unlock_bh(&x25_list_lock);
1861da177e4SLinus Torvalds }
1871da177e4SLinus Torvalds 
1881da177e4SLinus Torvalds /*
1891da177e4SLinus Torvalds  *	Handle device status changes.
1901da177e4SLinus Torvalds  */
1911da177e4SLinus Torvalds static int x25_device_event(struct notifier_block *this, unsigned long event,
1921da177e4SLinus Torvalds 			    void *ptr)
1931da177e4SLinus Torvalds {
1941da177e4SLinus Torvalds 	struct net_device *dev = ptr;
1951da177e4SLinus Torvalds 	struct x25_neigh *nb;
1961da177e4SLinus Torvalds 
197721499e8SYOSHIFUJI Hideaki 	if (!net_eq(dev_net(dev), &init_net))
198e9dc8653SEric W. Biederman 		return NOTIFY_DONE;
199e9dc8653SEric W. Biederman 
2001da177e4SLinus Torvalds 	if (dev->type == ARPHRD_X25
2011da177e4SLinus Torvalds #if defined(CONFIG_LLC) || defined(CONFIG_LLC_MODULE)
2021da177e4SLinus Torvalds 	 || dev->type == ARPHRD_ETHER
2031da177e4SLinus Torvalds #endif
2041da177e4SLinus Torvalds 	 ) {
2051da177e4SLinus Torvalds 		switch (event) {
2061da177e4SLinus Torvalds 			case NETDEV_UP:
2071da177e4SLinus Torvalds 				x25_link_device_up(dev);
2081da177e4SLinus Torvalds 				break;
2091da177e4SLinus Torvalds 			case NETDEV_GOING_DOWN:
2101da177e4SLinus Torvalds 				nb = x25_get_neigh(dev);
2111da177e4SLinus Torvalds 				if (nb) {
2121da177e4SLinus Torvalds 					x25_terminate_link(nb);
2131da177e4SLinus Torvalds 					x25_neigh_put(nb);
2141da177e4SLinus Torvalds 				}
2151da177e4SLinus Torvalds 				break;
2161da177e4SLinus Torvalds 			case NETDEV_DOWN:
2171da177e4SLinus Torvalds 				x25_kill_by_device(dev);
2181da177e4SLinus Torvalds 				x25_route_device_down(dev);
2191da177e4SLinus Torvalds 				x25_link_device_down(dev);
2201da177e4SLinus Torvalds 				break;
2211da177e4SLinus Torvalds 		}
2221da177e4SLinus Torvalds 	}
2231da177e4SLinus Torvalds 
2241da177e4SLinus Torvalds 	return NOTIFY_DONE;
2251da177e4SLinus Torvalds }
2261da177e4SLinus Torvalds 
2271da177e4SLinus Torvalds /*
2281da177e4SLinus Torvalds  *	Add a socket to the bound sockets list.
2291da177e4SLinus Torvalds  */
2301da177e4SLinus Torvalds static void x25_insert_socket(struct sock *sk)
2311da177e4SLinus Torvalds {
2321da177e4SLinus Torvalds 	write_lock_bh(&x25_list_lock);
2331da177e4SLinus Torvalds 	sk_add_node(sk, &x25_list);
2341da177e4SLinus Torvalds 	write_unlock_bh(&x25_list_lock);
2351da177e4SLinus Torvalds }
2361da177e4SLinus Torvalds 
2371da177e4SLinus Torvalds /*
2381da177e4SLinus Torvalds  *	Find a socket that wants to accept the Call Request we just
2391da177e4SLinus Torvalds  *	received. Check the full list for an address/cud match.
2401da177e4SLinus Torvalds  *	If no cuds match return the next_best thing, an address match.
2411da177e4SLinus Torvalds  *	Note: if a listening socket has cud set it must only get calls
2421da177e4SLinus Torvalds  *	with matching cud.
2431da177e4SLinus Torvalds  */
244cb65d506SShaun Pereira static struct sock *x25_find_listener(struct x25_address *addr,
245cb65d506SShaun Pereira 					struct sk_buff *skb)
2461da177e4SLinus Torvalds {
2471da177e4SLinus Torvalds 	struct sock *s;
2481da177e4SLinus Torvalds 	struct sock *next_best;
2491da177e4SLinus Torvalds 	struct hlist_node *node;
2501da177e4SLinus Torvalds 
2511da177e4SLinus Torvalds 	read_lock_bh(&x25_list_lock);
2521da177e4SLinus Torvalds 	next_best = NULL;
2531da177e4SLinus Torvalds 
2541da177e4SLinus Torvalds 	sk_for_each(s, node, &x25_list)
2551da177e4SLinus Torvalds 		if ((!strcmp(addr->x25_addr,
2561da177e4SLinus Torvalds 			x25_sk(s)->source_addr.x25_addr) ||
2571da177e4SLinus Torvalds 				!strcmp(addr->x25_addr,
2581da177e4SLinus Torvalds 					null_x25_address.x25_addr)) &&
2591da177e4SLinus Torvalds 					s->sk_state == TCP_LISTEN) {
2601da177e4SLinus Torvalds 			/*
2611da177e4SLinus Torvalds 			 * Found a listening socket, now check the incoming
2621da177e4SLinus Torvalds 			 * call user data vs this sockets call user data
2631da177e4SLinus Torvalds 			 */
264cb65d506SShaun Pereira 			if(skb->len > 0 && x25_sk(s)->cudmatchlength > 0) {
265cb65d506SShaun Pereira 				if((memcmp(x25_sk(s)->calluserdata.cuddata,
266cb65d506SShaun Pereira 					skb->data,
267cb65d506SShaun Pereira 					x25_sk(s)->cudmatchlength)) == 0) {
2681da177e4SLinus Torvalds 					sock_hold(s);
2691da177e4SLinus Torvalds 					goto found;
2701da177e4SLinus Torvalds 				 }
271cb65d506SShaun Pereira 			} else
2721da177e4SLinus Torvalds 				next_best = s;
2731da177e4SLinus Torvalds 		}
2741da177e4SLinus Torvalds 	if (next_best) {
2751da177e4SLinus Torvalds 		s = next_best;
2761da177e4SLinus Torvalds 		sock_hold(s);
2771da177e4SLinus Torvalds 		goto found;
2781da177e4SLinus Torvalds 	}
2791da177e4SLinus Torvalds 	s = NULL;
2801da177e4SLinus Torvalds found:
2811da177e4SLinus Torvalds 	read_unlock_bh(&x25_list_lock);
2821da177e4SLinus Torvalds 	return s;
2831da177e4SLinus Torvalds }
2841da177e4SLinus Torvalds 
2851da177e4SLinus Torvalds /*
2861da177e4SLinus Torvalds  *	Find a connected X.25 socket given my LCI and neighbour.
2871da177e4SLinus Torvalds  */
2881da177e4SLinus Torvalds static struct sock *__x25_find_socket(unsigned int lci, struct x25_neigh *nb)
2891da177e4SLinus Torvalds {
2901da177e4SLinus Torvalds 	struct sock *s;
2911da177e4SLinus Torvalds 	struct hlist_node *node;
2921da177e4SLinus Torvalds 
2931da177e4SLinus Torvalds 	sk_for_each(s, node, &x25_list)
2941da177e4SLinus Torvalds 		if (x25_sk(s)->lci == lci && x25_sk(s)->neighbour == nb) {
2951da177e4SLinus Torvalds 			sock_hold(s);
2961da177e4SLinus Torvalds 			goto found;
2971da177e4SLinus Torvalds 		}
2981da177e4SLinus Torvalds 	s = NULL;
2991da177e4SLinus Torvalds found:
3001da177e4SLinus Torvalds 	return s;
3011da177e4SLinus Torvalds }
3021da177e4SLinus Torvalds 
3031da177e4SLinus Torvalds struct sock *x25_find_socket(unsigned int lci, struct x25_neigh *nb)
3041da177e4SLinus Torvalds {
3051da177e4SLinus Torvalds 	struct sock *s;
3061da177e4SLinus Torvalds 
3071da177e4SLinus Torvalds 	read_lock_bh(&x25_list_lock);
3081da177e4SLinus Torvalds 	s = __x25_find_socket(lci, nb);
3091da177e4SLinus Torvalds 	read_unlock_bh(&x25_list_lock);
3101da177e4SLinus Torvalds 	return s;
3111da177e4SLinus Torvalds }
3121da177e4SLinus Torvalds 
3131da177e4SLinus Torvalds /*
3141da177e4SLinus Torvalds  *	Find a unique LCI for a given device.
3151da177e4SLinus Torvalds  */
3161da177e4SLinus Torvalds static unsigned int x25_new_lci(struct x25_neigh *nb)
3171da177e4SLinus Torvalds {
3181da177e4SLinus Torvalds 	unsigned int lci = 1;
3191da177e4SLinus Torvalds 	struct sock *sk;
3201da177e4SLinus Torvalds 
3211da177e4SLinus Torvalds 	read_lock_bh(&x25_list_lock);
3221da177e4SLinus Torvalds 
3231da177e4SLinus Torvalds 	while ((sk = __x25_find_socket(lci, nb)) != NULL) {
3241da177e4SLinus Torvalds 		sock_put(sk);
3251da177e4SLinus Torvalds 		if (++lci == 4096) {
3261da177e4SLinus Torvalds 			lci = 0;
3271da177e4SLinus Torvalds 			break;
3281da177e4SLinus Torvalds 		}
3291da177e4SLinus Torvalds 	}
3301da177e4SLinus Torvalds 
3311da177e4SLinus Torvalds 	read_unlock_bh(&x25_list_lock);
3321da177e4SLinus Torvalds 	return lci;
3331da177e4SLinus Torvalds }
3341da177e4SLinus Torvalds 
3351da177e4SLinus Torvalds /*
3361da177e4SLinus Torvalds  *	Deferred destroy.
3371da177e4SLinus Torvalds  */
33814ebaf81SDavid S. Miller static void __x25_destroy_socket(struct sock *);
3391da177e4SLinus Torvalds 
3401da177e4SLinus Torvalds /*
3411da177e4SLinus Torvalds  *	handler for deferred kills.
3421da177e4SLinus Torvalds  */
3431da177e4SLinus Torvalds static void x25_destroy_timer(unsigned long data)
3441da177e4SLinus Torvalds {
34514ebaf81SDavid S. Miller 	x25_destroy_socket_from_timer((struct sock *)data);
3461da177e4SLinus Torvalds }
3471da177e4SLinus Torvalds 
3481da177e4SLinus Torvalds /*
3491da177e4SLinus Torvalds  *	This is called from user mode and the timers. Thus it protects itself
3501da177e4SLinus Torvalds  *	against interrupt users but doesn't worry about being called during
3511da177e4SLinus Torvalds  *	work. Once it is removed from the queue no interrupt or bottom half
3521da177e4SLinus Torvalds  *	will touch it and we are (fairly 8-) ) safe.
3531da177e4SLinus Torvalds  *	Not static as it's used by the timer
3541da177e4SLinus Torvalds  */
35514ebaf81SDavid S. Miller static void __x25_destroy_socket(struct sock *sk)
3561da177e4SLinus Torvalds {
3571da177e4SLinus Torvalds 	struct sk_buff *skb;
3581da177e4SLinus Torvalds 
3591da177e4SLinus Torvalds 	x25_stop_heartbeat(sk);
3601da177e4SLinus Torvalds 	x25_stop_timer(sk);
3611da177e4SLinus Torvalds 
3621da177e4SLinus Torvalds 	x25_remove_socket(sk);
3631da177e4SLinus Torvalds 	x25_clear_queues(sk);		/* Flush the queues */
3641da177e4SLinus Torvalds 
3651da177e4SLinus Torvalds 	while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) {
3661da177e4SLinus Torvalds 		if (skb->sk != sk) {		/* A pending connection */
3671da177e4SLinus Torvalds 			/*
3681da177e4SLinus Torvalds 			 * Queue the unaccepted socket for death
3691da177e4SLinus Torvalds 			 */
3701da177e4SLinus Torvalds 			sock_set_flag(skb->sk, SOCK_DEAD);
3711da177e4SLinus Torvalds 			x25_start_heartbeat(skb->sk);
3721da177e4SLinus Torvalds 			x25_sk(skb->sk)->state = X25_STATE_0;
3731da177e4SLinus Torvalds 		}
3741da177e4SLinus Torvalds 
3751da177e4SLinus Torvalds 		kfree_skb(skb);
3761da177e4SLinus Torvalds 	}
3771da177e4SLinus Torvalds 
378c564039fSEric Dumazet 	if (sk_has_allocations(sk)) {
3791da177e4SLinus Torvalds 		/* Defer: outstanding buffers */
3801da177e4SLinus Torvalds 		sk->sk_timer.expires  = jiffies + 10 * HZ;
3811da177e4SLinus Torvalds 		sk->sk_timer.function = x25_destroy_timer;
3821da177e4SLinus Torvalds 		sk->sk_timer.data = (unsigned long)sk;
3831da177e4SLinus Torvalds 		add_timer(&sk->sk_timer);
3841da177e4SLinus Torvalds 	} else {
3851da177e4SLinus Torvalds 		/* drop last reference so sock_put will free */
3861da177e4SLinus Torvalds 		__sock_put(sk);
3871da177e4SLinus Torvalds 	}
38814ebaf81SDavid S. Miller }
3891da177e4SLinus Torvalds 
39014ebaf81SDavid S. Miller void x25_destroy_socket_from_timer(struct sock *sk)
39114ebaf81SDavid S. Miller {
39214ebaf81SDavid S. Miller 	sock_hold(sk);
39314ebaf81SDavid S. Miller 	bh_lock_sock(sk);
39414ebaf81SDavid S. Miller 	__x25_destroy_socket(sk);
39514ebaf81SDavid S. Miller 	bh_unlock_sock(sk);
39614ebaf81SDavid S. Miller 	sock_put(sk);
39714ebaf81SDavid S. Miller }
39814ebaf81SDavid S. Miller 
39914ebaf81SDavid S. Miller static void x25_destroy_socket(struct sock *sk)
40014ebaf81SDavid S. Miller {
40114ebaf81SDavid S. Miller 	sock_hold(sk);
40214ebaf81SDavid S. Miller 	lock_sock(sk);
40314ebaf81SDavid S. Miller 	__x25_destroy_socket(sk);
4041da177e4SLinus Torvalds 	release_sock(sk);
4051da177e4SLinus Torvalds 	sock_put(sk);
4061da177e4SLinus Torvalds }
4071da177e4SLinus Torvalds 
4081da177e4SLinus Torvalds /*
4091da177e4SLinus Torvalds  *	Handling for system calls applied via the various interfaces to a
4101da177e4SLinus Torvalds  *	X.25 socket object.
4111da177e4SLinus Torvalds  */
4121da177e4SLinus Torvalds 
4131da177e4SLinus Torvalds static int x25_setsockopt(struct socket *sock, int level, int optname,
414b7058842SDavid S. Miller 			  char __user *optval, unsigned int optlen)
4151da177e4SLinus Torvalds {
4161da177e4SLinus Torvalds 	int opt;
4171da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
4181da177e4SLinus Torvalds 	int rc = -ENOPROTOOPT;
4191da177e4SLinus Torvalds 
42091774904SArnd Bergmann 	lock_kernel();
4211da177e4SLinus Torvalds 	if (level != SOL_X25 || optname != X25_QBITINCL)
4221da177e4SLinus Torvalds 		goto out;
4231da177e4SLinus Torvalds 
4241da177e4SLinus Torvalds 	rc = -EINVAL;
4251da177e4SLinus Torvalds 	if (optlen < sizeof(int))
4261da177e4SLinus Torvalds 		goto out;
4271da177e4SLinus Torvalds 
4281da177e4SLinus Torvalds 	rc = -EFAULT;
4291da177e4SLinus Torvalds 	if (get_user(opt, (int __user *)optval))
4301da177e4SLinus Torvalds 		goto out;
4311da177e4SLinus Torvalds 
4321da177e4SLinus Torvalds 	x25_sk(sk)->qbitincl = !!opt;
4331da177e4SLinus Torvalds 	rc = 0;
4341da177e4SLinus Torvalds out:
43591774904SArnd Bergmann 	unlock_kernel();
4361da177e4SLinus Torvalds 	return rc;
4371da177e4SLinus Torvalds }
4381da177e4SLinus Torvalds 
4391da177e4SLinus Torvalds static int x25_getsockopt(struct socket *sock, int level, int optname,
4401da177e4SLinus Torvalds 			  char __user *optval, int __user *optlen)
4411da177e4SLinus Torvalds {
4421da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
4431da177e4SLinus Torvalds 	int val, len, rc = -ENOPROTOOPT;
4441da177e4SLinus Torvalds 
44591774904SArnd Bergmann 	lock_kernel();
4461da177e4SLinus Torvalds 	if (level != SOL_X25 || optname != X25_QBITINCL)
4471da177e4SLinus Torvalds 		goto out;
4481da177e4SLinus Torvalds 
4491da177e4SLinus Torvalds 	rc = -EFAULT;
4501da177e4SLinus Torvalds 	if (get_user(len, optlen))
4511da177e4SLinus Torvalds 		goto out;
4521da177e4SLinus Torvalds 
4531da177e4SLinus Torvalds 	len = min_t(unsigned int, len, sizeof(int));
4541da177e4SLinus Torvalds 
4551da177e4SLinus Torvalds 	rc = -EINVAL;
4561da177e4SLinus Torvalds 	if (len < 0)
4571da177e4SLinus Torvalds 		goto out;
4581da177e4SLinus Torvalds 
4591da177e4SLinus Torvalds 	rc = -EFAULT;
4601da177e4SLinus Torvalds 	if (put_user(len, optlen))
4611da177e4SLinus Torvalds 		goto out;
4621da177e4SLinus Torvalds 
4631da177e4SLinus Torvalds 	val = x25_sk(sk)->qbitincl;
4641da177e4SLinus Torvalds 	rc = copy_to_user(optval, &val, len) ? -EFAULT : 0;
4651da177e4SLinus Torvalds out:
46691774904SArnd Bergmann 	unlock_kernel();
4671da177e4SLinus Torvalds 	return rc;
4681da177e4SLinus Torvalds }
4691da177e4SLinus Torvalds 
4701da177e4SLinus Torvalds static int x25_listen(struct socket *sock, int backlog)
4711da177e4SLinus Torvalds {
4721da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
4731da177e4SLinus Torvalds 	int rc = -EOPNOTSUPP;
4741da177e4SLinus Torvalds 
47591774904SArnd Bergmann 	lock_kernel();
4761da177e4SLinus Torvalds 	if (sk->sk_state != TCP_LISTEN) {
4771da177e4SLinus Torvalds 		memset(&x25_sk(sk)->dest_addr, 0, X25_ADDR_LEN);
4781da177e4SLinus Torvalds 		sk->sk_max_ack_backlog = backlog;
4791da177e4SLinus Torvalds 		sk->sk_state           = TCP_LISTEN;
4801da177e4SLinus Torvalds 		rc = 0;
4811da177e4SLinus Torvalds 	}
48291774904SArnd Bergmann 	unlock_kernel();
4831da177e4SLinus Torvalds 
4841da177e4SLinus Torvalds 	return rc;
4851da177e4SLinus Torvalds }
4861da177e4SLinus Torvalds 
4871da177e4SLinus Torvalds static struct proto x25_proto = {
4881da177e4SLinus Torvalds 	.name	  = "X25",
4891da177e4SLinus Torvalds 	.owner	  = THIS_MODULE,
4901da177e4SLinus Torvalds 	.obj_size = sizeof(struct x25_sock),
4911da177e4SLinus Torvalds };
4921da177e4SLinus Torvalds 
4931b8d7ae4SEric W. Biederman static struct sock *x25_alloc_socket(struct net *net)
4941da177e4SLinus Torvalds {
4951da177e4SLinus Torvalds 	struct x25_sock *x25;
4966257ff21SPavel Emelyanov 	struct sock *sk = sk_alloc(net, AF_X25, GFP_ATOMIC, &x25_proto);
4971da177e4SLinus Torvalds 
4981da177e4SLinus Torvalds 	if (!sk)
4991da177e4SLinus Torvalds 		goto out;
5001da177e4SLinus Torvalds 
5011da177e4SLinus Torvalds 	sock_init_data(NULL, sk);
5021da177e4SLinus Torvalds 
5031da177e4SLinus Torvalds 	x25 = x25_sk(sk);
5041da177e4SLinus Torvalds 	skb_queue_head_init(&x25->ack_queue);
5051da177e4SLinus Torvalds 	skb_queue_head_init(&x25->fragment_queue);
5061da177e4SLinus Torvalds 	skb_queue_head_init(&x25->interrupt_in_queue);
5071da177e4SLinus Torvalds 	skb_queue_head_init(&x25->interrupt_out_queue);
5081da177e4SLinus Torvalds out:
5091da177e4SLinus Torvalds 	return sk;
5101da177e4SLinus Torvalds }
5111da177e4SLinus Torvalds 
5123f378b68SEric Paris static int x25_create(struct net *net, struct socket *sock, int protocol,
5133f378b68SEric Paris 		      int kern)
5141da177e4SLinus Torvalds {
5151da177e4SLinus Torvalds 	struct sock *sk;
5161da177e4SLinus Torvalds 	struct x25_sock *x25;
517b18e7a06Sandrew hendry 	int rc = -EAFNOSUPPORT;
5181da177e4SLinus Torvalds 
51909ad9bc7SOctavian Purdila 	if (!net_eq(net, &init_net))
5201da177e4SLinus Torvalds 		goto out;
5211da177e4SLinus Torvalds 
522b18e7a06Sandrew hendry 	rc = -ESOCKTNOSUPPORT;
523b18e7a06Sandrew hendry 	if (sock->type != SOCK_SEQPACKET)
524b18e7a06Sandrew hendry 		goto out;
525b18e7a06Sandrew hendry 
526b18e7a06Sandrew hendry 	rc = -EINVAL;
527b18e7a06Sandrew hendry 	if (protocol)
528b18e7a06Sandrew hendry 		goto out;
529b18e7a06Sandrew hendry 
530b18e7a06Sandrew hendry 	rc = -ENOBUFS;
5311b8d7ae4SEric W. Biederman 	if ((sk = x25_alloc_socket(net)) == NULL)
5321da177e4SLinus Torvalds 		goto out;
5331da177e4SLinus Torvalds 
5341da177e4SLinus Torvalds 	x25 = x25_sk(sk);
5351da177e4SLinus Torvalds 
5361da177e4SLinus Torvalds 	sock_init_data(sock, sk);
5371da177e4SLinus Torvalds 
5381da177e4SLinus Torvalds 	x25_init_timers(sk);
5391da177e4SLinus Torvalds 
5401da177e4SLinus Torvalds 	sock->ops    = &x25_proto_ops;
5411da177e4SLinus Torvalds 	sk->sk_protocol = protocol;
5421da177e4SLinus Torvalds 	sk->sk_backlog_rcv = x25_backlog_rcv;
5431da177e4SLinus Torvalds 
5441da177e4SLinus Torvalds 	x25->t21   = sysctl_x25_call_request_timeout;
5451da177e4SLinus Torvalds 	x25->t22   = sysctl_x25_reset_request_timeout;
5461da177e4SLinus Torvalds 	x25->t23   = sysctl_x25_clear_request_timeout;
5471da177e4SLinus Torvalds 	x25->t2    = sysctl_x25_ack_holdback_timeout;
5481da177e4SLinus Torvalds 	x25->state = X25_STATE_0;
549cb65d506SShaun Pereira 	x25->cudmatchlength = 0;
550ebc3f64bSShaun Pereira 	x25->accptapprv = X25_DENY_ACCPT_APPRV;		/* normally no cud  */
551ebc3f64bSShaun Pereira 							/* on call accept   */
5521da177e4SLinus Torvalds 
5531da177e4SLinus Torvalds 	x25->facilities.winsize_in  = X25_DEFAULT_WINDOW_SIZE;
5541da177e4SLinus Torvalds 	x25->facilities.winsize_out = X25_DEFAULT_WINDOW_SIZE;
5551da177e4SLinus Torvalds 	x25->facilities.pacsize_in  = X25_DEFAULT_PACKET_SIZE;
5561da177e4SLinus Torvalds 	x25->facilities.pacsize_out = X25_DEFAULT_PACKET_SIZE;
5571da177e4SLinus Torvalds 	x25->facilities.throughput  = X25_DEFAULT_THROUGHPUT;
5581da177e4SLinus Torvalds 	x25->facilities.reverse     = X25_DEFAULT_REVERSE;
559a64b7b93SShaun Pereira 	x25->dte_facilities.calling_len = 0;
560a64b7b93SShaun Pereira 	x25->dte_facilities.called_len = 0;
561a64b7b93SShaun Pereira 	memset(x25->dte_facilities.called_ae, '\0',
562a64b7b93SShaun Pereira 			sizeof(x25->dte_facilities.called_ae));
563a64b7b93SShaun Pereira 	memset(x25->dte_facilities.calling_ae, '\0',
564a64b7b93SShaun Pereira 			sizeof(x25->dte_facilities.calling_ae));
565a64b7b93SShaun Pereira 
5661da177e4SLinus Torvalds 	rc = 0;
5671da177e4SLinus Torvalds out:
5681da177e4SLinus Torvalds 	return rc;
5691da177e4SLinus Torvalds }
5701da177e4SLinus Torvalds 
5711da177e4SLinus Torvalds static struct sock *x25_make_new(struct sock *osk)
5721da177e4SLinus Torvalds {
5731da177e4SLinus Torvalds 	struct sock *sk = NULL;
5741da177e4SLinus Torvalds 	struct x25_sock *x25, *ox25;
5751da177e4SLinus Torvalds 
5761da177e4SLinus Torvalds 	if (osk->sk_type != SOCK_SEQPACKET)
5771da177e4SLinus Torvalds 		goto out;
5781da177e4SLinus Torvalds 
5793b1e0a65SYOSHIFUJI Hideaki 	if ((sk = x25_alloc_socket(sock_net(osk))) == NULL)
5801da177e4SLinus Torvalds 		goto out;
5811da177e4SLinus Torvalds 
5821da177e4SLinus Torvalds 	x25 = x25_sk(sk);
5831da177e4SLinus Torvalds 
5841da177e4SLinus Torvalds 	sk->sk_type        = osk->sk_type;
5851da177e4SLinus Torvalds 	sk->sk_priority    = osk->sk_priority;
5861da177e4SLinus Torvalds 	sk->sk_protocol    = osk->sk_protocol;
5871da177e4SLinus Torvalds 	sk->sk_rcvbuf      = osk->sk_rcvbuf;
5881da177e4SLinus Torvalds 	sk->sk_sndbuf      = osk->sk_sndbuf;
5891da177e4SLinus Torvalds 	sk->sk_state       = TCP_ESTABLISHED;
5901da177e4SLinus Torvalds 	sk->sk_backlog_rcv = osk->sk_backlog_rcv;
591a20a8554SShaun Pereira 	sock_copy_flags(sk, osk);
5921da177e4SLinus Torvalds 
5931da177e4SLinus Torvalds 	ox25 = x25_sk(osk);
5941da177e4SLinus Torvalds 	x25->t21        = ox25->t21;
5951da177e4SLinus Torvalds 	x25->t22        = ox25->t22;
5961da177e4SLinus Torvalds 	x25->t23        = ox25->t23;
5971da177e4SLinus Torvalds 	x25->t2         = ox25->t2;
5981da177e4SLinus Torvalds 	x25->facilities = ox25->facilities;
5991da177e4SLinus Torvalds 	x25->qbitincl   = ox25->qbitincl;
600a64b7b93SShaun Pereira 	x25->dte_facilities = ox25->dte_facilities;
601cb65d506SShaun Pereira 	x25->cudmatchlength = ox25->cudmatchlength;
602ebc3f64bSShaun Pereira 	x25->accptapprv = ox25->accptapprv;
6031da177e4SLinus Torvalds 
6041da177e4SLinus Torvalds 	x25_init_timers(sk);
6051da177e4SLinus Torvalds out:
6061da177e4SLinus Torvalds 	return sk;
6071da177e4SLinus Torvalds }
6081da177e4SLinus Torvalds 
6091da177e4SLinus Torvalds static int x25_release(struct socket *sock)
6101da177e4SLinus Torvalds {
6111da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
6121da177e4SLinus Torvalds 	struct x25_sock *x25;
6131da177e4SLinus Torvalds 
61491774904SArnd Bergmann 	lock_kernel();
6151da177e4SLinus Torvalds 	if (!sk)
6161da177e4SLinus Torvalds 		goto out;
6171da177e4SLinus Torvalds 
6181da177e4SLinus Torvalds 	x25 = x25_sk(sk);
6191da177e4SLinus Torvalds 
6201da177e4SLinus Torvalds 	switch (x25->state) {
6211da177e4SLinus Torvalds 
6221da177e4SLinus Torvalds 		case X25_STATE_0:
6231da177e4SLinus Torvalds 		case X25_STATE_2:
6241da177e4SLinus Torvalds 			x25_disconnect(sk, 0, 0, 0);
6251da177e4SLinus Torvalds 			x25_destroy_socket(sk);
6261da177e4SLinus Torvalds 			goto out;
6271da177e4SLinus Torvalds 
6281da177e4SLinus Torvalds 		case X25_STATE_1:
6291da177e4SLinus Torvalds 		case X25_STATE_3:
6301da177e4SLinus Torvalds 		case X25_STATE_4:
6311da177e4SLinus Torvalds 			x25_clear_queues(sk);
6321da177e4SLinus Torvalds 			x25_write_internal(sk, X25_CLEAR_REQUEST);
6331da177e4SLinus Torvalds 			x25_start_t23timer(sk);
6341da177e4SLinus Torvalds 			x25->state = X25_STATE_2;
6351da177e4SLinus Torvalds 			sk->sk_state	= TCP_CLOSE;
6361da177e4SLinus Torvalds 			sk->sk_shutdown	|= SEND_SHUTDOWN;
6371da177e4SLinus Torvalds 			sk->sk_state_change(sk);
6381da177e4SLinus Torvalds 			sock_set_flag(sk, SOCK_DEAD);
6391da177e4SLinus Torvalds 			sock_set_flag(sk, SOCK_DESTROY);
6401da177e4SLinus Torvalds 			break;
6411da177e4SLinus Torvalds 	}
6421da177e4SLinus Torvalds 
643c751e4f8SDavid S. Miller 	sock_orphan(sk);
6441da177e4SLinus Torvalds out:
64591774904SArnd Bergmann 	unlock_kernel();
6461da177e4SLinus Torvalds 	return 0;
6471da177e4SLinus Torvalds }
6481da177e4SLinus Torvalds 
6491da177e4SLinus Torvalds static int x25_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len)
6501da177e4SLinus Torvalds {
6511da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
6521da177e4SLinus Torvalds 	struct sockaddr_x25 *addr = (struct sockaddr_x25 *)uaddr;
653a9288525Sandrew hendry 	int len, i, rc = 0;
6541da177e4SLinus Torvalds 
65591774904SArnd Bergmann 	lock_kernel();
6561da177e4SLinus Torvalds 	if (!sock_flag(sk, SOCK_ZAPPED) ||
6571da177e4SLinus Torvalds 	    addr_len != sizeof(struct sockaddr_x25) ||
65891774904SArnd Bergmann 	    addr->sx25_family != AF_X25) {
65991774904SArnd Bergmann 		rc = -EINVAL;
66091774904SArnd Bergmann 		goto out;
66191774904SArnd Bergmann 	}
6621da177e4SLinus Torvalds 
663a9288525Sandrew hendry 	len = strlen(addr->sx25_addr.x25_addr);
664a9288525Sandrew hendry 	for (i = 0; i < len; i++) {
665a9288525Sandrew hendry 		if (!isdigit(addr->sx25_addr.x25_addr[i])) {
666a9288525Sandrew hendry 			rc = -EINVAL;
667a9288525Sandrew hendry 			goto out;
668a9288525Sandrew hendry 		}
669a9288525Sandrew hendry 	}
670a9288525Sandrew hendry 
6711da177e4SLinus Torvalds 	x25_sk(sk)->source_addr = addr->sx25_addr;
6721da177e4SLinus Torvalds 	x25_insert_socket(sk);
6731da177e4SLinus Torvalds 	sock_reset_flag(sk, SOCK_ZAPPED);
6741da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_bind: socket is bound\n");
67591774904SArnd Bergmann out:
67691774904SArnd Bergmann 	unlock_kernel();
67791774904SArnd Bergmann 	return rc;
6781da177e4SLinus Torvalds }
6791da177e4SLinus Torvalds 
6801da177e4SLinus Torvalds static int x25_wait_for_connection_establishment(struct sock *sk)
6811da177e4SLinus Torvalds {
6821da177e4SLinus Torvalds 	DECLARE_WAITQUEUE(wait, current);
6831da177e4SLinus Torvalds 	int rc;
6841da177e4SLinus Torvalds 
6851da177e4SLinus Torvalds 	add_wait_queue_exclusive(sk->sk_sleep, &wait);
6861da177e4SLinus Torvalds 	for (;;) {
6871da177e4SLinus Torvalds 		__set_current_state(TASK_INTERRUPTIBLE);
6881da177e4SLinus Torvalds 		rc = -ERESTARTSYS;
6891da177e4SLinus Torvalds 		if (signal_pending(current))
6901da177e4SLinus Torvalds 			break;
6911da177e4SLinus Torvalds 		rc = sock_error(sk);
6921da177e4SLinus Torvalds 		if (rc) {
6931da177e4SLinus Torvalds 			sk->sk_socket->state = SS_UNCONNECTED;
6941da177e4SLinus Torvalds 			break;
6951da177e4SLinus Torvalds 		}
6961da177e4SLinus Torvalds 		rc = 0;
6971da177e4SLinus Torvalds 		if (sk->sk_state != TCP_ESTABLISHED) {
6981da177e4SLinus Torvalds 			release_sock(sk);
6991da177e4SLinus Torvalds 			schedule();
7001da177e4SLinus Torvalds 			lock_sock(sk);
7011da177e4SLinus Torvalds 		} else
7021da177e4SLinus Torvalds 			break;
7031da177e4SLinus Torvalds 	}
7041da177e4SLinus Torvalds 	__set_current_state(TASK_RUNNING);
7051da177e4SLinus Torvalds 	remove_wait_queue(sk->sk_sleep, &wait);
7061da177e4SLinus Torvalds 	return rc;
7071da177e4SLinus Torvalds }
7081da177e4SLinus Torvalds 
7091da177e4SLinus Torvalds static int x25_connect(struct socket *sock, struct sockaddr *uaddr,
7101da177e4SLinus Torvalds 		       int addr_len, int flags)
7111da177e4SLinus Torvalds {
7121da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
7131da177e4SLinus Torvalds 	struct x25_sock *x25 = x25_sk(sk);
7141da177e4SLinus Torvalds 	struct sockaddr_x25 *addr = (struct sockaddr_x25 *)uaddr;
7151da177e4SLinus Torvalds 	struct x25_route *rt;
7161da177e4SLinus Torvalds 	int rc = 0;
7171da177e4SLinus Torvalds 
71891774904SArnd Bergmann 	lock_kernel();
7191da177e4SLinus Torvalds 	lock_sock(sk);
7201da177e4SLinus Torvalds 	if (sk->sk_state == TCP_ESTABLISHED && sock->state == SS_CONNECTING) {
7211da177e4SLinus Torvalds 		sock->state = SS_CONNECTED;
7221da177e4SLinus Torvalds 		goto out; /* Connect completed during a ERESTARTSYS event */
7231da177e4SLinus Torvalds 	}
7241da177e4SLinus Torvalds 
7251da177e4SLinus Torvalds 	rc = -ECONNREFUSED;
7261da177e4SLinus Torvalds 	if (sk->sk_state == TCP_CLOSE && sock->state == SS_CONNECTING) {
7271da177e4SLinus Torvalds 		sock->state = SS_UNCONNECTED;
7281da177e4SLinus Torvalds 		goto out;
7291da177e4SLinus Torvalds 	}
7301da177e4SLinus Torvalds 
7311da177e4SLinus Torvalds 	rc = -EISCONN;	/* No reconnect on a seqpacket socket */
7321da177e4SLinus Torvalds 	if (sk->sk_state == TCP_ESTABLISHED)
7331da177e4SLinus Torvalds 		goto out;
7341da177e4SLinus Torvalds 
7351da177e4SLinus Torvalds 	sk->sk_state   = TCP_CLOSE;
7361da177e4SLinus Torvalds 	sock->state = SS_UNCONNECTED;
7371da177e4SLinus Torvalds 
7381da177e4SLinus Torvalds 	rc = -EINVAL;
7391da177e4SLinus Torvalds 	if (addr_len != sizeof(struct sockaddr_x25) ||
7401da177e4SLinus Torvalds 	    addr->sx25_family != AF_X25)
7411da177e4SLinus Torvalds 		goto out;
7421da177e4SLinus Torvalds 
7431da177e4SLinus Torvalds 	rc = -ENETUNREACH;
7441da177e4SLinus Torvalds 	rt = x25_get_route(&addr->sx25_addr);
7451da177e4SLinus Torvalds 	if (!rt)
7461da177e4SLinus Torvalds 		goto out;
7471da177e4SLinus Torvalds 
7481da177e4SLinus Torvalds 	x25->neighbour = x25_get_neigh(rt->dev);
7491da177e4SLinus Torvalds 	if (!x25->neighbour)
7501da177e4SLinus Torvalds 		goto out_put_route;
7511da177e4SLinus Torvalds 
7521da177e4SLinus Torvalds 	x25_limit_facilities(&x25->facilities, x25->neighbour);
7531da177e4SLinus Torvalds 
7541da177e4SLinus Torvalds 	x25->lci = x25_new_lci(x25->neighbour);
7551da177e4SLinus Torvalds 	if (!x25->lci)
7561da177e4SLinus Torvalds 		goto out_put_neigh;
7571da177e4SLinus Torvalds 
7581da177e4SLinus Torvalds 	rc = -EINVAL;
7591da177e4SLinus Torvalds 	if (sock_flag(sk, SOCK_ZAPPED)) /* Must bind first - autobinding does not work */
7601da177e4SLinus Torvalds 		goto out_put_neigh;
7611da177e4SLinus Torvalds 
7621da177e4SLinus Torvalds 	if (!strcmp(x25->source_addr.x25_addr, null_x25_address.x25_addr))
7631da177e4SLinus Torvalds 		memset(&x25->source_addr, '\0', X25_ADDR_LEN);
7641da177e4SLinus Torvalds 
7651da177e4SLinus Torvalds 	x25->dest_addr = addr->sx25_addr;
7661da177e4SLinus Torvalds 
7671da177e4SLinus Torvalds 	/* Move to connecting socket, start sending Connect Requests */
7681da177e4SLinus Torvalds 	sock->state   = SS_CONNECTING;
7691da177e4SLinus Torvalds 	sk->sk_state  = TCP_SYN_SENT;
7701da177e4SLinus Torvalds 
7711da177e4SLinus Torvalds 	x25->state = X25_STATE_1;
7721da177e4SLinus Torvalds 
7731da177e4SLinus Torvalds 	x25_write_internal(sk, X25_CALL_REQUEST);
7741da177e4SLinus Torvalds 
7751da177e4SLinus Torvalds 	x25_start_heartbeat(sk);
7761da177e4SLinus Torvalds 	x25_start_t21timer(sk);
7771da177e4SLinus Torvalds 
7781da177e4SLinus Torvalds 	/* Now the loop */
7791da177e4SLinus Torvalds 	rc = -EINPROGRESS;
7801da177e4SLinus Torvalds 	if (sk->sk_state != TCP_ESTABLISHED && (flags & O_NONBLOCK))
7811da177e4SLinus Torvalds 		goto out_put_neigh;
7821da177e4SLinus Torvalds 
7831da177e4SLinus Torvalds 	rc = x25_wait_for_connection_establishment(sk);
7841da177e4SLinus Torvalds 	if (rc)
7851da177e4SLinus Torvalds 		goto out_put_neigh;
7861da177e4SLinus Torvalds 
7871da177e4SLinus Torvalds 	sock->state = SS_CONNECTED;
7881da177e4SLinus Torvalds 	rc = 0;
7891da177e4SLinus Torvalds out_put_neigh:
7901da177e4SLinus Torvalds 	if (rc)
7911da177e4SLinus Torvalds 		x25_neigh_put(x25->neighbour);
7921da177e4SLinus Torvalds out_put_route:
7931da177e4SLinus Torvalds 	x25_route_put(rt);
7941da177e4SLinus Torvalds out:
7951da177e4SLinus Torvalds 	release_sock(sk);
79691774904SArnd Bergmann 	unlock_kernel();
7971da177e4SLinus Torvalds 	return rc;
7981da177e4SLinus Torvalds }
7991da177e4SLinus Torvalds 
800bac37ec8SShaun Pereira static int x25_wait_for_data(struct sock *sk, long timeout)
8011da177e4SLinus Torvalds {
8021da177e4SLinus Torvalds 	DECLARE_WAITQUEUE(wait, current);
8031da177e4SLinus Torvalds 	int rc = 0;
8041da177e4SLinus Torvalds 
8051da177e4SLinus Torvalds 	add_wait_queue_exclusive(sk->sk_sleep, &wait);
8061da177e4SLinus Torvalds 	for (;;) {
8071da177e4SLinus Torvalds 		__set_current_state(TASK_INTERRUPTIBLE);
8081da177e4SLinus Torvalds 		if (sk->sk_shutdown & RCV_SHUTDOWN)
8091da177e4SLinus Torvalds 			break;
8101da177e4SLinus Torvalds 		rc = -ERESTARTSYS;
8111da177e4SLinus Torvalds 		if (signal_pending(current))
8121da177e4SLinus Torvalds 			break;
8131da177e4SLinus Torvalds 		rc = -EAGAIN;
8141da177e4SLinus Torvalds 		if (!timeout)
8151da177e4SLinus Torvalds 			break;
8161da177e4SLinus Torvalds 		rc = 0;
8171da177e4SLinus Torvalds 		if (skb_queue_empty(&sk->sk_receive_queue)) {
8181da177e4SLinus Torvalds 			release_sock(sk);
8191da177e4SLinus Torvalds 			timeout = schedule_timeout(timeout);
8201da177e4SLinus Torvalds 			lock_sock(sk);
8211da177e4SLinus Torvalds 		} else
8221da177e4SLinus Torvalds 			break;
8231da177e4SLinus Torvalds 	}
8241da177e4SLinus Torvalds 	__set_current_state(TASK_RUNNING);
8251da177e4SLinus Torvalds 	remove_wait_queue(sk->sk_sleep, &wait);
8261da177e4SLinus Torvalds 	return rc;
8271da177e4SLinus Torvalds }
8281da177e4SLinus Torvalds 
8291da177e4SLinus Torvalds static int x25_accept(struct socket *sock, struct socket *newsock, int flags)
8301da177e4SLinus Torvalds {
8311da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
8321da177e4SLinus Torvalds 	struct sock *newsk;
8331da177e4SLinus Torvalds 	struct sk_buff *skb;
8341da177e4SLinus Torvalds 	int rc = -EINVAL;
8351da177e4SLinus Torvalds 
83691774904SArnd Bergmann 	lock_kernel();
8371da177e4SLinus Torvalds 	if (!sk || sk->sk_state != TCP_LISTEN)
8381da177e4SLinus Torvalds 		goto out;
8391da177e4SLinus Torvalds 
8401da177e4SLinus Torvalds 	rc = -EOPNOTSUPP;
8411da177e4SLinus Torvalds 	if (sk->sk_type != SOCK_SEQPACKET)
8421da177e4SLinus Torvalds 		goto out;
8431da177e4SLinus Torvalds 
8441da177e4SLinus Torvalds 	lock_sock(sk);
8451da177e4SLinus Torvalds 	rc = x25_wait_for_data(sk, sk->sk_rcvtimeo);
8461da177e4SLinus Torvalds 	if (rc)
8471da177e4SLinus Torvalds 		goto out2;
8481da177e4SLinus Torvalds 	skb = skb_dequeue(&sk->sk_receive_queue);
8491da177e4SLinus Torvalds 	rc = -EINVAL;
8501da177e4SLinus Torvalds 	if (!skb->sk)
8511da177e4SLinus Torvalds 		goto out2;
8521da177e4SLinus Torvalds 	newsk		 = skb->sk;
853b61d38e0SDavid S. Miller 	sock_graft(newsk, newsock);
8541da177e4SLinus Torvalds 
8551da177e4SLinus Torvalds 	/* Now attach up the new socket */
8561da177e4SLinus Torvalds 	skb->sk = NULL;
8571da177e4SLinus Torvalds 	kfree_skb(skb);
8581da177e4SLinus Torvalds 	sk->sk_ack_backlog--;
8591da177e4SLinus Torvalds 	newsock->state = SS_CONNECTED;
8601da177e4SLinus Torvalds 	rc = 0;
8611da177e4SLinus Torvalds out2:
8621da177e4SLinus Torvalds 	release_sock(sk);
8631da177e4SLinus Torvalds out:
86491774904SArnd Bergmann 	unlock_kernel();
8651da177e4SLinus Torvalds 	return rc;
8661da177e4SLinus Torvalds }
8671da177e4SLinus Torvalds 
8681da177e4SLinus Torvalds static int x25_getname(struct socket *sock, struct sockaddr *uaddr,
8691da177e4SLinus Torvalds 		       int *uaddr_len, int peer)
8701da177e4SLinus Torvalds {
8711da177e4SLinus Torvalds 	struct sockaddr_x25 *sx25 = (struct sockaddr_x25 *)uaddr;
8721da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
8731da177e4SLinus Torvalds 	struct x25_sock *x25 = x25_sk(sk);
87491774904SArnd Bergmann 	int rc = 0;
8751da177e4SLinus Torvalds 
87691774904SArnd Bergmann 	lock_kernel();
8771da177e4SLinus Torvalds 	if (peer) {
87891774904SArnd Bergmann 		if (sk->sk_state != TCP_ESTABLISHED) {
87991774904SArnd Bergmann 			rc = -ENOTCONN;
88091774904SArnd Bergmann 			goto out;
88191774904SArnd Bergmann 		}
8821da177e4SLinus Torvalds 		sx25->sx25_addr = x25->dest_addr;
8831da177e4SLinus Torvalds 	} else
8841da177e4SLinus Torvalds 		sx25->sx25_addr = x25->source_addr;
8851da177e4SLinus Torvalds 
8861da177e4SLinus Torvalds 	sx25->sx25_family = AF_X25;
8871da177e4SLinus Torvalds 	*uaddr_len = sizeof(*sx25);
8881da177e4SLinus Torvalds 
88991774904SArnd Bergmann out:
89091774904SArnd Bergmann 	unlock_kernel();
89191774904SArnd Bergmann 	return rc;
89291774904SArnd Bergmann }
89391774904SArnd Bergmann 
89491774904SArnd Bergmann static unsigned int x25_datagram_poll(struct file *file, struct socket *sock,
89591774904SArnd Bergmann 			   poll_table *wait)
89691774904SArnd Bergmann {
89791774904SArnd Bergmann 	int rc;
89891774904SArnd Bergmann 
89991774904SArnd Bergmann 	lock_kernel();
90091774904SArnd Bergmann 	rc = datagram_poll(file, sock, wait);
90191774904SArnd Bergmann 	unlock_kernel();
90291774904SArnd Bergmann 
90391774904SArnd Bergmann 	return rc;
9041da177e4SLinus Torvalds }
9051da177e4SLinus Torvalds 
9061da177e4SLinus Torvalds int x25_rx_call_request(struct sk_buff *skb, struct x25_neigh *nb,
9071da177e4SLinus Torvalds 			unsigned int lci)
9081da177e4SLinus Torvalds {
9091da177e4SLinus Torvalds 	struct sock *sk;
9101da177e4SLinus Torvalds 	struct sock *make;
9111da177e4SLinus Torvalds 	struct x25_sock *makex25;
9121da177e4SLinus Torvalds 	struct x25_address source_addr, dest_addr;
9131da177e4SLinus Torvalds 	struct x25_facilities facilities;
914a64b7b93SShaun Pereira 	struct x25_dte_facilities dte_facilities;
91595a9dc43SAndrew Hendry 	int len, addr_len, rc;
9161da177e4SLinus Torvalds 
9171da177e4SLinus Torvalds 	/*
9181da177e4SLinus Torvalds 	 *	Remove the LCI and frame type.
9191da177e4SLinus Torvalds 	 */
9201da177e4SLinus Torvalds 	skb_pull(skb, X25_STD_MIN_LEN);
9211da177e4SLinus Torvalds 
9221da177e4SLinus Torvalds 	/*
9231da177e4SLinus Torvalds 	 *	Extract the X.25 addresses and convert them to ASCII strings,
9241da177e4SLinus Torvalds 	 *	and remove them.
9251da177e4SLinus Torvalds 	 */
92695a9dc43SAndrew Hendry 	addr_len = x25_addr_ntoa(skb->data, &source_addr, &dest_addr);
92795a9dc43SAndrew Hendry 	skb_pull(skb, addr_len);
9281da177e4SLinus Torvalds 
9291da177e4SLinus Torvalds 	/*
9301da177e4SLinus Torvalds 	 *	Get the length of the facilities, skip past them for the moment
9311da177e4SLinus Torvalds 	 *	get the call user data because this is needed to determine
9321da177e4SLinus Torvalds 	 *	the correct listener
9331da177e4SLinus Torvalds 	 */
9341da177e4SLinus Torvalds 	len = skb->data[0] + 1;
9351da177e4SLinus Torvalds 	skb_pull(skb,len);
9361da177e4SLinus Torvalds 
9371da177e4SLinus Torvalds 	/*
9381da177e4SLinus Torvalds 	 *	Find a listener for the particular address/cud pair.
9391da177e4SLinus Torvalds 	 */
940cb65d506SShaun Pereira 	sk = x25_find_listener(&source_addr,skb);
941cb65d506SShaun Pereira 	skb_push(skb,len);
9421da177e4SLinus Torvalds 
94395a9dc43SAndrew Hendry 	if (sk != NULL && sk_acceptq_is_full(sk)) {
94495a9dc43SAndrew Hendry 		goto out_sock_put;
94595a9dc43SAndrew Hendry 	}
94695a9dc43SAndrew Hendry 
9471da177e4SLinus Torvalds 	/*
94895a9dc43SAndrew Hendry 	 *	We dont have any listeners for this incoming call.
94995a9dc43SAndrew Hendry 	 *	Try forwarding it.
9501da177e4SLinus Torvalds 	 */
95195a9dc43SAndrew Hendry 	if (sk == NULL) {
95295a9dc43SAndrew Hendry 		skb_push(skb, addr_len + X25_STD_MIN_LEN);
95339e21c0dSAndrew Hendry 		if (sysctl_x25_forward &&
95439e21c0dSAndrew Hendry 				x25_forward_call(&dest_addr, nb, skb, lci) > 0)
95595a9dc43SAndrew Hendry 		{
95695a9dc43SAndrew Hendry 			/* Call was forwarded, dont process it any more */
95795a9dc43SAndrew Hendry 			kfree_skb(skb);
95895a9dc43SAndrew Hendry 			rc = 1;
95995a9dc43SAndrew Hendry 			goto out;
96095a9dc43SAndrew Hendry 		} else {
96195a9dc43SAndrew Hendry 			/* No listeners, can't forward, clear the call */
9621da177e4SLinus Torvalds 			goto out_clear_request;
96395a9dc43SAndrew Hendry 		}
96495a9dc43SAndrew Hendry 	}
9651da177e4SLinus Torvalds 
9661da177e4SLinus Torvalds 	/*
9671da177e4SLinus Torvalds 	 *	Try to reach a compromise on the requested facilities.
9681da177e4SLinus Torvalds 	 */
969a64b7b93SShaun Pereira 	len = x25_negotiate_facilities(skb, sk, &facilities, &dte_facilities);
970a64b7b93SShaun Pereira 	if (len == -1)
9711da177e4SLinus Torvalds 		goto out_sock_put;
9721da177e4SLinus Torvalds 
9731da177e4SLinus Torvalds 	/*
9741da177e4SLinus Torvalds 	 * current neighbour/link might impose additional limits
9751da177e4SLinus Torvalds 	 * on certain facilties
9761da177e4SLinus Torvalds 	 */
9771da177e4SLinus Torvalds 
9781da177e4SLinus Torvalds 	x25_limit_facilities(&facilities, nb);
9791da177e4SLinus Torvalds 
9801da177e4SLinus Torvalds 	/*
9811da177e4SLinus Torvalds 	 *	Try to create a new socket.
9821da177e4SLinus Torvalds 	 */
9831da177e4SLinus Torvalds 	make = x25_make_new(sk);
9841da177e4SLinus Torvalds 	if (!make)
9851da177e4SLinus Torvalds 		goto out_sock_put;
9861da177e4SLinus Torvalds 
9871da177e4SLinus Torvalds 	/*
9881da177e4SLinus Torvalds 	 *	Remove the facilities
9891da177e4SLinus Torvalds 	 */
9901da177e4SLinus Torvalds 	skb_pull(skb, len);
9911da177e4SLinus Torvalds 
9921da177e4SLinus Torvalds 	skb->sk     = make;
9931da177e4SLinus Torvalds 	make->sk_state = TCP_ESTABLISHED;
9941da177e4SLinus Torvalds 
9951da177e4SLinus Torvalds 	makex25 = x25_sk(make);
9961da177e4SLinus Torvalds 	makex25->lci           = lci;
9971da177e4SLinus Torvalds 	makex25->dest_addr     = dest_addr;
9981da177e4SLinus Torvalds 	makex25->source_addr   = source_addr;
9991da177e4SLinus Torvalds 	makex25->neighbour     = nb;
10001da177e4SLinus Torvalds 	makex25->facilities    = facilities;
1001a64b7b93SShaun Pereira 	makex25->dte_facilities= dte_facilities;
10021da177e4SLinus Torvalds 	makex25->vc_facil_mask = x25_sk(sk)->vc_facil_mask;
1003cb65d506SShaun Pereira 	/* ensure no reverse facil on accept */
1004cb65d506SShaun Pereira 	makex25->vc_facil_mask &= ~X25_MASK_REVERSE;
1005a64b7b93SShaun Pereira 	/* ensure no calling address extension on accept */
1006a64b7b93SShaun Pereira 	makex25->vc_facil_mask &= ~X25_MASK_CALLING_AE;
1007cb65d506SShaun Pereira 	makex25->cudmatchlength = x25_sk(sk)->cudmatchlength;
10081da177e4SLinus Torvalds 
1009ebc3f64bSShaun Pereira 	/* Normally all calls are accepted immediatly */
1010ebc3f64bSShaun Pereira 	if(makex25->accptapprv & X25_DENY_ACCPT_APPRV) {
10111da177e4SLinus Torvalds 		x25_write_internal(make, X25_CALL_ACCEPTED);
10121da177e4SLinus Torvalds 		makex25->state = X25_STATE_3;
1013ebc3f64bSShaun Pereira 	}
10141da177e4SLinus Torvalds 
1015cb65d506SShaun Pereira 	/*
1016cb65d506SShaun Pereira 	 *	Incoming Call User Data.
1017cb65d506SShaun Pereira 	 */
1018d626f62bSArnaldo Carvalho de Melo 	skb_copy_from_linear_data(skb, makex25->calluserdata.cuddata, skb->len);
1019cb65d506SShaun Pereira 	makex25->calluserdata.cudlength = skb->len;
1020cb65d506SShaun Pereira 
10211da177e4SLinus Torvalds 	sk->sk_ack_backlog++;
10221da177e4SLinus Torvalds 
10231da177e4SLinus Torvalds 	x25_insert_socket(make);
10241da177e4SLinus Torvalds 
10251da177e4SLinus Torvalds 	skb_queue_head(&sk->sk_receive_queue, skb);
10261da177e4SLinus Torvalds 
10271da177e4SLinus Torvalds 	x25_start_heartbeat(make);
10281da177e4SLinus Torvalds 
10291da177e4SLinus Torvalds 	if (!sock_flag(sk, SOCK_DEAD))
10301da177e4SLinus Torvalds 		sk->sk_data_ready(sk, skb->len);
10311da177e4SLinus Torvalds 	rc = 1;
10321da177e4SLinus Torvalds 	sock_put(sk);
10331da177e4SLinus Torvalds out:
10341da177e4SLinus Torvalds 	return rc;
10351da177e4SLinus Torvalds out_sock_put:
10361da177e4SLinus Torvalds 	sock_put(sk);
10371da177e4SLinus Torvalds out_clear_request:
10381da177e4SLinus Torvalds 	rc = 0;
10391da177e4SLinus Torvalds 	x25_transmit_clear_request(nb, lci, 0x01);
10401da177e4SLinus Torvalds 	goto out;
10411da177e4SLinus Torvalds }
10421da177e4SLinus Torvalds 
10431da177e4SLinus Torvalds static int x25_sendmsg(struct kiocb *iocb, struct socket *sock,
10441da177e4SLinus Torvalds 		       struct msghdr *msg, size_t len)
10451da177e4SLinus Torvalds {
10461da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
10471da177e4SLinus Torvalds 	struct x25_sock *x25 = x25_sk(sk);
10481da177e4SLinus Torvalds 	struct sockaddr_x25 *usx25 = (struct sockaddr_x25 *)msg->msg_name;
10491da177e4SLinus Torvalds 	struct sockaddr_x25 sx25;
10501da177e4SLinus Torvalds 	struct sk_buff *skb;
10511da177e4SLinus Torvalds 	unsigned char *asmptr;
10521da177e4SLinus Torvalds 	int noblock = msg->msg_flags & MSG_DONTWAIT;
10531da177e4SLinus Torvalds 	size_t size;
10541da177e4SLinus Torvalds 	int qbit = 0, rc = -EINVAL;
10551da177e4SLinus Torvalds 
105691774904SArnd Bergmann 	lock_kernel();
10571da177e4SLinus Torvalds 	if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_OOB|MSG_EOR|MSG_CMSG_COMPAT))
10581da177e4SLinus Torvalds 		goto out;
10591da177e4SLinus Torvalds 
10601da177e4SLinus Torvalds 	/* we currently don't support segmented records at the user interface */
10611da177e4SLinus Torvalds 	if (!(msg->msg_flags & (MSG_EOR|MSG_OOB)))
10621da177e4SLinus Torvalds 		goto out;
10631da177e4SLinus Torvalds 
10641da177e4SLinus Torvalds 	rc = -EADDRNOTAVAIL;
10651da177e4SLinus Torvalds 	if (sock_flag(sk, SOCK_ZAPPED))
10661da177e4SLinus Torvalds 		goto out;
10671da177e4SLinus Torvalds 
10681da177e4SLinus Torvalds 	rc = -EPIPE;
10691da177e4SLinus Torvalds 	if (sk->sk_shutdown & SEND_SHUTDOWN) {
10701da177e4SLinus Torvalds 		send_sig(SIGPIPE, current, 0);
10711da177e4SLinus Torvalds 		goto out;
10721da177e4SLinus Torvalds 	}
10731da177e4SLinus Torvalds 
10741da177e4SLinus Torvalds 	rc = -ENETUNREACH;
10751da177e4SLinus Torvalds 	if (!x25->neighbour)
10761da177e4SLinus Torvalds 		goto out;
10771da177e4SLinus Torvalds 
10781da177e4SLinus Torvalds 	if (usx25) {
10791da177e4SLinus Torvalds 		rc = -EINVAL;
10801da177e4SLinus Torvalds 		if (msg->msg_namelen < sizeof(sx25))
10811da177e4SLinus Torvalds 			goto out;
10821da177e4SLinus Torvalds 		memcpy(&sx25, usx25, sizeof(sx25));
10831da177e4SLinus Torvalds 		rc = -EISCONN;
10841da177e4SLinus Torvalds 		if (strcmp(x25->dest_addr.x25_addr, sx25.sx25_addr.x25_addr))
10851da177e4SLinus Torvalds 			goto out;
10861da177e4SLinus Torvalds 		rc = -EINVAL;
10871da177e4SLinus Torvalds 		if (sx25.sx25_family != AF_X25)
10881da177e4SLinus Torvalds 			goto out;
10891da177e4SLinus Torvalds 	} else {
10901da177e4SLinus Torvalds 		/*
10911da177e4SLinus Torvalds 		 *	FIXME 1003.1g - if the socket is like this because
10921da177e4SLinus Torvalds 		 *	it has become closed (not started closed) we ought
10931da177e4SLinus Torvalds 		 *	to SIGPIPE, EPIPE;
10941da177e4SLinus Torvalds 		 */
10951da177e4SLinus Torvalds 		rc = -ENOTCONN;
10961da177e4SLinus Torvalds 		if (sk->sk_state != TCP_ESTABLISHED)
10971da177e4SLinus Torvalds 			goto out;
10981da177e4SLinus Torvalds 
10991da177e4SLinus Torvalds 		sx25.sx25_family = AF_X25;
11001da177e4SLinus Torvalds 		sx25.sx25_addr   = x25->dest_addr;
11011da177e4SLinus Torvalds 	}
11021da177e4SLinus Torvalds 
110383e0bbcbSAlan Cox 	/* Sanity check the packet size */
110483e0bbcbSAlan Cox 	if (len > 65535) {
110583e0bbcbSAlan Cox 		rc = -EMSGSIZE;
110683e0bbcbSAlan Cox 		goto out;
110783e0bbcbSAlan Cox 	}
110883e0bbcbSAlan Cox 
11091da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: sendto: Addresses built.\n");
11101da177e4SLinus Torvalds 
11111da177e4SLinus Torvalds 	/* Build a packet */
11121da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: sendto: building packet.\n");
11131da177e4SLinus Torvalds 
11141da177e4SLinus Torvalds 	if ((msg->msg_flags & MSG_OOB) && len > 32)
11151da177e4SLinus Torvalds 		len = 32;
11161da177e4SLinus Torvalds 
11171da177e4SLinus Torvalds 	size = len + X25_MAX_L2_LEN + X25_EXT_MIN_LEN;
11181da177e4SLinus Torvalds 
11191da177e4SLinus Torvalds 	skb = sock_alloc_send_skb(sk, size, noblock, &rc);
11201da177e4SLinus Torvalds 	if (!skb)
11211da177e4SLinus Torvalds 		goto out;
11221da177e4SLinus Torvalds 	X25_SKB_CB(skb)->flags = msg->msg_flags;
11231da177e4SLinus Torvalds 
11241da177e4SLinus Torvalds 	skb_reserve(skb, X25_MAX_L2_LEN + X25_EXT_MIN_LEN);
11251da177e4SLinus Torvalds 
11261da177e4SLinus Torvalds 	/*
11271da177e4SLinus Torvalds 	 *	Put the data on the end
11281da177e4SLinus Torvalds 	 */
11291da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: Copying user data\n");
11301da177e4SLinus Torvalds 
1131eeeb0374SArnaldo Carvalho de Melo 	skb_reset_transport_header(skb);
1132eeeb0374SArnaldo Carvalho de Melo 	skb_put(skb, len);
11331da177e4SLinus Torvalds 
1134eeeb0374SArnaldo Carvalho de Melo 	rc = memcpy_fromiovec(skb_transport_header(skb), msg->msg_iov, len);
11351da177e4SLinus Torvalds 	if (rc)
11361da177e4SLinus Torvalds 		goto out_kfree_skb;
11371da177e4SLinus Torvalds 
11381da177e4SLinus Torvalds 	/*
11391da177e4SLinus Torvalds 	 *	If the Q BIT Include socket option is in force, the first
11401da177e4SLinus Torvalds 	 *	byte of the user data is the logical value of the Q Bit.
11411da177e4SLinus Torvalds 	 */
11421da177e4SLinus Torvalds 	if (x25->qbitincl) {
11431da177e4SLinus Torvalds 		qbit = skb->data[0];
11441da177e4SLinus Torvalds 		skb_pull(skb, 1);
11451da177e4SLinus Torvalds 	}
11461da177e4SLinus Torvalds 
11471da177e4SLinus Torvalds 	/*
11481da177e4SLinus Torvalds 	 *	Push down the X.25 header
11491da177e4SLinus Torvalds 	 */
11501da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: Building X.25 Header.\n");
11511da177e4SLinus Torvalds 
11521da177e4SLinus Torvalds 	if (msg->msg_flags & MSG_OOB) {
11531da177e4SLinus Torvalds 		if (x25->neighbour->extended) {
11541da177e4SLinus Torvalds 			asmptr    = skb_push(skb, X25_STD_MIN_LEN);
11551da177e4SLinus Torvalds 			*asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_EXTSEQ;
11561da177e4SLinus Torvalds 			*asmptr++ = (x25->lci >> 0) & 0xFF;
11571da177e4SLinus Torvalds 			*asmptr++ = X25_INTERRUPT;
11581da177e4SLinus Torvalds 		} else {
11591da177e4SLinus Torvalds 			asmptr    = skb_push(skb, X25_STD_MIN_LEN);
11601da177e4SLinus Torvalds 			*asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_STDSEQ;
11611da177e4SLinus Torvalds 			*asmptr++ = (x25->lci >> 0) & 0xFF;
11621da177e4SLinus Torvalds 			*asmptr++ = X25_INTERRUPT;
11631da177e4SLinus Torvalds 		}
11641da177e4SLinus Torvalds 	} else {
11651da177e4SLinus Torvalds 		if (x25->neighbour->extended) {
11661da177e4SLinus Torvalds 			/* Build an Extended X.25 header */
11671da177e4SLinus Torvalds 			asmptr    = skb_push(skb, X25_EXT_MIN_LEN);
11681da177e4SLinus Torvalds 			*asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_EXTSEQ;
11691da177e4SLinus Torvalds 			*asmptr++ = (x25->lci >> 0) & 0xFF;
11701da177e4SLinus Torvalds 			*asmptr++ = X25_DATA;
11711da177e4SLinus Torvalds 			*asmptr++ = X25_DATA;
11721da177e4SLinus Torvalds 		} else {
11731da177e4SLinus Torvalds 			/* Build an Standard X.25 header */
11741da177e4SLinus Torvalds 			asmptr    = skb_push(skb, X25_STD_MIN_LEN);
11751da177e4SLinus Torvalds 			*asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_STDSEQ;
11761da177e4SLinus Torvalds 			*asmptr++ = (x25->lci >> 0) & 0xFF;
11771da177e4SLinus Torvalds 			*asmptr++ = X25_DATA;
11781da177e4SLinus Torvalds 		}
11791da177e4SLinus Torvalds 
11801da177e4SLinus Torvalds 		if (qbit)
11811da177e4SLinus Torvalds 			skb->data[0] |= X25_Q_BIT;
11821da177e4SLinus Torvalds 	}
11831da177e4SLinus Torvalds 
11841da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: Built header.\n");
11851da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: Transmitting buffer\n");
11861da177e4SLinus Torvalds 
11871da177e4SLinus Torvalds 	rc = -ENOTCONN;
11881da177e4SLinus Torvalds 	if (sk->sk_state != TCP_ESTABLISHED)
11891da177e4SLinus Torvalds 		goto out_kfree_skb;
11901da177e4SLinus Torvalds 
11911da177e4SLinus Torvalds 	if (msg->msg_flags & MSG_OOB)
11921da177e4SLinus Torvalds 		skb_queue_tail(&x25->interrupt_out_queue, skb);
11931da177e4SLinus Torvalds 	else {
11948db09f26SRoel Kluin 		rc = x25_output(sk, skb);
11958db09f26SRoel Kluin 		len = rc;
11968db09f26SRoel Kluin 		if (rc < 0)
11971da177e4SLinus Torvalds 			kfree_skb(skb);
11981da177e4SLinus Torvalds 		else if (x25->qbitincl)
11991da177e4SLinus Torvalds 			len++;
12001da177e4SLinus Torvalds 	}
12011da177e4SLinus Torvalds 
12021da177e4SLinus Torvalds 	/*
12031da177e4SLinus Torvalds 	 * lock_sock() is currently only used to serialize this x25_kick()
12041da177e4SLinus Torvalds 	 * against input-driven x25_kick() calls. It currently only blocks
12051da177e4SLinus Torvalds 	 * incoming packets for this socket and does not protect against
12061da177e4SLinus Torvalds 	 * any other socket state changes and is not called from anywhere
12071da177e4SLinus Torvalds 	 * else. As x25_kick() cannot block and as long as all socket
12081da177e4SLinus Torvalds 	 * operations are BKL-wrapped, we don't need take to care about
12091da177e4SLinus Torvalds 	 * purging the backlog queue in x25_release().
12101da177e4SLinus Torvalds 	 *
12111da177e4SLinus Torvalds 	 * Using lock_sock() to protect all socket operations entirely
12121da177e4SLinus Torvalds 	 * (and making the whole x25 stack SMP aware) unfortunately would
12131da177e4SLinus Torvalds 	 * require major changes to {send,recv}msg and skb allocation methods.
12141da177e4SLinus Torvalds 	 * -> 2.5 ;)
12151da177e4SLinus Torvalds 	 */
12161da177e4SLinus Torvalds 	lock_sock(sk);
12171da177e4SLinus Torvalds 	x25_kick(sk);
12181da177e4SLinus Torvalds 	release_sock(sk);
12191da177e4SLinus Torvalds 	rc = len;
12201da177e4SLinus Torvalds out:
122191774904SArnd Bergmann 	unlock_kernel();
12221da177e4SLinus Torvalds 	return rc;
12231da177e4SLinus Torvalds out_kfree_skb:
12241da177e4SLinus Torvalds 	kfree_skb(skb);
12251da177e4SLinus Torvalds 	goto out;
12261da177e4SLinus Torvalds }
12271da177e4SLinus Torvalds 
12281da177e4SLinus Torvalds 
12291da177e4SLinus Torvalds static int x25_recvmsg(struct kiocb *iocb, struct socket *sock,
12301da177e4SLinus Torvalds 		       struct msghdr *msg, size_t size,
12311da177e4SLinus Torvalds 		       int flags)
12321da177e4SLinus Torvalds {
12331da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
12341da177e4SLinus Torvalds 	struct x25_sock *x25 = x25_sk(sk);
12351da177e4SLinus Torvalds 	struct sockaddr_x25 *sx25 = (struct sockaddr_x25 *)msg->msg_name;
12361da177e4SLinus Torvalds 	size_t copied;
12371da177e4SLinus Torvalds 	int qbit;
12381da177e4SLinus Torvalds 	struct sk_buff *skb;
12391da177e4SLinus Torvalds 	unsigned char *asmptr;
12401da177e4SLinus Torvalds 	int rc = -ENOTCONN;
12411da177e4SLinus Torvalds 
124291774904SArnd Bergmann 	lock_kernel();
12431da177e4SLinus Torvalds 	/*
12441da177e4SLinus Torvalds 	 * This works for seqpacket too. The receiver has ordered the queue for
12451da177e4SLinus Torvalds 	 * us! We do one quick check first though
12461da177e4SLinus Torvalds 	 */
12471da177e4SLinus Torvalds 	if (sk->sk_state != TCP_ESTABLISHED)
12481da177e4SLinus Torvalds 		goto out;
12491da177e4SLinus Torvalds 
12501da177e4SLinus Torvalds 	if (flags & MSG_OOB) {
12511da177e4SLinus Torvalds 		rc = -EINVAL;
12521da177e4SLinus Torvalds 		if (sock_flag(sk, SOCK_URGINLINE) ||
12531da177e4SLinus Torvalds 		    !skb_peek(&x25->interrupt_in_queue))
12541da177e4SLinus Torvalds 			goto out;
12551da177e4SLinus Torvalds 
12561da177e4SLinus Torvalds 		skb = skb_dequeue(&x25->interrupt_in_queue);
12571da177e4SLinus Torvalds 
12581da177e4SLinus Torvalds 		skb_pull(skb, X25_STD_MIN_LEN);
12591da177e4SLinus Torvalds 
12601da177e4SLinus Torvalds 		/*
12611da177e4SLinus Torvalds 		 *	No Q bit information on Interrupt data.
12621da177e4SLinus Torvalds 		 */
12631da177e4SLinus Torvalds 		if (x25->qbitincl) {
12641da177e4SLinus Torvalds 			asmptr  = skb_push(skb, 1);
12651da177e4SLinus Torvalds 			*asmptr = 0x00;
12661da177e4SLinus Torvalds 		}
12671da177e4SLinus Torvalds 
12681da177e4SLinus Torvalds 		msg->msg_flags |= MSG_OOB;
12691da177e4SLinus Torvalds 	} else {
12701da177e4SLinus Torvalds 		/* Now we can treat all alike */
12711da177e4SLinus Torvalds 		skb = skb_recv_datagram(sk, flags & ~MSG_DONTWAIT,
12721da177e4SLinus Torvalds 					flags & MSG_DONTWAIT, &rc);
12731da177e4SLinus Torvalds 		if (!skb)
12741da177e4SLinus Torvalds 			goto out;
12751da177e4SLinus Torvalds 
12761da177e4SLinus Torvalds 		qbit = (skb->data[0] & X25_Q_BIT) == X25_Q_BIT;
12771da177e4SLinus Torvalds 
12781da177e4SLinus Torvalds 		skb_pull(skb, x25->neighbour->extended ?
12791da177e4SLinus Torvalds 				X25_EXT_MIN_LEN : X25_STD_MIN_LEN);
12801da177e4SLinus Torvalds 
12811da177e4SLinus Torvalds 		if (x25->qbitincl) {
12821da177e4SLinus Torvalds 			asmptr  = skb_push(skb, 1);
12831da177e4SLinus Torvalds 			*asmptr = qbit;
12841da177e4SLinus Torvalds 		}
12851da177e4SLinus Torvalds 	}
12861da177e4SLinus Torvalds 
1287badff6d0SArnaldo Carvalho de Melo 	skb_reset_transport_header(skb);
12881da177e4SLinus Torvalds 	copied = skb->len;
12891da177e4SLinus Torvalds 
12901da177e4SLinus Torvalds 	if (copied > size) {
12911da177e4SLinus Torvalds 		copied = size;
12921da177e4SLinus Torvalds 		msg->msg_flags |= MSG_TRUNC;
12931da177e4SLinus Torvalds 	}
12941da177e4SLinus Torvalds 
12951da177e4SLinus Torvalds 	/* Currently, each datagram always contains a complete record */
12961da177e4SLinus Torvalds 	msg->msg_flags |= MSG_EOR;
12971da177e4SLinus Torvalds 
12981da177e4SLinus Torvalds 	rc = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
12991da177e4SLinus Torvalds 	if (rc)
13001da177e4SLinus Torvalds 		goto out_free_dgram;
13011da177e4SLinus Torvalds 
13021da177e4SLinus Torvalds 	if (sx25) {
13031da177e4SLinus Torvalds 		sx25->sx25_family = AF_X25;
13041da177e4SLinus Torvalds 		sx25->sx25_addr   = x25->dest_addr;
13051da177e4SLinus Torvalds 	}
13061da177e4SLinus Torvalds 
13071da177e4SLinus Torvalds 	msg->msg_namelen = sizeof(struct sockaddr_x25);
13081da177e4SLinus Torvalds 
13091da177e4SLinus Torvalds 	lock_sock(sk);
13101da177e4SLinus Torvalds 	x25_check_rbuf(sk);
13111da177e4SLinus Torvalds 	release_sock(sk);
13121da177e4SLinus Torvalds 	rc = copied;
13131da177e4SLinus Torvalds out_free_dgram:
13141da177e4SLinus Torvalds 	skb_free_datagram(sk, skb);
13151da177e4SLinus Torvalds out:
131691774904SArnd Bergmann 	unlock_kernel();
13171da177e4SLinus Torvalds 	return rc;
13181da177e4SLinus Torvalds }
13191da177e4SLinus Torvalds 
13201da177e4SLinus Torvalds 
13211da177e4SLinus Torvalds static int x25_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
13221da177e4SLinus Torvalds {
13231da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
13241da177e4SLinus Torvalds 	struct x25_sock *x25 = x25_sk(sk);
13251da177e4SLinus Torvalds 	void __user *argp = (void __user *)arg;
13261da177e4SLinus Torvalds 	int rc;
13271da177e4SLinus Torvalds 
132891774904SArnd Bergmann 	lock_kernel();
13291da177e4SLinus Torvalds 	switch (cmd) {
13301da177e4SLinus Torvalds 		case TIOCOUTQ: {
133131e6d363SEric Dumazet 			int amount = sk->sk_sndbuf - sk_wmem_alloc_get(sk);
133231e6d363SEric Dumazet 
13331da177e4SLinus Torvalds 			if (amount < 0)
13341da177e4SLinus Torvalds 				amount = 0;
13351da177e4SLinus Torvalds 			rc = put_user(amount, (unsigned int __user *)argp);
13361da177e4SLinus Torvalds 			break;
13371da177e4SLinus Torvalds 		}
13381da177e4SLinus Torvalds 
13391da177e4SLinus Torvalds 		case TIOCINQ: {
13401da177e4SLinus Torvalds 			struct sk_buff *skb;
13411da177e4SLinus Torvalds 			int amount = 0;
13421da177e4SLinus Torvalds 			/*
13431da177e4SLinus Torvalds 			 * These two are safe on a single CPU system as
13441da177e4SLinus Torvalds 			 * only user tasks fiddle here
13451da177e4SLinus Torvalds 			 */
13461da177e4SLinus Torvalds 			if ((skb = skb_peek(&sk->sk_receive_queue)) != NULL)
13471da177e4SLinus Torvalds 				amount = skb->len;
13481da177e4SLinus Torvalds 			rc = put_user(amount, (unsigned int __user *)argp);
13491da177e4SLinus Torvalds 			break;
13501da177e4SLinus Torvalds 		}
13511da177e4SLinus Torvalds 
13521da177e4SLinus Torvalds 		case SIOCGSTAMP:
13531da177e4SLinus Torvalds 			rc = -EINVAL;
13541da177e4SLinus Torvalds 			if (sk)
13551da177e4SLinus Torvalds 				rc = sock_get_timestamp(sk,
13561da177e4SLinus Torvalds 						(struct timeval __user *)argp);
13571da177e4SLinus Torvalds 			break;
1358ae40eb1eSEric Dumazet 		case SIOCGSTAMPNS:
1359ae40eb1eSEric Dumazet 			rc = -EINVAL;
1360ae40eb1eSEric Dumazet 			if (sk)
1361ae40eb1eSEric Dumazet 				rc = sock_get_timestampns(sk,
1362ae40eb1eSEric Dumazet 						(struct timespec __user *)argp);
1363ae40eb1eSEric Dumazet 			break;
13641da177e4SLinus Torvalds 		case SIOCGIFADDR:
13651da177e4SLinus Torvalds 		case SIOCSIFADDR:
13661da177e4SLinus Torvalds 		case SIOCGIFDSTADDR:
13671da177e4SLinus Torvalds 		case SIOCSIFDSTADDR:
13681da177e4SLinus Torvalds 		case SIOCGIFBRDADDR:
13691da177e4SLinus Torvalds 		case SIOCSIFBRDADDR:
13701da177e4SLinus Torvalds 		case SIOCGIFNETMASK:
13711da177e4SLinus Torvalds 		case SIOCSIFNETMASK:
13721da177e4SLinus Torvalds 		case SIOCGIFMETRIC:
13731da177e4SLinus Torvalds 		case SIOCSIFMETRIC:
13741da177e4SLinus Torvalds 			rc = -EINVAL;
13751da177e4SLinus Torvalds 			break;
13761da177e4SLinus Torvalds 		case SIOCADDRT:
13771da177e4SLinus Torvalds 		case SIOCDELRT:
13781da177e4SLinus Torvalds 			rc = -EPERM;
13791da177e4SLinus Torvalds 			if (!capable(CAP_NET_ADMIN))
13801da177e4SLinus Torvalds 				break;
13811da177e4SLinus Torvalds 			rc = x25_route_ioctl(cmd, argp);
13821da177e4SLinus Torvalds 			break;
13831da177e4SLinus Torvalds 		case SIOCX25GSUBSCRIP:
13841da177e4SLinus Torvalds 			rc = x25_subscr_ioctl(cmd, argp);
13851da177e4SLinus Torvalds 			break;
13861da177e4SLinus Torvalds 		case SIOCX25SSUBSCRIP:
13871da177e4SLinus Torvalds 			rc = -EPERM;
13881da177e4SLinus Torvalds 			if (!capable(CAP_NET_ADMIN))
13891da177e4SLinus Torvalds 				break;
13901da177e4SLinus Torvalds 			rc = x25_subscr_ioctl(cmd, argp);
13911da177e4SLinus Torvalds 			break;
13921da177e4SLinus Torvalds 		case SIOCX25GFACILITIES: {
13931da177e4SLinus Torvalds 			struct x25_facilities fac = x25->facilities;
13941da177e4SLinus Torvalds 			rc = copy_to_user(argp, &fac,
13951da177e4SLinus Torvalds 					  sizeof(fac)) ? -EFAULT : 0;
13961da177e4SLinus Torvalds 			break;
13971da177e4SLinus Torvalds 		}
13981da177e4SLinus Torvalds 
13991da177e4SLinus Torvalds 		case SIOCX25SFACILITIES: {
14001da177e4SLinus Torvalds 			struct x25_facilities facilities;
14011da177e4SLinus Torvalds 			rc = -EFAULT;
14021da177e4SLinus Torvalds 			if (copy_from_user(&facilities, argp,
14031da177e4SLinus Torvalds 					   sizeof(facilities)))
14041da177e4SLinus Torvalds 				break;
14051da177e4SLinus Torvalds 			rc = -EINVAL;
14061da177e4SLinus Torvalds 			if (sk->sk_state != TCP_LISTEN &&
14071da177e4SLinus Torvalds 			    sk->sk_state != TCP_CLOSE)
14081da177e4SLinus Torvalds 				break;
14091da177e4SLinus Torvalds 			if (facilities.pacsize_in < X25_PS16 ||
14101da177e4SLinus Torvalds 			    facilities.pacsize_in > X25_PS4096)
14111da177e4SLinus Torvalds 				break;
14121da177e4SLinus Torvalds 			if (facilities.pacsize_out < X25_PS16 ||
14131da177e4SLinus Torvalds 			    facilities.pacsize_out > X25_PS4096)
14141da177e4SLinus Torvalds 				break;
14151da177e4SLinus Torvalds 			if (facilities.winsize_in < 1 ||
14161da177e4SLinus Torvalds 			    facilities.winsize_in > 127)
14171da177e4SLinus Torvalds 				break;
14181da177e4SLinus Torvalds 			if (facilities.throughput < 0x03 ||
14191da177e4SLinus Torvalds 			    facilities.throughput > 0xDD)
14201da177e4SLinus Torvalds 				break;
1421ebc3f64bSShaun Pereira 			if (facilities.reverse &&
142206a96b33Sroel kluin 				(facilities.reverse & 0x81) != 0x81)
14231da177e4SLinus Torvalds 				break;
14241da177e4SLinus Torvalds 			x25->facilities = facilities;
14251da177e4SLinus Torvalds 			rc = 0;
14261da177e4SLinus Torvalds 			break;
14271da177e4SLinus Torvalds 		}
14281da177e4SLinus Torvalds 
1429a64b7b93SShaun Pereira 		case SIOCX25GDTEFACILITIES: {
1430a64b7b93SShaun Pereira 			rc = copy_to_user(argp, &x25->dte_facilities,
1431a64b7b93SShaun Pereira 						sizeof(x25->dte_facilities));
1432a64b7b93SShaun Pereira 			if (rc)
1433a64b7b93SShaun Pereira 				rc = -EFAULT;
1434a64b7b93SShaun Pereira 			break;
1435a64b7b93SShaun Pereira 		}
1436a64b7b93SShaun Pereira 
1437a64b7b93SShaun Pereira 		case SIOCX25SDTEFACILITIES: {
1438a64b7b93SShaun Pereira 			struct x25_dte_facilities dtefacs;
1439a64b7b93SShaun Pereira 			rc = -EFAULT;
1440a64b7b93SShaun Pereira 			if (copy_from_user(&dtefacs, argp, sizeof(dtefacs)))
1441a64b7b93SShaun Pereira 				break;
1442a64b7b93SShaun Pereira 			rc = -EINVAL;
1443a64b7b93SShaun Pereira 			if (sk->sk_state != TCP_LISTEN &&
1444a64b7b93SShaun Pereira 					sk->sk_state != TCP_CLOSE)
1445a64b7b93SShaun Pereira 				break;
1446a64b7b93SShaun Pereira 			if (dtefacs.calling_len > X25_MAX_AE_LEN)
1447a64b7b93SShaun Pereira 				break;
1448a64b7b93SShaun Pereira 			if (dtefacs.calling_ae == NULL)
1449a64b7b93SShaun Pereira 				break;
1450a64b7b93SShaun Pereira 			if (dtefacs.called_len > X25_MAX_AE_LEN)
1451a64b7b93SShaun Pereira 				break;
1452a64b7b93SShaun Pereira 			if (dtefacs.called_ae == NULL)
1453a64b7b93SShaun Pereira 				break;
1454a64b7b93SShaun Pereira 			x25->dte_facilities = dtefacs;
1455a64b7b93SShaun Pereira 			rc = 0;
1456a64b7b93SShaun Pereira 			break;
1457a64b7b93SShaun Pereira 		}
1458a64b7b93SShaun Pereira 
14591da177e4SLinus Torvalds 		case SIOCX25GCALLUSERDATA: {
14601da177e4SLinus Torvalds 			struct x25_calluserdata cud = x25->calluserdata;
14611da177e4SLinus Torvalds 			rc = copy_to_user(argp, &cud,
14621da177e4SLinus Torvalds 					  sizeof(cud)) ? -EFAULT : 0;
14631da177e4SLinus Torvalds 			break;
14641da177e4SLinus Torvalds 		}
14651da177e4SLinus Torvalds 
14661da177e4SLinus Torvalds 		case SIOCX25SCALLUSERDATA: {
14671da177e4SLinus Torvalds 			struct x25_calluserdata calluserdata;
14681da177e4SLinus Torvalds 
14691da177e4SLinus Torvalds 			rc = -EFAULT;
14701da177e4SLinus Torvalds 			if (copy_from_user(&calluserdata, argp,
14711da177e4SLinus Torvalds 					   sizeof(calluserdata)))
14721da177e4SLinus Torvalds 				break;
14731da177e4SLinus Torvalds 			rc = -EINVAL;
14741da177e4SLinus Torvalds 			if (calluserdata.cudlength > X25_MAX_CUD_LEN)
14751da177e4SLinus Torvalds 				break;
14761da177e4SLinus Torvalds 			x25->calluserdata = calluserdata;
14771da177e4SLinus Torvalds 			rc = 0;
14781da177e4SLinus Torvalds 			break;
14791da177e4SLinus Torvalds 		}
14801da177e4SLinus Torvalds 
14811da177e4SLinus Torvalds 		case SIOCX25GCAUSEDIAG: {
14821da177e4SLinus Torvalds 			struct x25_causediag causediag;
14831da177e4SLinus Torvalds 			causediag = x25->causediag;
14841da177e4SLinus Torvalds 			rc = copy_to_user(argp, &causediag,
14851da177e4SLinus Torvalds 					  sizeof(causediag)) ? -EFAULT : 0;
14861da177e4SLinus Torvalds 			break;
14871da177e4SLinus Torvalds 		}
14881da177e4SLinus Torvalds 
1489386e50ccSAndrew Hendry 		case SIOCX25SCAUSEDIAG: {
1490386e50ccSAndrew Hendry 			struct x25_causediag causediag;
1491386e50ccSAndrew Hendry 			rc = -EFAULT;
1492386e50ccSAndrew Hendry 			if (copy_from_user(&causediag, argp, sizeof(causediag)))
1493386e50ccSAndrew Hendry 				break;
1494386e50ccSAndrew Hendry 			x25->causediag = causediag;
1495386e50ccSAndrew Hendry 			rc = 0;
1496386e50ccSAndrew Hendry 			break;
1497386e50ccSAndrew Hendry 
1498386e50ccSAndrew Hendry 		}
1499386e50ccSAndrew Hendry 
1500cb65d506SShaun Pereira 		case SIOCX25SCUDMATCHLEN: {
1501cb65d506SShaun Pereira 			struct x25_subaddr sub_addr;
1502cb65d506SShaun Pereira 			rc = -EINVAL;
1503cb65d506SShaun Pereira 			if(sk->sk_state != TCP_CLOSE)
1504cb65d506SShaun Pereira 				break;
1505cb65d506SShaun Pereira 			rc = -EFAULT;
1506cb65d506SShaun Pereira 			if (copy_from_user(&sub_addr, argp,
1507cb65d506SShaun Pereira 					sizeof(sub_addr)))
1508cb65d506SShaun Pereira 				break;
1509cb65d506SShaun Pereira 			rc = -EINVAL;
1510cb65d506SShaun Pereira 			if(sub_addr.cudmatchlength > X25_MAX_CUD_LEN)
1511cb65d506SShaun Pereira 				break;
1512cb65d506SShaun Pereira 			x25->cudmatchlength = sub_addr.cudmatchlength;
1513cb65d506SShaun Pereira 			rc = 0;
1514cb65d506SShaun Pereira 			break;
1515cb65d506SShaun Pereira 		}
1516cb65d506SShaun Pereira 
1517ebc3f64bSShaun Pereira 		case SIOCX25CALLACCPTAPPRV: {
1518ebc3f64bSShaun Pereira 			rc = -EINVAL;
1519ebc3f64bSShaun Pereira 			if (sk->sk_state != TCP_CLOSE)
1520ebc3f64bSShaun Pereira 				break;
1521ebc3f64bSShaun Pereira 			x25->accptapprv = X25_ALLOW_ACCPT_APPRV;
1522ebc3f64bSShaun Pereira 			rc = 0;
1523ebc3f64bSShaun Pereira 			break;
1524ebc3f64bSShaun Pereira 		}
1525ebc3f64bSShaun Pereira 
1526ebc3f64bSShaun Pereira 		case SIOCX25SENDCALLACCPT:  {
1527ebc3f64bSShaun Pereira 			rc = -EINVAL;
1528ebc3f64bSShaun Pereira 			if (sk->sk_state != TCP_ESTABLISHED)
1529ebc3f64bSShaun Pereira 				break;
1530ebc3f64bSShaun Pereira 			if (x25->accptapprv)	/* must call accptapprv above */
1531ebc3f64bSShaun Pereira 				break;
1532ebc3f64bSShaun Pereira 			x25_write_internal(sk, X25_CALL_ACCEPTED);
1533ebc3f64bSShaun Pereira 			x25->state = X25_STATE_3;
1534ebc3f64bSShaun Pereira 			rc = 0;
1535ebc3f64bSShaun Pereira 			break;
1536ebc3f64bSShaun Pereira 		}
1537ebc3f64bSShaun Pereira 
15381da177e4SLinus Torvalds 		default:
1539b5e5fa5eSChristoph Hellwig 			rc = -ENOIOCTLCMD;
15401da177e4SLinus Torvalds 			break;
15411da177e4SLinus Torvalds 	}
154291774904SArnd Bergmann 	unlock_kernel();
15431da177e4SLinus Torvalds 
15441da177e4SLinus Torvalds 	return rc;
15451da177e4SLinus Torvalds }
15461da177e4SLinus Torvalds 
1547ec1b4cf7SStephen Hemminger static const struct net_proto_family x25_family_ops = {
15481da177e4SLinus Torvalds 	.family =	AF_X25,
15491da177e4SLinus Torvalds 	.create =	x25_create,
15501da177e4SLinus Torvalds 	.owner	=	THIS_MODULE,
15511da177e4SLinus Torvalds };
15521da177e4SLinus Torvalds 
15531b06e6baSShaun Pereira #ifdef CONFIG_COMPAT
15541b06e6baSShaun Pereira static int compat_x25_subscr_ioctl(unsigned int cmd,
15551b06e6baSShaun Pereira 		struct compat_x25_subscrip_struct __user *x25_subscr32)
15561b06e6baSShaun Pereira {
15571b06e6baSShaun Pereira 	struct compat_x25_subscrip_struct x25_subscr;
15581b06e6baSShaun Pereira 	struct x25_neigh *nb;
15591b06e6baSShaun Pereira 	struct net_device *dev;
15601b06e6baSShaun Pereira 	int rc = -EINVAL;
15611b06e6baSShaun Pereira 
15621b06e6baSShaun Pereira 	rc = -EFAULT;
15631b06e6baSShaun Pereira 	if (copy_from_user(&x25_subscr, x25_subscr32, sizeof(*x25_subscr32)))
15641b06e6baSShaun Pereira 		goto out;
15651b06e6baSShaun Pereira 
15661b06e6baSShaun Pereira 	rc = -EINVAL;
15671b06e6baSShaun Pereira 	dev = x25_dev_get(x25_subscr.device);
15681b06e6baSShaun Pereira 	if (dev == NULL)
15691b06e6baSShaun Pereira 		goto out;
15701b06e6baSShaun Pereira 
15711b06e6baSShaun Pereira 	nb = x25_get_neigh(dev);
15721b06e6baSShaun Pereira 	if (nb == NULL)
15731b06e6baSShaun Pereira 		goto out_dev_put;
15741b06e6baSShaun Pereira 
15751b06e6baSShaun Pereira 	dev_put(dev);
15761b06e6baSShaun Pereira 
15771b06e6baSShaun Pereira 	if (cmd == SIOCX25GSUBSCRIP) {
15781b06e6baSShaun Pereira 		x25_subscr.extended = nb->extended;
15791b06e6baSShaun Pereira 		x25_subscr.global_facil_mask = nb->global_facil_mask;
15801b06e6baSShaun Pereira 		rc = copy_to_user(x25_subscr32, &x25_subscr,
15811b06e6baSShaun Pereira 				sizeof(*x25_subscr32)) ? -EFAULT : 0;
15821b06e6baSShaun Pereira 	} else {
15831b06e6baSShaun Pereira 		rc = -EINVAL;
15841b06e6baSShaun Pereira 		if (x25_subscr.extended == 0 || x25_subscr.extended == 1) {
15851b06e6baSShaun Pereira 			rc = 0;
15861b06e6baSShaun Pereira 			nb->extended = x25_subscr.extended;
15871b06e6baSShaun Pereira 			nb->global_facil_mask = x25_subscr.global_facil_mask;
15881b06e6baSShaun Pereira 		}
15891b06e6baSShaun Pereira 	}
15901b06e6baSShaun Pereira 	x25_neigh_put(nb);
15911b06e6baSShaun Pereira out:
15921b06e6baSShaun Pereira 	return rc;
15931b06e6baSShaun Pereira out_dev_put:
15941b06e6baSShaun Pereira 	dev_put(dev);
15951b06e6baSShaun Pereira 	goto out;
15961b06e6baSShaun Pereira }
15971b06e6baSShaun Pereira 
15981b06e6baSShaun Pereira static int compat_x25_ioctl(struct socket *sock, unsigned int cmd,
15991b06e6baSShaun Pereira 				unsigned long arg)
16001b06e6baSShaun Pereira {
16011b06e6baSShaun Pereira 	void __user *argp = compat_ptr(arg);
16021b06e6baSShaun Pereira 	struct sock *sk = sock->sk;
16031b06e6baSShaun Pereira 
16041b06e6baSShaun Pereira 	int rc = -ENOIOCTLCMD;
16051b06e6baSShaun Pereira 
16061b06e6baSShaun Pereira 	switch(cmd) {
16071b06e6baSShaun Pereira 	case TIOCOUTQ:
16081b06e6baSShaun Pereira 	case TIOCINQ:
16091b06e6baSShaun Pereira 		rc = x25_ioctl(sock, cmd, (unsigned long)argp);
16101b06e6baSShaun Pereira 		break;
16111b06e6baSShaun Pereira 	case SIOCGSTAMP:
16121b06e6baSShaun Pereira 		rc = -EINVAL;
161391774904SArnd Bergmann 		lock_kernel();
16141b06e6baSShaun Pereira 		if (sk)
16151b06e6baSShaun Pereira 			rc = compat_sock_get_timestamp(sk,
16161b06e6baSShaun Pereira 					(struct timeval __user*)argp);
161791774904SArnd Bergmann 		unlock_kernel();
16181b06e6baSShaun Pereira 		break;
1619ae40eb1eSEric Dumazet 	case SIOCGSTAMPNS:
1620ae40eb1eSEric Dumazet 		rc = -EINVAL;
162191774904SArnd Bergmann 		lock_kernel();
1622ae40eb1eSEric Dumazet 		if (sk)
1623ae40eb1eSEric Dumazet 			rc = compat_sock_get_timestampns(sk,
1624ae40eb1eSEric Dumazet 					(struct timespec __user*)argp);
162591774904SArnd Bergmann 		unlock_kernel();
1626ae40eb1eSEric Dumazet 		break;
16271b06e6baSShaun Pereira 	case SIOCGIFADDR:
16281b06e6baSShaun Pereira 	case SIOCSIFADDR:
16291b06e6baSShaun Pereira 	case SIOCGIFDSTADDR:
16301b06e6baSShaun Pereira 	case SIOCSIFDSTADDR:
16311b06e6baSShaun Pereira 	case SIOCGIFBRDADDR:
16321b06e6baSShaun Pereira 	case SIOCSIFBRDADDR:
16331b06e6baSShaun Pereira 	case SIOCGIFNETMASK:
16341b06e6baSShaun Pereira 	case SIOCSIFNETMASK:
16351b06e6baSShaun Pereira 	case SIOCGIFMETRIC:
16361b06e6baSShaun Pereira 	case SIOCSIFMETRIC:
16371b06e6baSShaun Pereira 		rc = -EINVAL;
16381b06e6baSShaun Pereira 		break;
16391b06e6baSShaun Pereira 	case SIOCADDRT:
16401b06e6baSShaun Pereira 	case SIOCDELRT:
16411b06e6baSShaun Pereira 		rc = -EPERM;
16421b06e6baSShaun Pereira 		if (!capable(CAP_NET_ADMIN))
16431b06e6baSShaun Pereira 			break;
164491774904SArnd Bergmann 		lock_kernel();
16451b06e6baSShaun Pereira 		rc = x25_route_ioctl(cmd, argp);
164691774904SArnd Bergmann 		unlock_kernel();
16471b06e6baSShaun Pereira 		break;
16481b06e6baSShaun Pereira 	case SIOCX25GSUBSCRIP:
164991774904SArnd Bergmann 		lock_kernel();
16501b06e6baSShaun Pereira 		rc = compat_x25_subscr_ioctl(cmd, argp);
165191774904SArnd Bergmann 		unlock_kernel();
16521b06e6baSShaun Pereira 		break;
16531b06e6baSShaun Pereira 	case SIOCX25SSUBSCRIP:
16541b06e6baSShaun Pereira 		rc = -EPERM;
16551b06e6baSShaun Pereira 		if (!capable(CAP_NET_ADMIN))
16561b06e6baSShaun Pereira 			break;
165791774904SArnd Bergmann 		lock_kernel();
16581b06e6baSShaun Pereira 		rc = compat_x25_subscr_ioctl(cmd, argp);
165991774904SArnd Bergmann 		unlock_kernel();
16601b06e6baSShaun Pereira 		break;
16611b06e6baSShaun Pereira 	case SIOCX25GFACILITIES:
16621b06e6baSShaun Pereira 	case SIOCX25SFACILITIES:
16639a6b9f2eSShaun Pereira 	case SIOCX25GDTEFACILITIES:
16649a6b9f2eSShaun Pereira 	case SIOCX25SDTEFACILITIES:
16651b06e6baSShaun Pereira 	case SIOCX25GCALLUSERDATA:
16661b06e6baSShaun Pereira 	case SIOCX25SCALLUSERDATA:
16671b06e6baSShaun Pereira 	case SIOCX25GCAUSEDIAG:
1668386e50ccSAndrew Hendry 	case SIOCX25SCAUSEDIAG:
16691b06e6baSShaun Pereira 	case SIOCX25SCUDMATCHLEN:
16701b06e6baSShaun Pereira 	case SIOCX25CALLACCPTAPPRV:
16711b06e6baSShaun Pereira 	case SIOCX25SENDCALLACCPT:
16721b06e6baSShaun Pereira 		rc = x25_ioctl(sock, cmd, (unsigned long)argp);
16731b06e6baSShaun Pereira 		break;
16741b06e6baSShaun Pereira 	default:
16751b06e6baSShaun Pereira 		rc = -ENOIOCTLCMD;
16761b06e6baSShaun Pereira 		break;
16771b06e6baSShaun Pereira 	}
16781b06e6baSShaun Pereira 	return rc;
16791b06e6baSShaun Pereira }
16801b06e6baSShaun Pereira #endif
16811b06e6baSShaun Pereira 
168291774904SArnd Bergmann static const struct proto_ops x25_proto_ops = {
16831da177e4SLinus Torvalds 	.family =	AF_X25,
16841da177e4SLinus Torvalds 	.owner =	THIS_MODULE,
16851da177e4SLinus Torvalds 	.release =	x25_release,
16861da177e4SLinus Torvalds 	.bind =		x25_bind,
16871da177e4SLinus Torvalds 	.connect =	x25_connect,
16881da177e4SLinus Torvalds 	.socketpair =	sock_no_socketpair,
16891da177e4SLinus Torvalds 	.accept =	x25_accept,
16901da177e4SLinus Torvalds 	.getname =	x25_getname,
169191774904SArnd Bergmann 	.poll =		x25_datagram_poll,
16921da177e4SLinus Torvalds 	.ioctl =	x25_ioctl,
16931b06e6baSShaun Pereira #ifdef CONFIG_COMPAT
16941b06e6baSShaun Pereira 	.compat_ioctl = compat_x25_ioctl,
16951b06e6baSShaun Pereira #endif
16961da177e4SLinus Torvalds 	.listen =	x25_listen,
16971da177e4SLinus Torvalds 	.shutdown =	sock_no_shutdown,
16981da177e4SLinus Torvalds 	.setsockopt =	x25_setsockopt,
16991da177e4SLinus Torvalds 	.getsockopt =	x25_getsockopt,
17001da177e4SLinus Torvalds 	.sendmsg =	x25_sendmsg,
17011da177e4SLinus Torvalds 	.recvmsg =	x25_recvmsg,
17021da177e4SLinus Torvalds 	.mmap =		sock_no_mmap,
17031da177e4SLinus Torvalds 	.sendpage =	sock_no_sendpage,
17041da177e4SLinus Torvalds };
17051da177e4SLinus Torvalds 
17067546dd97SStephen Hemminger static struct packet_type x25_packet_type __read_mostly = {
170709640e63SHarvey Harrison 	.type =	cpu_to_be16(ETH_P_X25),
17081da177e4SLinus Torvalds 	.func =	x25_lapb_receive_frame,
17091da177e4SLinus Torvalds };
17101da177e4SLinus Torvalds 
17111da177e4SLinus Torvalds static struct notifier_block x25_dev_notifier = {
17121da177e4SLinus Torvalds 	.notifier_call = x25_device_event,
17131da177e4SLinus Torvalds };
17141da177e4SLinus Torvalds 
17151da177e4SLinus Torvalds void x25_kill_by_neigh(struct x25_neigh *nb)
17161da177e4SLinus Torvalds {
17171da177e4SLinus Torvalds 	struct sock *s;
17181da177e4SLinus Torvalds 	struct hlist_node *node;
17191da177e4SLinus Torvalds 
17201da177e4SLinus Torvalds 	write_lock_bh(&x25_list_lock);
17211da177e4SLinus Torvalds 
17221da177e4SLinus Torvalds 	sk_for_each(s, node, &x25_list)
17231da177e4SLinus Torvalds 		if (x25_sk(s)->neighbour == nb)
17241da177e4SLinus Torvalds 			x25_disconnect(s, ENETUNREACH, 0, 0);
17251da177e4SLinus Torvalds 
17261da177e4SLinus Torvalds 	write_unlock_bh(&x25_list_lock);
172795a9dc43SAndrew Hendry 
172895a9dc43SAndrew Hendry 	/* Remove any related forwards */
172995a9dc43SAndrew Hendry 	x25_clear_forward_by_dev(nb->dev);
17301da177e4SLinus Torvalds }
17311da177e4SLinus Torvalds 
17321da177e4SLinus Torvalds static int __init x25_init(void)
17331da177e4SLinus Torvalds {
17341da177e4SLinus Torvalds 	int rc = proto_register(&x25_proto, 0);
17351da177e4SLinus Torvalds 
17361da177e4SLinus Torvalds 	if (rc != 0)
17371da177e4SLinus Torvalds 		goto out;
17381da177e4SLinus Torvalds 
17391fd975a0Sandrew hendry 	rc = sock_register(&x25_family_ops);
17401fd975a0Sandrew hendry 	if (rc != 0)
17411fd975a0Sandrew hendry 		goto out_proto;
17421da177e4SLinus Torvalds 
17431da177e4SLinus Torvalds 	dev_add_pack(&x25_packet_type);
17441da177e4SLinus Torvalds 
17451fd975a0Sandrew hendry 	rc = register_netdevice_notifier(&x25_dev_notifier);
17461fd975a0Sandrew hendry 	if (rc != 0)
17471fd975a0Sandrew hendry 		goto out_sock;
17481da177e4SLinus Torvalds 
1749a44562e4Smaximilian attems 	printk(KERN_INFO "X.25 for Linux Version 0.2\n");
17501da177e4SLinus Torvalds 
17511da177e4SLinus Torvalds 	x25_register_sysctl();
17521fd975a0Sandrew hendry 	rc = x25_proc_init();
17531fd975a0Sandrew hendry 	if (rc != 0)
17541fd975a0Sandrew hendry 		goto out_dev;
17551da177e4SLinus Torvalds out:
17561da177e4SLinus Torvalds 	return rc;
17571fd975a0Sandrew hendry out_dev:
17581fd975a0Sandrew hendry 	unregister_netdevice_notifier(&x25_dev_notifier);
17591fd975a0Sandrew hendry out_sock:
17601fd975a0Sandrew hendry 	sock_unregister(AF_X25);
17611fd975a0Sandrew hendry out_proto:
17621fd975a0Sandrew hendry 	proto_unregister(&x25_proto);
17631fd975a0Sandrew hendry 	goto out;
17641da177e4SLinus Torvalds }
17651da177e4SLinus Torvalds module_init(x25_init);
17661da177e4SLinus Torvalds 
17671da177e4SLinus Torvalds static void __exit x25_exit(void)
17681da177e4SLinus Torvalds {
17691da177e4SLinus Torvalds 	x25_proc_exit();
17701da177e4SLinus Torvalds 	x25_link_free();
17711da177e4SLinus Torvalds 	x25_route_free();
17721da177e4SLinus Torvalds 
17731da177e4SLinus Torvalds 	x25_unregister_sysctl();
17741da177e4SLinus Torvalds 
17751da177e4SLinus Torvalds 	unregister_netdevice_notifier(&x25_dev_notifier);
17761da177e4SLinus Torvalds 
17771da177e4SLinus Torvalds 	dev_remove_pack(&x25_packet_type);
17781da177e4SLinus Torvalds 
17791da177e4SLinus Torvalds 	sock_unregister(AF_X25);
17801da177e4SLinus Torvalds 	proto_unregister(&x25_proto);
17811da177e4SLinus Torvalds }
17821da177e4SLinus Torvalds module_exit(x25_exit);
17831da177e4SLinus Torvalds 
17841da177e4SLinus Torvalds MODULE_AUTHOR("Jonathan Naylor <g4klx@g4klx.demon.co.uk>");
17851da177e4SLinus Torvalds MODULE_DESCRIPTION("The X.25 Packet Layer network layer protocol");
17861da177e4SLinus Torvalds MODULE_LICENSE("GPL");
17871da177e4SLinus Torvalds MODULE_ALIAS_NETPROTO(PF_X25);
1788