xref: /openbmc/linux/net/x25/af_x25.c (revision b7058842c940ad2c08dd829b21e5c92ebe3b8758)
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>
501da177e4SLinus Torvalds #include <net/sock.h>
51c752f073SArnaldo Carvalho de Melo #include <net/tcp_states.h>
521da177e4SLinus Torvalds #include <asm/uaccess.h>
531da177e4SLinus Torvalds #include <linux/fcntl.h>
541da177e4SLinus Torvalds #include <linux/termios.h>	/* For TIOCINQ/OUTQ */
551da177e4SLinus Torvalds #include <linux/notifier.h>
561da177e4SLinus Torvalds #include <linux/init.h>
571b06e6baSShaun Pereira #include <linux/compat.h>
581b06e6baSShaun Pereira 
591da177e4SLinus Torvalds #include <net/x25.h>
601b06e6baSShaun Pereira #include <net/compat.h>
611da177e4SLinus Torvalds 
621da177e4SLinus Torvalds int sysctl_x25_restart_request_timeout = X25_DEFAULT_T20;
631da177e4SLinus Torvalds int sysctl_x25_call_request_timeout    = X25_DEFAULT_T21;
641da177e4SLinus Torvalds int sysctl_x25_reset_request_timeout   = X25_DEFAULT_T22;
651da177e4SLinus Torvalds int sysctl_x25_clear_request_timeout   = X25_DEFAULT_T23;
661da177e4SLinus Torvalds int sysctl_x25_ack_holdback_timeout    = X25_DEFAULT_T2;
6739e21c0dSAndrew Hendry int sysctl_x25_forward                 = 0;
681da177e4SLinus Torvalds 
691da177e4SLinus Torvalds HLIST_HEAD(x25_list);
701da177e4SLinus Torvalds DEFINE_RWLOCK(x25_list_lock);
711da177e4SLinus Torvalds 
7290ddc4f0SEric Dumazet static const struct proto_ops x25_proto_ops;
731da177e4SLinus Torvalds 
741da177e4SLinus Torvalds static struct x25_address null_x25_address = {"               "};
751da177e4SLinus Torvalds 
761b06e6baSShaun Pereira #ifdef CONFIG_COMPAT
771b06e6baSShaun Pereira struct compat_x25_subscrip_struct {
781b06e6baSShaun Pereira 	char device[200-sizeof(compat_ulong_t)];
791b06e6baSShaun Pereira 	compat_ulong_t global_facil_mask;
801b06e6baSShaun Pereira 	compat_uint_t extended;
811b06e6baSShaun Pereira };
821b06e6baSShaun Pereira #endif
831b06e6baSShaun Pereira 
841da177e4SLinus Torvalds int x25_addr_ntoa(unsigned char *p, struct x25_address *called_addr,
851da177e4SLinus Torvalds 		  struct x25_address *calling_addr)
861da177e4SLinus Torvalds {
876bf1574eSEric Dumazet 	unsigned int called_len, calling_len;
881da177e4SLinus Torvalds 	char *called, *calling;
896bf1574eSEric Dumazet 	unsigned int i;
901da177e4SLinus Torvalds 
911da177e4SLinus Torvalds 	called_len  = (*p >> 0) & 0x0F;
921da177e4SLinus Torvalds 	calling_len = (*p >> 4) & 0x0F;
931da177e4SLinus Torvalds 
941da177e4SLinus Torvalds 	called  = called_addr->x25_addr;
951da177e4SLinus Torvalds 	calling = calling_addr->x25_addr;
961da177e4SLinus Torvalds 	p++;
971da177e4SLinus Torvalds 
981da177e4SLinus Torvalds 	for (i = 0; i < (called_len + calling_len); i++) {
991da177e4SLinus Torvalds 		if (i < called_len) {
1001da177e4SLinus Torvalds 			if (i % 2 != 0) {
1011da177e4SLinus Torvalds 				*called++ = ((*p >> 0) & 0x0F) + '0';
1021da177e4SLinus Torvalds 				p++;
1031da177e4SLinus Torvalds 			} else {
1041da177e4SLinus Torvalds 				*called++ = ((*p >> 4) & 0x0F) + '0';
1051da177e4SLinus Torvalds 			}
1061da177e4SLinus Torvalds 		} else {
1071da177e4SLinus Torvalds 			if (i % 2 != 0) {
1081da177e4SLinus Torvalds 				*calling++ = ((*p >> 0) & 0x0F) + '0';
1091da177e4SLinus Torvalds 				p++;
1101da177e4SLinus Torvalds 			} else {
1111da177e4SLinus Torvalds 				*calling++ = ((*p >> 4) & 0x0F) + '0';
1121da177e4SLinus Torvalds 			}
1131da177e4SLinus Torvalds 		}
1141da177e4SLinus Torvalds 	}
1151da177e4SLinus Torvalds 
1161da177e4SLinus Torvalds 	*called = *calling = '\0';
1171da177e4SLinus Torvalds 
1181da177e4SLinus Torvalds 	return 1 + (called_len + calling_len + 1) / 2;
1191da177e4SLinus Torvalds }
1201da177e4SLinus Torvalds 
1211da177e4SLinus Torvalds int x25_addr_aton(unsigned char *p, struct x25_address *called_addr,
1221da177e4SLinus Torvalds 		  struct x25_address *calling_addr)
1231da177e4SLinus Torvalds {
1241da177e4SLinus Torvalds 	unsigned int called_len, calling_len;
1251da177e4SLinus Torvalds 	char *called, *calling;
1261da177e4SLinus Torvalds 	int i;
1271da177e4SLinus Torvalds 
1281da177e4SLinus Torvalds 	called  = called_addr->x25_addr;
1291da177e4SLinus Torvalds 	calling = calling_addr->x25_addr;
1301da177e4SLinus Torvalds 
1311da177e4SLinus Torvalds 	called_len  = strlen(called);
1321da177e4SLinus Torvalds 	calling_len = strlen(calling);
1331da177e4SLinus Torvalds 
1341da177e4SLinus Torvalds 	*p++ = (calling_len << 4) | (called_len << 0);
1351da177e4SLinus Torvalds 
1361da177e4SLinus Torvalds 	for (i = 0; i < (called_len + calling_len); i++) {
1371da177e4SLinus Torvalds 		if (i < called_len) {
1381da177e4SLinus Torvalds 			if (i % 2 != 0) {
1391da177e4SLinus Torvalds 				*p |= (*called++ - '0') << 0;
1401da177e4SLinus Torvalds 				p++;
1411da177e4SLinus Torvalds 			} else {
1421da177e4SLinus Torvalds 				*p = 0x00;
1431da177e4SLinus Torvalds 				*p |= (*called++ - '0') << 4;
1441da177e4SLinus Torvalds 			}
1451da177e4SLinus Torvalds 		} else {
1461da177e4SLinus Torvalds 			if (i % 2 != 0) {
1471da177e4SLinus Torvalds 				*p |= (*calling++ - '0') << 0;
1481da177e4SLinus Torvalds 				p++;
1491da177e4SLinus Torvalds 			} else {
1501da177e4SLinus Torvalds 				*p = 0x00;
1511da177e4SLinus Torvalds 				*p |= (*calling++ - '0') << 4;
1521da177e4SLinus Torvalds 			}
1531da177e4SLinus Torvalds 		}
1541da177e4SLinus Torvalds 	}
1551da177e4SLinus Torvalds 
1561da177e4SLinus Torvalds 	return 1 + (called_len + calling_len + 1) / 2;
1571da177e4SLinus Torvalds }
1581da177e4SLinus Torvalds 
1591da177e4SLinus Torvalds /*
1601da177e4SLinus Torvalds  *	Socket removal during an interrupt is now safe.
1611da177e4SLinus Torvalds  */
1621da177e4SLinus Torvalds static void x25_remove_socket(struct sock *sk)
1631da177e4SLinus Torvalds {
1641da177e4SLinus Torvalds 	write_lock_bh(&x25_list_lock);
1651da177e4SLinus Torvalds 	sk_del_node_init(sk);
1661da177e4SLinus Torvalds 	write_unlock_bh(&x25_list_lock);
1671da177e4SLinus Torvalds }
1681da177e4SLinus Torvalds 
1691da177e4SLinus Torvalds /*
1701da177e4SLinus Torvalds  *	Kill all bound sockets on a dropped device.
1711da177e4SLinus Torvalds  */
1721da177e4SLinus Torvalds static void x25_kill_by_device(struct net_device *dev)
1731da177e4SLinus Torvalds {
1741da177e4SLinus Torvalds 	struct sock *s;
1751da177e4SLinus Torvalds 	struct hlist_node *node;
1761da177e4SLinus Torvalds 
1771da177e4SLinus Torvalds 	write_lock_bh(&x25_list_lock);
1781da177e4SLinus Torvalds 
1791da177e4SLinus Torvalds 	sk_for_each(s, node, &x25_list)
1801da177e4SLinus Torvalds 		if (x25_sk(s)->neighbour && x25_sk(s)->neighbour->dev == dev)
1811da177e4SLinus Torvalds 			x25_disconnect(s, ENETUNREACH, 0, 0);
1821da177e4SLinus Torvalds 
1831da177e4SLinus Torvalds 	write_unlock_bh(&x25_list_lock);
1841da177e4SLinus Torvalds }
1851da177e4SLinus Torvalds 
1861da177e4SLinus Torvalds /*
1871da177e4SLinus Torvalds  *	Handle device status changes.
1881da177e4SLinus Torvalds  */
1891da177e4SLinus Torvalds static int x25_device_event(struct notifier_block *this, unsigned long event,
1901da177e4SLinus Torvalds 			    void *ptr)
1911da177e4SLinus Torvalds {
1921da177e4SLinus Torvalds 	struct net_device *dev = ptr;
1931da177e4SLinus Torvalds 	struct x25_neigh *nb;
1941da177e4SLinus Torvalds 
195721499e8SYOSHIFUJI Hideaki 	if (!net_eq(dev_net(dev), &init_net))
196e9dc8653SEric W. Biederman 		return NOTIFY_DONE;
197e9dc8653SEric W. Biederman 
1981da177e4SLinus Torvalds 	if (dev->type == ARPHRD_X25
1991da177e4SLinus Torvalds #if defined(CONFIG_LLC) || defined(CONFIG_LLC_MODULE)
2001da177e4SLinus Torvalds 	 || dev->type == ARPHRD_ETHER
2011da177e4SLinus Torvalds #endif
2021da177e4SLinus Torvalds 	 ) {
2031da177e4SLinus Torvalds 		switch (event) {
2041da177e4SLinus Torvalds 			case NETDEV_UP:
2051da177e4SLinus Torvalds 				x25_link_device_up(dev);
2061da177e4SLinus Torvalds 				break;
2071da177e4SLinus Torvalds 			case NETDEV_GOING_DOWN:
2081da177e4SLinus Torvalds 				nb = x25_get_neigh(dev);
2091da177e4SLinus Torvalds 				if (nb) {
2101da177e4SLinus Torvalds 					x25_terminate_link(nb);
2111da177e4SLinus Torvalds 					x25_neigh_put(nb);
2121da177e4SLinus Torvalds 				}
2131da177e4SLinus Torvalds 				break;
2141da177e4SLinus Torvalds 			case NETDEV_DOWN:
2151da177e4SLinus Torvalds 				x25_kill_by_device(dev);
2161da177e4SLinus Torvalds 				x25_route_device_down(dev);
2171da177e4SLinus Torvalds 				x25_link_device_down(dev);
2181da177e4SLinus Torvalds 				break;
2191da177e4SLinus Torvalds 		}
2201da177e4SLinus Torvalds 	}
2211da177e4SLinus Torvalds 
2221da177e4SLinus Torvalds 	return NOTIFY_DONE;
2231da177e4SLinus Torvalds }
2241da177e4SLinus Torvalds 
2251da177e4SLinus Torvalds /*
2261da177e4SLinus Torvalds  *	Add a socket to the bound sockets list.
2271da177e4SLinus Torvalds  */
2281da177e4SLinus Torvalds static void x25_insert_socket(struct sock *sk)
2291da177e4SLinus Torvalds {
2301da177e4SLinus Torvalds 	write_lock_bh(&x25_list_lock);
2311da177e4SLinus Torvalds 	sk_add_node(sk, &x25_list);
2321da177e4SLinus Torvalds 	write_unlock_bh(&x25_list_lock);
2331da177e4SLinus Torvalds }
2341da177e4SLinus Torvalds 
2351da177e4SLinus Torvalds /*
2361da177e4SLinus Torvalds  *	Find a socket that wants to accept the Call Request we just
2371da177e4SLinus Torvalds  *	received. Check the full list for an address/cud match.
2381da177e4SLinus Torvalds  *	If no cuds match return the next_best thing, an address match.
2391da177e4SLinus Torvalds  *	Note: if a listening socket has cud set it must only get calls
2401da177e4SLinus Torvalds  *	with matching cud.
2411da177e4SLinus Torvalds  */
242cb65d506SShaun Pereira static struct sock *x25_find_listener(struct x25_address *addr,
243cb65d506SShaun Pereira 					struct sk_buff *skb)
2441da177e4SLinus Torvalds {
2451da177e4SLinus Torvalds 	struct sock *s;
2461da177e4SLinus Torvalds 	struct sock *next_best;
2471da177e4SLinus Torvalds 	struct hlist_node *node;
2481da177e4SLinus Torvalds 
2491da177e4SLinus Torvalds 	read_lock_bh(&x25_list_lock);
2501da177e4SLinus Torvalds 	next_best = NULL;
2511da177e4SLinus Torvalds 
2521da177e4SLinus Torvalds 	sk_for_each(s, node, &x25_list)
2531da177e4SLinus Torvalds 		if ((!strcmp(addr->x25_addr,
2541da177e4SLinus Torvalds 			x25_sk(s)->source_addr.x25_addr) ||
2551da177e4SLinus Torvalds 				!strcmp(addr->x25_addr,
2561da177e4SLinus Torvalds 					null_x25_address.x25_addr)) &&
2571da177e4SLinus Torvalds 					s->sk_state == TCP_LISTEN) {
2581da177e4SLinus Torvalds 			/*
2591da177e4SLinus Torvalds 			 * Found a listening socket, now check the incoming
2601da177e4SLinus Torvalds 			 * call user data vs this sockets call user data
2611da177e4SLinus Torvalds 			 */
262cb65d506SShaun Pereira 			if(skb->len > 0 && x25_sk(s)->cudmatchlength > 0) {
263cb65d506SShaun Pereira 				if((memcmp(x25_sk(s)->calluserdata.cuddata,
264cb65d506SShaun Pereira 					skb->data,
265cb65d506SShaun Pereira 					x25_sk(s)->cudmatchlength)) == 0) {
2661da177e4SLinus Torvalds 					sock_hold(s);
2671da177e4SLinus Torvalds 					goto found;
2681da177e4SLinus Torvalds 				 }
269cb65d506SShaun Pereira 			} else
2701da177e4SLinus Torvalds 				next_best = s;
2711da177e4SLinus Torvalds 		}
2721da177e4SLinus Torvalds 	if (next_best) {
2731da177e4SLinus Torvalds 		s = next_best;
2741da177e4SLinus Torvalds 		sock_hold(s);
2751da177e4SLinus Torvalds 		goto found;
2761da177e4SLinus Torvalds 	}
2771da177e4SLinus Torvalds 	s = NULL;
2781da177e4SLinus Torvalds found:
2791da177e4SLinus Torvalds 	read_unlock_bh(&x25_list_lock);
2801da177e4SLinus Torvalds 	return s;
2811da177e4SLinus Torvalds }
2821da177e4SLinus Torvalds 
2831da177e4SLinus Torvalds /*
2841da177e4SLinus Torvalds  *	Find a connected X.25 socket given my LCI and neighbour.
2851da177e4SLinus Torvalds  */
2861da177e4SLinus Torvalds static struct sock *__x25_find_socket(unsigned int lci, struct x25_neigh *nb)
2871da177e4SLinus Torvalds {
2881da177e4SLinus Torvalds 	struct sock *s;
2891da177e4SLinus Torvalds 	struct hlist_node *node;
2901da177e4SLinus Torvalds 
2911da177e4SLinus Torvalds 	sk_for_each(s, node, &x25_list)
2921da177e4SLinus Torvalds 		if (x25_sk(s)->lci == lci && x25_sk(s)->neighbour == nb) {
2931da177e4SLinus Torvalds 			sock_hold(s);
2941da177e4SLinus Torvalds 			goto found;
2951da177e4SLinus Torvalds 		}
2961da177e4SLinus Torvalds 	s = NULL;
2971da177e4SLinus Torvalds found:
2981da177e4SLinus Torvalds 	return s;
2991da177e4SLinus Torvalds }
3001da177e4SLinus Torvalds 
3011da177e4SLinus Torvalds struct sock *x25_find_socket(unsigned int lci, struct x25_neigh *nb)
3021da177e4SLinus Torvalds {
3031da177e4SLinus Torvalds 	struct sock *s;
3041da177e4SLinus Torvalds 
3051da177e4SLinus Torvalds 	read_lock_bh(&x25_list_lock);
3061da177e4SLinus Torvalds 	s = __x25_find_socket(lci, nb);
3071da177e4SLinus Torvalds 	read_unlock_bh(&x25_list_lock);
3081da177e4SLinus Torvalds 	return s;
3091da177e4SLinus Torvalds }
3101da177e4SLinus Torvalds 
3111da177e4SLinus Torvalds /*
3121da177e4SLinus Torvalds  *	Find a unique LCI for a given device.
3131da177e4SLinus Torvalds  */
3141da177e4SLinus Torvalds static unsigned int x25_new_lci(struct x25_neigh *nb)
3151da177e4SLinus Torvalds {
3161da177e4SLinus Torvalds 	unsigned int lci = 1;
3171da177e4SLinus Torvalds 	struct sock *sk;
3181da177e4SLinus Torvalds 
3191da177e4SLinus Torvalds 	read_lock_bh(&x25_list_lock);
3201da177e4SLinus Torvalds 
3211da177e4SLinus Torvalds 	while ((sk = __x25_find_socket(lci, nb)) != NULL) {
3221da177e4SLinus Torvalds 		sock_put(sk);
3231da177e4SLinus Torvalds 		if (++lci == 4096) {
3241da177e4SLinus Torvalds 			lci = 0;
3251da177e4SLinus Torvalds 			break;
3261da177e4SLinus Torvalds 		}
3271da177e4SLinus Torvalds 	}
3281da177e4SLinus Torvalds 
3291da177e4SLinus Torvalds 	read_unlock_bh(&x25_list_lock);
3301da177e4SLinus Torvalds 	return lci;
3311da177e4SLinus Torvalds }
3321da177e4SLinus Torvalds 
3331da177e4SLinus Torvalds /*
3341da177e4SLinus Torvalds  *	Deferred destroy.
3351da177e4SLinus Torvalds  */
33614ebaf81SDavid S. Miller static void __x25_destroy_socket(struct sock *);
3371da177e4SLinus Torvalds 
3381da177e4SLinus Torvalds /*
3391da177e4SLinus Torvalds  *	handler for deferred kills.
3401da177e4SLinus Torvalds  */
3411da177e4SLinus Torvalds static void x25_destroy_timer(unsigned long data)
3421da177e4SLinus Torvalds {
34314ebaf81SDavid S. Miller 	x25_destroy_socket_from_timer((struct sock *)data);
3441da177e4SLinus Torvalds }
3451da177e4SLinus Torvalds 
3461da177e4SLinus Torvalds /*
3471da177e4SLinus Torvalds  *	This is called from user mode and the timers. Thus it protects itself
3481da177e4SLinus Torvalds  *	against interrupt users but doesn't worry about being called during
3491da177e4SLinus Torvalds  *	work. Once it is removed from the queue no interrupt or bottom half
3501da177e4SLinus Torvalds  *	will touch it and we are (fairly 8-) ) safe.
3511da177e4SLinus Torvalds  *	Not static as it's used by the timer
3521da177e4SLinus Torvalds  */
35314ebaf81SDavid S. Miller static void __x25_destroy_socket(struct sock *sk)
3541da177e4SLinus Torvalds {
3551da177e4SLinus Torvalds 	struct sk_buff *skb;
3561da177e4SLinus Torvalds 
3571da177e4SLinus Torvalds 	x25_stop_heartbeat(sk);
3581da177e4SLinus Torvalds 	x25_stop_timer(sk);
3591da177e4SLinus Torvalds 
3601da177e4SLinus Torvalds 	x25_remove_socket(sk);
3611da177e4SLinus Torvalds 	x25_clear_queues(sk);		/* Flush the queues */
3621da177e4SLinus Torvalds 
3631da177e4SLinus Torvalds 	while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) {
3641da177e4SLinus Torvalds 		if (skb->sk != sk) {		/* A pending connection */
3651da177e4SLinus Torvalds 			/*
3661da177e4SLinus Torvalds 			 * Queue the unaccepted socket for death
3671da177e4SLinus Torvalds 			 */
3681da177e4SLinus Torvalds 			sock_set_flag(skb->sk, SOCK_DEAD);
3691da177e4SLinus Torvalds 			x25_start_heartbeat(skb->sk);
3701da177e4SLinus Torvalds 			x25_sk(skb->sk)->state = X25_STATE_0;
3711da177e4SLinus Torvalds 		}
3721da177e4SLinus Torvalds 
3731da177e4SLinus Torvalds 		kfree_skb(skb);
3741da177e4SLinus Torvalds 	}
3751da177e4SLinus Torvalds 
376c564039fSEric Dumazet 	if (sk_has_allocations(sk)) {
3771da177e4SLinus Torvalds 		/* Defer: outstanding buffers */
3781da177e4SLinus Torvalds 		sk->sk_timer.expires  = jiffies + 10 * HZ;
3791da177e4SLinus Torvalds 		sk->sk_timer.function = x25_destroy_timer;
3801da177e4SLinus Torvalds 		sk->sk_timer.data = (unsigned long)sk;
3811da177e4SLinus Torvalds 		add_timer(&sk->sk_timer);
3821da177e4SLinus Torvalds 	} else {
3831da177e4SLinus Torvalds 		/* drop last reference so sock_put will free */
3841da177e4SLinus Torvalds 		__sock_put(sk);
3851da177e4SLinus Torvalds 	}
38614ebaf81SDavid S. Miller }
3871da177e4SLinus Torvalds 
38814ebaf81SDavid S. Miller void x25_destroy_socket_from_timer(struct sock *sk)
38914ebaf81SDavid S. Miller {
39014ebaf81SDavid S. Miller 	sock_hold(sk);
39114ebaf81SDavid S. Miller 	bh_lock_sock(sk);
39214ebaf81SDavid S. Miller 	__x25_destroy_socket(sk);
39314ebaf81SDavid S. Miller 	bh_unlock_sock(sk);
39414ebaf81SDavid S. Miller 	sock_put(sk);
39514ebaf81SDavid S. Miller }
39614ebaf81SDavid S. Miller 
39714ebaf81SDavid S. Miller static void x25_destroy_socket(struct sock *sk)
39814ebaf81SDavid S. Miller {
39914ebaf81SDavid S. Miller 	sock_hold(sk);
40014ebaf81SDavid S. Miller 	lock_sock(sk);
40114ebaf81SDavid S. Miller 	__x25_destroy_socket(sk);
4021da177e4SLinus Torvalds 	release_sock(sk);
4031da177e4SLinus Torvalds 	sock_put(sk);
4041da177e4SLinus Torvalds }
4051da177e4SLinus Torvalds 
4061da177e4SLinus Torvalds /*
4071da177e4SLinus Torvalds  *	Handling for system calls applied via the various interfaces to a
4081da177e4SLinus Torvalds  *	X.25 socket object.
4091da177e4SLinus Torvalds  */
4101da177e4SLinus Torvalds 
4111da177e4SLinus Torvalds static int x25_setsockopt(struct socket *sock, int level, int optname,
412*b7058842SDavid S. Miller 			  char __user *optval, unsigned int optlen)
4131da177e4SLinus Torvalds {
4141da177e4SLinus Torvalds 	int opt;
4151da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
4161da177e4SLinus Torvalds 	int rc = -ENOPROTOOPT;
4171da177e4SLinus Torvalds 
4181da177e4SLinus Torvalds 	if (level != SOL_X25 || optname != X25_QBITINCL)
4191da177e4SLinus Torvalds 		goto out;
4201da177e4SLinus Torvalds 
4211da177e4SLinus Torvalds 	rc = -EINVAL;
4221da177e4SLinus Torvalds 	if (optlen < sizeof(int))
4231da177e4SLinus Torvalds 		goto out;
4241da177e4SLinus Torvalds 
4251da177e4SLinus Torvalds 	rc = -EFAULT;
4261da177e4SLinus Torvalds 	if (get_user(opt, (int __user *)optval))
4271da177e4SLinus Torvalds 		goto out;
4281da177e4SLinus Torvalds 
4291da177e4SLinus Torvalds 	x25_sk(sk)->qbitincl = !!opt;
4301da177e4SLinus Torvalds 	rc = 0;
4311da177e4SLinus Torvalds out:
4321da177e4SLinus Torvalds 	return rc;
4331da177e4SLinus Torvalds }
4341da177e4SLinus Torvalds 
4351da177e4SLinus Torvalds static int x25_getsockopt(struct socket *sock, int level, int optname,
4361da177e4SLinus Torvalds 			  char __user *optval, int __user *optlen)
4371da177e4SLinus Torvalds {
4381da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
4391da177e4SLinus Torvalds 	int val, len, rc = -ENOPROTOOPT;
4401da177e4SLinus Torvalds 
4411da177e4SLinus Torvalds 	if (level != SOL_X25 || optname != X25_QBITINCL)
4421da177e4SLinus Torvalds 		goto out;
4431da177e4SLinus Torvalds 
4441da177e4SLinus Torvalds 	rc = -EFAULT;
4451da177e4SLinus Torvalds 	if (get_user(len, optlen))
4461da177e4SLinus Torvalds 		goto out;
4471da177e4SLinus Torvalds 
4481da177e4SLinus Torvalds 	len = min_t(unsigned int, len, sizeof(int));
4491da177e4SLinus Torvalds 
4501da177e4SLinus Torvalds 	rc = -EINVAL;
4511da177e4SLinus Torvalds 	if (len < 0)
4521da177e4SLinus Torvalds 		goto out;
4531da177e4SLinus Torvalds 
4541da177e4SLinus Torvalds 	rc = -EFAULT;
4551da177e4SLinus Torvalds 	if (put_user(len, optlen))
4561da177e4SLinus Torvalds 		goto out;
4571da177e4SLinus Torvalds 
4581da177e4SLinus Torvalds 	val = x25_sk(sk)->qbitincl;
4591da177e4SLinus Torvalds 	rc = copy_to_user(optval, &val, len) ? -EFAULT : 0;
4601da177e4SLinus Torvalds out:
4611da177e4SLinus Torvalds 	return rc;
4621da177e4SLinus Torvalds }
4631da177e4SLinus Torvalds 
4641da177e4SLinus Torvalds static int x25_listen(struct socket *sock, int backlog)
4651da177e4SLinus Torvalds {
4661da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
4671da177e4SLinus Torvalds 	int rc = -EOPNOTSUPP;
4681da177e4SLinus Torvalds 
4691da177e4SLinus Torvalds 	if (sk->sk_state != TCP_LISTEN) {
4701da177e4SLinus Torvalds 		memset(&x25_sk(sk)->dest_addr, 0, X25_ADDR_LEN);
4711da177e4SLinus Torvalds 		sk->sk_max_ack_backlog = backlog;
4721da177e4SLinus Torvalds 		sk->sk_state           = TCP_LISTEN;
4731da177e4SLinus Torvalds 		rc = 0;
4741da177e4SLinus Torvalds 	}
4751da177e4SLinus Torvalds 
4761da177e4SLinus Torvalds 	return rc;
4771da177e4SLinus Torvalds }
4781da177e4SLinus Torvalds 
4791da177e4SLinus Torvalds static struct proto x25_proto = {
4801da177e4SLinus Torvalds 	.name	  = "X25",
4811da177e4SLinus Torvalds 	.owner	  = THIS_MODULE,
4821da177e4SLinus Torvalds 	.obj_size = sizeof(struct x25_sock),
4831da177e4SLinus Torvalds };
4841da177e4SLinus Torvalds 
4851b8d7ae4SEric W. Biederman static struct sock *x25_alloc_socket(struct net *net)
4861da177e4SLinus Torvalds {
4871da177e4SLinus Torvalds 	struct x25_sock *x25;
4886257ff21SPavel Emelyanov 	struct sock *sk = sk_alloc(net, AF_X25, GFP_ATOMIC, &x25_proto);
4891da177e4SLinus Torvalds 
4901da177e4SLinus Torvalds 	if (!sk)
4911da177e4SLinus Torvalds 		goto out;
4921da177e4SLinus Torvalds 
4931da177e4SLinus Torvalds 	sock_init_data(NULL, sk);
4941da177e4SLinus Torvalds 
4951da177e4SLinus Torvalds 	x25 = x25_sk(sk);
4961da177e4SLinus Torvalds 	skb_queue_head_init(&x25->ack_queue);
4971da177e4SLinus Torvalds 	skb_queue_head_init(&x25->fragment_queue);
4981da177e4SLinus Torvalds 	skb_queue_head_init(&x25->interrupt_in_queue);
4991da177e4SLinus Torvalds 	skb_queue_head_init(&x25->interrupt_out_queue);
5001da177e4SLinus Torvalds out:
5011da177e4SLinus Torvalds 	return sk;
5021da177e4SLinus Torvalds }
5031da177e4SLinus Torvalds 
5041b8d7ae4SEric W. Biederman static int x25_create(struct net *net, struct socket *sock, int protocol)
5051da177e4SLinus Torvalds {
5061da177e4SLinus Torvalds 	struct sock *sk;
5071da177e4SLinus Torvalds 	struct x25_sock *x25;
5081da177e4SLinus Torvalds 	int rc = -ESOCKTNOSUPPORT;
5091da177e4SLinus Torvalds 
5101b8d7ae4SEric W. Biederman 	if (net != &init_net)
5111b8d7ae4SEric W. Biederman 		return -EAFNOSUPPORT;
5121b8d7ae4SEric W. Biederman 
5131da177e4SLinus Torvalds 	if (sock->type != SOCK_SEQPACKET || protocol)
5141da177e4SLinus Torvalds 		goto out;
5151da177e4SLinus Torvalds 
5161da177e4SLinus Torvalds 	rc = -ENOMEM;
5171b8d7ae4SEric W. Biederman 	if ((sk = x25_alloc_socket(net)) == NULL)
5181da177e4SLinus Torvalds 		goto out;
5191da177e4SLinus Torvalds 
5201da177e4SLinus Torvalds 	x25 = x25_sk(sk);
5211da177e4SLinus Torvalds 
5221da177e4SLinus Torvalds 	sock_init_data(sock, sk);
5231da177e4SLinus Torvalds 
5241da177e4SLinus Torvalds 	x25_init_timers(sk);
5251da177e4SLinus Torvalds 
5261da177e4SLinus Torvalds 	sock->ops    = &x25_proto_ops;
5271da177e4SLinus Torvalds 	sk->sk_protocol = protocol;
5281da177e4SLinus Torvalds 	sk->sk_backlog_rcv = x25_backlog_rcv;
5291da177e4SLinus Torvalds 
5301da177e4SLinus Torvalds 	x25->t21   = sysctl_x25_call_request_timeout;
5311da177e4SLinus Torvalds 	x25->t22   = sysctl_x25_reset_request_timeout;
5321da177e4SLinus Torvalds 	x25->t23   = sysctl_x25_clear_request_timeout;
5331da177e4SLinus Torvalds 	x25->t2    = sysctl_x25_ack_holdback_timeout;
5341da177e4SLinus Torvalds 	x25->state = X25_STATE_0;
535cb65d506SShaun Pereira 	x25->cudmatchlength = 0;
536ebc3f64bSShaun Pereira 	x25->accptapprv = X25_DENY_ACCPT_APPRV;		/* normally no cud  */
537ebc3f64bSShaun Pereira 							/* on call accept   */
5381da177e4SLinus Torvalds 
5391da177e4SLinus Torvalds 	x25->facilities.winsize_in  = X25_DEFAULT_WINDOW_SIZE;
5401da177e4SLinus Torvalds 	x25->facilities.winsize_out = X25_DEFAULT_WINDOW_SIZE;
5411da177e4SLinus Torvalds 	x25->facilities.pacsize_in  = X25_DEFAULT_PACKET_SIZE;
5421da177e4SLinus Torvalds 	x25->facilities.pacsize_out = X25_DEFAULT_PACKET_SIZE;
5431da177e4SLinus Torvalds 	x25->facilities.throughput  = X25_DEFAULT_THROUGHPUT;
5441da177e4SLinus Torvalds 	x25->facilities.reverse     = X25_DEFAULT_REVERSE;
545a64b7b93SShaun Pereira 	x25->dte_facilities.calling_len = 0;
546a64b7b93SShaun Pereira 	x25->dte_facilities.called_len = 0;
547a64b7b93SShaun Pereira 	memset(x25->dte_facilities.called_ae, '\0',
548a64b7b93SShaun Pereira 			sizeof(x25->dte_facilities.called_ae));
549a64b7b93SShaun Pereira 	memset(x25->dte_facilities.calling_ae, '\0',
550a64b7b93SShaun Pereira 			sizeof(x25->dte_facilities.calling_ae));
551a64b7b93SShaun Pereira 
5521da177e4SLinus Torvalds 	rc = 0;
5531da177e4SLinus Torvalds out:
5541da177e4SLinus Torvalds 	return rc;
5551da177e4SLinus Torvalds }
5561da177e4SLinus Torvalds 
5571da177e4SLinus Torvalds static struct sock *x25_make_new(struct sock *osk)
5581da177e4SLinus Torvalds {
5591da177e4SLinus Torvalds 	struct sock *sk = NULL;
5601da177e4SLinus Torvalds 	struct x25_sock *x25, *ox25;
5611da177e4SLinus Torvalds 
5621da177e4SLinus Torvalds 	if (osk->sk_type != SOCK_SEQPACKET)
5631da177e4SLinus Torvalds 		goto out;
5641da177e4SLinus Torvalds 
5653b1e0a65SYOSHIFUJI Hideaki 	if ((sk = x25_alloc_socket(sock_net(osk))) == NULL)
5661da177e4SLinus Torvalds 		goto out;
5671da177e4SLinus Torvalds 
5681da177e4SLinus Torvalds 	x25 = x25_sk(sk);
5691da177e4SLinus Torvalds 
5701da177e4SLinus Torvalds 	sk->sk_type        = osk->sk_type;
5711da177e4SLinus Torvalds 	sk->sk_priority    = osk->sk_priority;
5721da177e4SLinus Torvalds 	sk->sk_protocol    = osk->sk_protocol;
5731da177e4SLinus Torvalds 	sk->sk_rcvbuf      = osk->sk_rcvbuf;
5741da177e4SLinus Torvalds 	sk->sk_sndbuf      = osk->sk_sndbuf;
5751da177e4SLinus Torvalds 	sk->sk_state       = TCP_ESTABLISHED;
5761da177e4SLinus Torvalds 	sk->sk_backlog_rcv = osk->sk_backlog_rcv;
577a20a8554SShaun Pereira 	sock_copy_flags(sk, osk);
5781da177e4SLinus Torvalds 
5791da177e4SLinus Torvalds 	ox25 = x25_sk(osk);
5801da177e4SLinus Torvalds 	x25->t21        = ox25->t21;
5811da177e4SLinus Torvalds 	x25->t22        = ox25->t22;
5821da177e4SLinus Torvalds 	x25->t23        = ox25->t23;
5831da177e4SLinus Torvalds 	x25->t2         = ox25->t2;
5841da177e4SLinus Torvalds 	x25->facilities = ox25->facilities;
5851da177e4SLinus Torvalds 	x25->qbitincl   = ox25->qbitincl;
586a64b7b93SShaun Pereira 	x25->dte_facilities = ox25->dte_facilities;
587cb65d506SShaun Pereira 	x25->cudmatchlength = ox25->cudmatchlength;
588ebc3f64bSShaun Pereira 	x25->accptapprv = ox25->accptapprv;
5891da177e4SLinus Torvalds 
5901da177e4SLinus Torvalds 	x25_init_timers(sk);
5911da177e4SLinus Torvalds out:
5921da177e4SLinus Torvalds 	return sk;
5931da177e4SLinus Torvalds }
5941da177e4SLinus Torvalds 
5951da177e4SLinus Torvalds static int x25_release(struct socket *sock)
5961da177e4SLinus Torvalds {
5971da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
5981da177e4SLinus Torvalds 	struct x25_sock *x25;
5991da177e4SLinus Torvalds 
6001da177e4SLinus Torvalds 	if (!sk)
6011da177e4SLinus Torvalds 		goto out;
6021da177e4SLinus Torvalds 
6031da177e4SLinus Torvalds 	x25 = x25_sk(sk);
6041da177e4SLinus Torvalds 
6051da177e4SLinus Torvalds 	switch (x25->state) {
6061da177e4SLinus Torvalds 
6071da177e4SLinus Torvalds 		case X25_STATE_0:
6081da177e4SLinus Torvalds 		case X25_STATE_2:
6091da177e4SLinus Torvalds 			x25_disconnect(sk, 0, 0, 0);
6101da177e4SLinus Torvalds 			x25_destroy_socket(sk);
6111da177e4SLinus Torvalds 			goto out;
6121da177e4SLinus Torvalds 
6131da177e4SLinus Torvalds 		case X25_STATE_1:
6141da177e4SLinus Torvalds 		case X25_STATE_3:
6151da177e4SLinus Torvalds 		case X25_STATE_4:
6161da177e4SLinus Torvalds 			x25_clear_queues(sk);
6171da177e4SLinus Torvalds 			x25_write_internal(sk, X25_CLEAR_REQUEST);
6181da177e4SLinus Torvalds 			x25_start_t23timer(sk);
6191da177e4SLinus Torvalds 			x25->state = X25_STATE_2;
6201da177e4SLinus Torvalds 			sk->sk_state	= TCP_CLOSE;
6211da177e4SLinus Torvalds 			sk->sk_shutdown	|= SEND_SHUTDOWN;
6221da177e4SLinus Torvalds 			sk->sk_state_change(sk);
6231da177e4SLinus Torvalds 			sock_set_flag(sk, SOCK_DEAD);
6241da177e4SLinus Torvalds 			sock_set_flag(sk, SOCK_DESTROY);
6251da177e4SLinus Torvalds 			break;
6261da177e4SLinus Torvalds 	}
6271da177e4SLinus Torvalds 
628c751e4f8SDavid S. Miller 	sock_orphan(sk);
6291da177e4SLinus Torvalds out:
6301da177e4SLinus Torvalds 	return 0;
6311da177e4SLinus Torvalds }
6321da177e4SLinus Torvalds 
6331da177e4SLinus Torvalds static int x25_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len)
6341da177e4SLinus Torvalds {
6351da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
6361da177e4SLinus Torvalds 	struct sockaddr_x25 *addr = (struct sockaddr_x25 *)uaddr;
6371da177e4SLinus Torvalds 
6381da177e4SLinus Torvalds 	if (!sock_flag(sk, SOCK_ZAPPED) ||
6391da177e4SLinus Torvalds 	    addr_len != sizeof(struct sockaddr_x25) ||
6401da177e4SLinus Torvalds 	    addr->sx25_family != AF_X25)
6411da177e4SLinus Torvalds 		return -EINVAL;
6421da177e4SLinus Torvalds 
6431da177e4SLinus Torvalds 	x25_sk(sk)->source_addr = addr->sx25_addr;
6441da177e4SLinus Torvalds 	x25_insert_socket(sk);
6451da177e4SLinus Torvalds 	sock_reset_flag(sk, SOCK_ZAPPED);
6461da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_bind: socket is bound\n");
6471da177e4SLinus Torvalds 
6481da177e4SLinus Torvalds 	return 0;
6491da177e4SLinus Torvalds }
6501da177e4SLinus Torvalds 
6511da177e4SLinus Torvalds static int x25_wait_for_connection_establishment(struct sock *sk)
6521da177e4SLinus Torvalds {
6531da177e4SLinus Torvalds 	DECLARE_WAITQUEUE(wait, current);
6541da177e4SLinus Torvalds 	int rc;
6551da177e4SLinus Torvalds 
6561da177e4SLinus Torvalds 	add_wait_queue_exclusive(sk->sk_sleep, &wait);
6571da177e4SLinus Torvalds 	for (;;) {
6581da177e4SLinus Torvalds 		__set_current_state(TASK_INTERRUPTIBLE);
6591da177e4SLinus Torvalds 		rc = -ERESTARTSYS;
6601da177e4SLinus Torvalds 		if (signal_pending(current))
6611da177e4SLinus Torvalds 			break;
6621da177e4SLinus Torvalds 		rc = sock_error(sk);
6631da177e4SLinus Torvalds 		if (rc) {
6641da177e4SLinus Torvalds 			sk->sk_socket->state = SS_UNCONNECTED;
6651da177e4SLinus Torvalds 			break;
6661da177e4SLinus Torvalds 		}
6671da177e4SLinus Torvalds 		rc = 0;
6681da177e4SLinus Torvalds 		if (sk->sk_state != TCP_ESTABLISHED) {
6691da177e4SLinus Torvalds 			release_sock(sk);
6701da177e4SLinus Torvalds 			schedule();
6711da177e4SLinus Torvalds 			lock_sock(sk);
6721da177e4SLinus Torvalds 		} else
6731da177e4SLinus Torvalds 			break;
6741da177e4SLinus Torvalds 	}
6751da177e4SLinus Torvalds 	__set_current_state(TASK_RUNNING);
6761da177e4SLinus Torvalds 	remove_wait_queue(sk->sk_sleep, &wait);
6771da177e4SLinus Torvalds 	return rc;
6781da177e4SLinus Torvalds }
6791da177e4SLinus Torvalds 
6801da177e4SLinus Torvalds static int x25_connect(struct socket *sock, struct sockaddr *uaddr,
6811da177e4SLinus Torvalds 		       int addr_len, int flags)
6821da177e4SLinus Torvalds {
6831da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
6841da177e4SLinus Torvalds 	struct x25_sock *x25 = x25_sk(sk);
6851da177e4SLinus Torvalds 	struct sockaddr_x25 *addr = (struct sockaddr_x25 *)uaddr;
6861da177e4SLinus Torvalds 	struct x25_route *rt;
6871da177e4SLinus Torvalds 	int rc = 0;
6881da177e4SLinus Torvalds 
6891da177e4SLinus Torvalds 	lock_sock(sk);
6901da177e4SLinus Torvalds 	if (sk->sk_state == TCP_ESTABLISHED && sock->state == SS_CONNECTING) {
6911da177e4SLinus Torvalds 		sock->state = SS_CONNECTED;
6921da177e4SLinus Torvalds 		goto out; /* Connect completed during a ERESTARTSYS event */
6931da177e4SLinus Torvalds 	}
6941da177e4SLinus Torvalds 
6951da177e4SLinus Torvalds 	rc = -ECONNREFUSED;
6961da177e4SLinus Torvalds 	if (sk->sk_state == TCP_CLOSE && sock->state == SS_CONNECTING) {
6971da177e4SLinus Torvalds 		sock->state = SS_UNCONNECTED;
6981da177e4SLinus Torvalds 		goto out;
6991da177e4SLinus Torvalds 	}
7001da177e4SLinus Torvalds 
7011da177e4SLinus Torvalds 	rc = -EISCONN;	/* No reconnect on a seqpacket socket */
7021da177e4SLinus Torvalds 	if (sk->sk_state == TCP_ESTABLISHED)
7031da177e4SLinus Torvalds 		goto out;
7041da177e4SLinus Torvalds 
7051da177e4SLinus Torvalds 	sk->sk_state   = TCP_CLOSE;
7061da177e4SLinus Torvalds 	sock->state = SS_UNCONNECTED;
7071da177e4SLinus Torvalds 
7081da177e4SLinus Torvalds 	rc = -EINVAL;
7091da177e4SLinus Torvalds 	if (addr_len != sizeof(struct sockaddr_x25) ||
7101da177e4SLinus Torvalds 	    addr->sx25_family != AF_X25)
7111da177e4SLinus Torvalds 		goto out;
7121da177e4SLinus Torvalds 
7131da177e4SLinus Torvalds 	rc = -ENETUNREACH;
7141da177e4SLinus Torvalds 	rt = x25_get_route(&addr->sx25_addr);
7151da177e4SLinus Torvalds 	if (!rt)
7161da177e4SLinus Torvalds 		goto out;
7171da177e4SLinus Torvalds 
7181da177e4SLinus Torvalds 	x25->neighbour = x25_get_neigh(rt->dev);
7191da177e4SLinus Torvalds 	if (!x25->neighbour)
7201da177e4SLinus Torvalds 		goto out_put_route;
7211da177e4SLinus Torvalds 
7221da177e4SLinus Torvalds 	x25_limit_facilities(&x25->facilities, x25->neighbour);
7231da177e4SLinus Torvalds 
7241da177e4SLinus Torvalds 	x25->lci = x25_new_lci(x25->neighbour);
7251da177e4SLinus Torvalds 	if (!x25->lci)
7261da177e4SLinus Torvalds 		goto out_put_neigh;
7271da177e4SLinus Torvalds 
7281da177e4SLinus Torvalds 	rc = -EINVAL;
7291da177e4SLinus Torvalds 	if (sock_flag(sk, SOCK_ZAPPED)) /* Must bind first - autobinding does not work */
7301da177e4SLinus Torvalds 		goto out_put_neigh;
7311da177e4SLinus Torvalds 
7321da177e4SLinus Torvalds 	if (!strcmp(x25->source_addr.x25_addr, null_x25_address.x25_addr))
7331da177e4SLinus Torvalds 		memset(&x25->source_addr, '\0', X25_ADDR_LEN);
7341da177e4SLinus Torvalds 
7351da177e4SLinus Torvalds 	x25->dest_addr = addr->sx25_addr;
7361da177e4SLinus Torvalds 
7371da177e4SLinus Torvalds 	/* Move to connecting socket, start sending Connect Requests */
7381da177e4SLinus Torvalds 	sock->state   = SS_CONNECTING;
7391da177e4SLinus Torvalds 	sk->sk_state  = TCP_SYN_SENT;
7401da177e4SLinus Torvalds 
7411da177e4SLinus Torvalds 	x25->state = X25_STATE_1;
7421da177e4SLinus Torvalds 
7431da177e4SLinus Torvalds 	x25_write_internal(sk, X25_CALL_REQUEST);
7441da177e4SLinus Torvalds 
7451da177e4SLinus Torvalds 	x25_start_heartbeat(sk);
7461da177e4SLinus Torvalds 	x25_start_t21timer(sk);
7471da177e4SLinus Torvalds 
7481da177e4SLinus Torvalds 	/* Now the loop */
7491da177e4SLinus Torvalds 	rc = -EINPROGRESS;
7501da177e4SLinus Torvalds 	if (sk->sk_state != TCP_ESTABLISHED && (flags & O_NONBLOCK))
7511da177e4SLinus Torvalds 		goto out_put_neigh;
7521da177e4SLinus Torvalds 
7531da177e4SLinus Torvalds 	rc = x25_wait_for_connection_establishment(sk);
7541da177e4SLinus Torvalds 	if (rc)
7551da177e4SLinus Torvalds 		goto out_put_neigh;
7561da177e4SLinus Torvalds 
7571da177e4SLinus Torvalds 	sock->state = SS_CONNECTED;
7581da177e4SLinus Torvalds 	rc = 0;
7591da177e4SLinus Torvalds out_put_neigh:
7601da177e4SLinus Torvalds 	if (rc)
7611da177e4SLinus Torvalds 		x25_neigh_put(x25->neighbour);
7621da177e4SLinus Torvalds out_put_route:
7631da177e4SLinus Torvalds 	x25_route_put(rt);
7641da177e4SLinus Torvalds out:
7651da177e4SLinus Torvalds 	release_sock(sk);
7661da177e4SLinus Torvalds 	return rc;
7671da177e4SLinus Torvalds }
7681da177e4SLinus Torvalds 
769bac37ec8SShaun Pereira static int x25_wait_for_data(struct sock *sk, long timeout)
7701da177e4SLinus Torvalds {
7711da177e4SLinus Torvalds 	DECLARE_WAITQUEUE(wait, current);
7721da177e4SLinus Torvalds 	int rc = 0;
7731da177e4SLinus Torvalds 
7741da177e4SLinus Torvalds 	add_wait_queue_exclusive(sk->sk_sleep, &wait);
7751da177e4SLinus Torvalds 	for (;;) {
7761da177e4SLinus Torvalds 		__set_current_state(TASK_INTERRUPTIBLE);
7771da177e4SLinus Torvalds 		if (sk->sk_shutdown & RCV_SHUTDOWN)
7781da177e4SLinus Torvalds 			break;
7791da177e4SLinus Torvalds 		rc = -ERESTARTSYS;
7801da177e4SLinus Torvalds 		if (signal_pending(current))
7811da177e4SLinus Torvalds 			break;
7821da177e4SLinus Torvalds 		rc = -EAGAIN;
7831da177e4SLinus Torvalds 		if (!timeout)
7841da177e4SLinus Torvalds 			break;
7851da177e4SLinus Torvalds 		rc = 0;
7861da177e4SLinus Torvalds 		if (skb_queue_empty(&sk->sk_receive_queue)) {
7871da177e4SLinus Torvalds 			release_sock(sk);
7881da177e4SLinus Torvalds 			timeout = schedule_timeout(timeout);
7891da177e4SLinus Torvalds 			lock_sock(sk);
7901da177e4SLinus Torvalds 		} else
7911da177e4SLinus Torvalds 			break;
7921da177e4SLinus Torvalds 	}
7931da177e4SLinus Torvalds 	__set_current_state(TASK_RUNNING);
7941da177e4SLinus Torvalds 	remove_wait_queue(sk->sk_sleep, &wait);
7951da177e4SLinus Torvalds 	return rc;
7961da177e4SLinus Torvalds }
7971da177e4SLinus Torvalds 
7981da177e4SLinus Torvalds static int x25_accept(struct socket *sock, struct socket *newsock, int flags)
7991da177e4SLinus Torvalds {
8001da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
8011da177e4SLinus Torvalds 	struct sock *newsk;
8021da177e4SLinus Torvalds 	struct sk_buff *skb;
8031da177e4SLinus Torvalds 	int rc = -EINVAL;
8041da177e4SLinus Torvalds 
8051da177e4SLinus Torvalds 	if (!sk || sk->sk_state != TCP_LISTEN)
8061da177e4SLinus Torvalds 		goto out;
8071da177e4SLinus Torvalds 
8081da177e4SLinus Torvalds 	rc = -EOPNOTSUPP;
8091da177e4SLinus Torvalds 	if (sk->sk_type != SOCK_SEQPACKET)
8101da177e4SLinus Torvalds 		goto out;
8111da177e4SLinus Torvalds 
8121da177e4SLinus Torvalds 	lock_sock(sk);
8131da177e4SLinus Torvalds 	rc = x25_wait_for_data(sk, sk->sk_rcvtimeo);
8141da177e4SLinus Torvalds 	if (rc)
8151da177e4SLinus Torvalds 		goto out2;
8161da177e4SLinus Torvalds 	skb = skb_dequeue(&sk->sk_receive_queue);
8171da177e4SLinus Torvalds 	rc = -EINVAL;
8181da177e4SLinus Torvalds 	if (!skb->sk)
8191da177e4SLinus Torvalds 		goto out2;
8201da177e4SLinus Torvalds 	newsk		 = skb->sk;
821b61d38e0SDavid S. Miller 	sock_graft(newsk, newsock);
8221da177e4SLinus Torvalds 
8231da177e4SLinus Torvalds 	/* Now attach up the new socket */
8241da177e4SLinus Torvalds 	skb->sk = NULL;
8251da177e4SLinus Torvalds 	kfree_skb(skb);
8261da177e4SLinus Torvalds 	sk->sk_ack_backlog--;
8271da177e4SLinus Torvalds 	newsock->state = SS_CONNECTED;
8281da177e4SLinus Torvalds 	rc = 0;
8291da177e4SLinus Torvalds out2:
8301da177e4SLinus Torvalds 	release_sock(sk);
8311da177e4SLinus Torvalds out:
8321da177e4SLinus Torvalds 	return rc;
8331da177e4SLinus Torvalds }
8341da177e4SLinus Torvalds 
8351da177e4SLinus Torvalds static int x25_getname(struct socket *sock, struct sockaddr *uaddr,
8361da177e4SLinus Torvalds 		       int *uaddr_len, int peer)
8371da177e4SLinus Torvalds {
8381da177e4SLinus Torvalds 	struct sockaddr_x25 *sx25 = (struct sockaddr_x25 *)uaddr;
8391da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
8401da177e4SLinus Torvalds 	struct x25_sock *x25 = x25_sk(sk);
8411da177e4SLinus Torvalds 
8421da177e4SLinus Torvalds 	if (peer) {
8431da177e4SLinus Torvalds 		if (sk->sk_state != TCP_ESTABLISHED)
8441da177e4SLinus Torvalds 			return -ENOTCONN;
8451da177e4SLinus Torvalds 		sx25->sx25_addr = x25->dest_addr;
8461da177e4SLinus Torvalds 	} else
8471da177e4SLinus Torvalds 		sx25->sx25_addr = x25->source_addr;
8481da177e4SLinus Torvalds 
8491da177e4SLinus Torvalds 	sx25->sx25_family = AF_X25;
8501da177e4SLinus Torvalds 	*uaddr_len = sizeof(*sx25);
8511da177e4SLinus Torvalds 
8521da177e4SLinus Torvalds 	return 0;
8531da177e4SLinus Torvalds }
8541da177e4SLinus Torvalds 
8551da177e4SLinus Torvalds int x25_rx_call_request(struct sk_buff *skb, struct x25_neigh *nb,
8561da177e4SLinus Torvalds 			unsigned int lci)
8571da177e4SLinus Torvalds {
8581da177e4SLinus Torvalds 	struct sock *sk;
8591da177e4SLinus Torvalds 	struct sock *make;
8601da177e4SLinus Torvalds 	struct x25_sock *makex25;
8611da177e4SLinus Torvalds 	struct x25_address source_addr, dest_addr;
8621da177e4SLinus Torvalds 	struct x25_facilities facilities;
863a64b7b93SShaun Pereira 	struct x25_dte_facilities dte_facilities;
86495a9dc43SAndrew Hendry 	int len, addr_len, rc;
8651da177e4SLinus Torvalds 
8661da177e4SLinus Torvalds 	/*
8671da177e4SLinus Torvalds 	 *	Remove the LCI and frame type.
8681da177e4SLinus Torvalds 	 */
8691da177e4SLinus Torvalds 	skb_pull(skb, X25_STD_MIN_LEN);
8701da177e4SLinus Torvalds 
8711da177e4SLinus Torvalds 	/*
8721da177e4SLinus Torvalds 	 *	Extract the X.25 addresses and convert them to ASCII strings,
8731da177e4SLinus Torvalds 	 *	and remove them.
8741da177e4SLinus Torvalds 	 */
87595a9dc43SAndrew Hendry 	addr_len = x25_addr_ntoa(skb->data, &source_addr, &dest_addr);
87695a9dc43SAndrew Hendry 	skb_pull(skb, addr_len);
8771da177e4SLinus Torvalds 
8781da177e4SLinus Torvalds 	/*
8791da177e4SLinus Torvalds 	 *	Get the length of the facilities, skip past them for the moment
8801da177e4SLinus Torvalds 	 *	get the call user data because this is needed to determine
8811da177e4SLinus Torvalds 	 *	the correct listener
8821da177e4SLinus Torvalds 	 */
8831da177e4SLinus Torvalds 	len = skb->data[0] + 1;
8841da177e4SLinus Torvalds 	skb_pull(skb,len);
8851da177e4SLinus Torvalds 
8861da177e4SLinus Torvalds 	/*
8871da177e4SLinus Torvalds 	 *	Find a listener for the particular address/cud pair.
8881da177e4SLinus Torvalds 	 */
889cb65d506SShaun Pereira 	sk = x25_find_listener(&source_addr,skb);
890cb65d506SShaun Pereira 	skb_push(skb,len);
8911da177e4SLinus Torvalds 
89295a9dc43SAndrew Hendry 	if (sk != NULL && sk_acceptq_is_full(sk)) {
89395a9dc43SAndrew Hendry 		goto out_sock_put;
89495a9dc43SAndrew Hendry 	}
89595a9dc43SAndrew Hendry 
8961da177e4SLinus Torvalds 	/*
89795a9dc43SAndrew Hendry 	 *	We dont have any listeners for this incoming call.
89895a9dc43SAndrew Hendry 	 *	Try forwarding it.
8991da177e4SLinus Torvalds 	 */
90095a9dc43SAndrew Hendry 	if (sk == NULL) {
90195a9dc43SAndrew Hendry 		skb_push(skb, addr_len + X25_STD_MIN_LEN);
90239e21c0dSAndrew Hendry 		if (sysctl_x25_forward &&
90339e21c0dSAndrew Hendry 				x25_forward_call(&dest_addr, nb, skb, lci) > 0)
90495a9dc43SAndrew Hendry 		{
90595a9dc43SAndrew Hendry 			/* Call was forwarded, dont process it any more */
90695a9dc43SAndrew Hendry 			kfree_skb(skb);
90795a9dc43SAndrew Hendry 			rc = 1;
90895a9dc43SAndrew Hendry 			goto out;
90995a9dc43SAndrew Hendry 		} else {
91095a9dc43SAndrew Hendry 			/* No listeners, can't forward, clear the call */
9111da177e4SLinus Torvalds 			goto out_clear_request;
91295a9dc43SAndrew Hendry 		}
91395a9dc43SAndrew Hendry 	}
9141da177e4SLinus Torvalds 
9151da177e4SLinus Torvalds 	/*
9161da177e4SLinus Torvalds 	 *	Try to reach a compromise on the requested facilities.
9171da177e4SLinus Torvalds 	 */
918a64b7b93SShaun Pereira 	len = x25_negotiate_facilities(skb, sk, &facilities, &dte_facilities);
919a64b7b93SShaun Pereira 	if (len == -1)
9201da177e4SLinus Torvalds 		goto out_sock_put;
9211da177e4SLinus Torvalds 
9221da177e4SLinus Torvalds 	/*
9231da177e4SLinus Torvalds 	 * current neighbour/link might impose additional limits
9241da177e4SLinus Torvalds 	 * on certain facilties
9251da177e4SLinus Torvalds 	 */
9261da177e4SLinus Torvalds 
9271da177e4SLinus Torvalds 	x25_limit_facilities(&facilities, nb);
9281da177e4SLinus Torvalds 
9291da177e4SLinus Torvalds 	/*
9301da177e4SLinus Torvalds 	 *	Try to create a new socket.
9311da177e4SLinus Torvalds 	 */
9321da177e4SLinus Torvalds 	make = x25_make_new(sk);
9331da177e4SLinus Torvalds 	if (!make)
9341da177e4SLinus Torvalds 		goto out_sock_put;
9351da177e4SLinus Torvalds 
9361da177e4SLinus Torvalds 	/*
9371da177e4SLinus Torvalds 	 *	Remove the facilities
9381da177e4SLinus Torvalds 	 */
9391da177e4SLinus Torvalds 	skb_pull(skb, len);
9401da177e4SLinus Torvalds 
9411da177e4SLinus Torvalds 	skb->sk     = make;
9421da177e4SLinus Torvalds 	make->sk_state = TCP_ESTABLISHED;
9431da177e4SLinus Torvalds 
9441da177e4SLinus Torvalds 	makex25 = x25_sk(make);
9451da177e4SLinus Torvalds 	makex25->lci           = lci;
9461da177e4SLinus Torvalds 	makex25->dest_addr     = dest_addr;
9471da177e4SLinus Torvalds 	makex25->source_addr   = source_addr;
9481da177e4SLinus Torvalds 	makex25->neighbour     = nb;
9491da177e4SLinus Torvalds 	makex25->facilities    = facilities;
950a64b7b93SShaun Pereira 	makex25->dte_facilities= dte_facilities;
9511da177e4SLinus Torvalds 	makex25->vc_facil_mask = x25_sk(sk)->vc_facil_mask;
952cb65d506SShaun Pereira 	/* ensure no reverse facil on accept */
953cb65d506SShaun Pereira 	makex25->vc_facil_mask &= ~X25_MASK_REVERSE;
954a64b7b93SShaun Pereira 	/* ensure no calling address extension on accept */
955a64b7b93SShaun Pereira 	makex25->vc_facil_mask &= ~X25_MASK_CALLING_AE;
956cb65d506SShaun Pereira 	makex25->cudmatchlength = x25_sk(sk)->cudmatchlength;
9571da177e4SLinus Torvalds 
958ebc3f64bSShaun Pereira 	/* Normally all calls are accepted immediatly */
959ebc3f64bSShaun Pereira 	if(makex25->accptapprv & X25_DENY_ACCPT_APPRV) {
9601da177e4SLinus Torvalds 		x25_write_internal(make, X25_CALL_ACCEPTED);
9611da177e4SLinus Torvalds 		makex25->state = X25_STATE_3;
962ebc3f64bSShaun Pereira 	}
9631da177e4SLinus Torvalds 
964cb65d506SShaun Pereira 	/*
965cb65d506SShaun Pereira 	 *	Incoming Call User Data.
966cb65d506SShaun Pereira 	 */
967d626f62bSArnaldo Carvalho de Melo 	skb_copy_from_linear_data(skb, makex25->calluserdata.cuddata, skb->len);
968cb65d506SShaun Pereira 	makex25->calluserdata.cudlength = skb->len;
969cb65d506SShaun Pereira 
9701da177e4SLinus Torvalds 	sk->sk_ack_backlog++;
9711da177e4SLinus Torvalds 
9721da177e4SLinus Torvalds 	x25_insert_socket(make);
9731da177e4SLinus Torvalds 
9741da177e4SLinus Torvalds 	skb_queue_head(&sk->sk_receive_queue, skb);
9751da177e4SLinus Torvalds 
9761da177e4SLinus Torvalds 	x25_start_heartbeat(make);
9771da177e4SLinus Torvalds 
9781da177e4SLinus Torvalds 	if (!sock_flag(sk, SOCK_DEAD))
9791da177e4SLinus Torvalds 		sk->sk_data_ready(sk, skb->len);
9801da177e4SLinus Torvalds 	rc = 1;
9811da177e4SLinus Torvalds 	sock_put(sk);
9821da177e4SLinus Torvalds out:
9831da177e4SLinus Torvalds 	return rc;
9841da177e4SLinus Torvalds out_sock_put:
9851da177e4SLinus Torvalds 	sock_put(sk);
9861da177e4SLinus Torvalds out_clear_request:
9871da177e4SLinus Torvalds 	rc = 0;
9881da177e4SLinus Torvalds 	x25_transmit_clear_request(nb, lci, 0x01);
9891da177e4SLinus Torvalds 	goto out;
9901da177e4SLinus Torvalds }
9911da177e4SLinus Torvalds 
9921da177e4SLinus Torvalds static int x25_sendmsg(struct kiocb *iocb, struct socket *sock,
9931da177e4SLinus Torvalds 		       struct msghdr *msg, size_t len)
9941da177e4SLinus Torvalds {
9951da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
9961da177e4SLinus Torvalds 	struct x25_sock *x25 = x25_sk(sk);
9971da177e4SLinus Torvalds 	struct sockaddr_x25 *usx25 = (struct sockaddr_x25 *)msg->msg_name;
9981da177e4SLinus Torvalds 	struct sockaddr_x25 sx25;
9991da177e4SLinus Torvalds 	struct sk_buff *skb;
10001da177e4SLinus Torvalds 	unsigned char *asmptr;
10011da177e4SLinus Torvalds 	int noblock = msg->msg_flags & MSG_DONTWAIT;
10021da177e4SLinus Torvalds 	size_t size;
10031da177e4SLinus Torvalds 	int qbit = 0, rc = -EINVAL;
10041da177e4SLinus Torvalds 
10051da177e4SLinus Torvalds 	if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_OOB|MSG_EOR|MSG_CMSG_COMPAT))
10061da177e4SLinus Torvalds 		goto out;
10071da177e4SLinus Torvalds 
10081da177e4SLinus Torvalds 	/* we currently don't support segmented records at the user interface */
10091da177e4SLinus Torvalds 	if (!(msg->msg_flags & (MSG_EOR|MSG_OOB)))
10101da177e4SLinus Torvalds 		goto out;
10111da177e4SLinus Torvalds 
10121da177e4SLinus Torvalds 	rc = -EADDRNOTAVAIL;
10131da177e4SLinus Torvalds 	if (sock_flag(sk, SOCK_ZAPPED))
10141da177e4SLinus Torvalds 		goto out;
10151da177e4SLinus Torvalds 
10161da177e4SLinus Torvalds 	rc = -EPIPE;
10171da177e4SLinus Torvalds 	if (sk->sk_shutdown & SEND_SHUTDOWN) {
10181da177e4SLinus Torvalds 		send_sig(SIGPIPE, current, 0);
10191da177e4SLinus Torvalds 		goto out;
10201da177e4SLinus Torvalds 	}
10211da177e4SLinus Torvalds 
10221da177e4SLinus Torvalds 	rc = -ENETUNREACH;
10231da177e4SLinus Torvalds 	if (!x25->neighbour)
10241da177e4SLinus Torvalds 		goto out;
10251da177e4SLinus Torvalds 
10261da177e4SLinus Torvalds 	if (usx25) {
10271da177e4SLinus Torvalds 		rc = -EINVAL;
10281da177e4SLinus Torvalds 		if (msg->msg_namelen < sizeof(sx25))
10291da177e4SLinus Torvalds 			goto out;
10301da177e4SLinus Torvalds 		memcpy(&sx25, usx25, sizeof(sx25));
10311da177e4SLinus Torvalds 		rc = -EISCONN;
10321da177e4SLinus Torvalds 		if (strcmp(x25->dest_addr.x25_addr, sx25.sx25_addr.x25_addr))
10331da177e4SLinus Torvalds 			goto out;
10341da177e4SLinus Torvalds 		rc = -EINVAL;
10351da177e4SLinus Torvalds 		if (sx25.sx25_family != AF_X25)
10361da177e4SLinus Torvalds 			goto out;
10371da177e4SLinus Torvalds 	} else {
10381da177e4SLinus Torvalds 		/*
10391da177e4SLinus Torvalds 		 *	FIXME 1003.1g - if the socket is like this because
10401da177e4SLinus Torvalds 		 *	it has become closed (not started closed) we ought
10411da177e4SLinus Torvalds 		 *	to SIGPIPE, EPIPE;
10421da177e4SLinus Torvalds 		 */
10431da177e4SLinus Torvalds 		rc = -ENOTCONN;
10441da177e4SLinus Torvalds 		if (sk->sk_state != TCP_ESTABLISHED)
10451da177e4SLinus Torvalds 			goto out;
10461da177e4SLinus Torvalds 
10471da177e4SLinus Torvalds 		sx25.sx25_family = AF_X25;
10481da177e4SLinus Torvalds 		sx25.sx25_addr   = x25->dest_addr;
10491da177e4SLinus Torvalds 	}
10501da177e4SLinus Torvalds 
105183e0bbcbSAlan Cox 	/* Sanity check the packet size */
105283e0bbcbSAlan Cox 	if (len > 65535) {
105383e0bbcbSAlan Cox 		rc = -EMSGSIZE;
105483e0bbcbSAlan Cox 		goto out;
105583e0bbcbSAlan Cox 	}
105683e0bbcbSAlan Cox 
10571da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: sendto: Addresses built.\n");
10581da177e4SLinus Torvalds 
10591da177e4SLinus Torvalds 	/* Build a packet */
10601da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: sendto: building packet.\n");
10611da177e4SLinus Torvalds 
10621da177e4SLinus Torvalds 	if ((msg->msg_flags & MSG_OOB) && len > 32)
10631da177e4SLinus Torvalds 		len = 32;
10641da177e4SLinus Torvalds 
10651da177e4SLinus Torvalds 	size = len + X25_MAX_L2_LEN + X25_EXT_MIN_LEN;
10661da177e4SLinus Torvalds 
10671da177e4SLinus Torvalds 	skb = sock_alloc_send_skb(sk, size, noblock, &rc);
10681da177e4SLinus Torvalds 	if (!skb)
10691da177e4SLinus Torvalds 		goto out;
10701da177e4SLinus Torvalds 	X25_SKB_CB(skb)->flags = msg->msg_flags;
10711da177e4SLinus Torvalds 
10721da177e4SLinus Torvalds 	skb_reserve(skb, X25_MAX_L2_LEN + X25_EXT_MIN_LEN);
10731da177e4SLinus Torvalds 
10741da177e4SLinus Torvalds 	/*
10751da177e4SLinus Torvalds 	 *	Put the data on the end
10761da177e4SLinus Torvalds 	 */
10771da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: Copying user data\n");
10781da177e4SLinus Torvalds 
1079eeeb0374SArnaldo Carvalho de Melo 	skb_reset_transport_header(skb);
1080eeeb0374SArnaldo Carvalho de Melo 	skb_put(skb, len);
10811da177e4SLinus Torvalds 
1082eeeb0374SArnaldo Carvalho de Melo 	rc = memcpy_fromiovec(skb_transport_header(skb), msg->msg_iov, len);
10831da177e4SLinus Torvalds 	if (rc)
10841da177e4SLinus Torvalds 		goto out_kfree_skb;
10851da177e4SLinus Torvalds 
10861da177e4SLinus Torvalds 	/*
10871da177e4SLinus Torvalds 	 *	If the Q BIT Include socket option is in force, the first
10881da177e4SLinus Torvalds 	 *	byte of the user data is the logical value of the Q Bit.
10891da177e4SLinus Torvalds 	 */
10901da177e4SLinus Torvalds 	if (x25->qbitincl) {
10911da177e4SLinus Torvalds 		qbit = skb->data[0];
10921da177e4SLinus Torvalds 		skb_pull(skb, 1);
10931da177e4SLinus Torvalds 	}
10941da177e4SLinus Torvalds 
10951da177e4SLinus Torvalds 	/*
10961da177e4SLinus Torvalds 	 *	Push down the X.25 header
10971da177e4SLinus Torvalds 	 */
10981da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: Building X.25 Header.\n");
10991da177e4SLinus Torvalds 
11001da177e4SLinus Torvalds 	if (msg->msg_flags & MSG_OOB) {
11011da177e4SLinus Torvalds 		if (x25->neighbour->extended) {
11021da177e4SLinus Torvalds 			asmptr    = skb_push(skb, X25_STD_MIN_LEN);
11031da177e4SLinus Torvalds 			*asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_EXTSEQ;
11041da177e4SLinus Torvalds 			*asmptr++ = (x25->lci >> 0) & 0xFF;
11051da177e4SLinus Torvalds 			*asmptr++ = X25_INTERRUPT;
11061da177e4SLinus Torvalds 		} else {
11071da177e4SLinus Torvalds 			asmptr    = skb_push(skb, X25_STD_MIN_LEN);
11081da177e4SLinus Torvalds 			*asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_STDSEQ;
11091da177e4SLinus Torvalds 			*asmptr++ = (x25->lci >> 0) & 0xFF;
11101da177e4SLinus Torvalds 			*asmptr++ = X25_INTERRUPT;
11111da177e4SLinus Torvalds 		}
11121da177e4SLinus Torvalds 	} else {
11131da177e4SLinus Torvalds 		if (x25->neighbour->extended) {
11141da177e4SLinus Torvalds 			/* Build an Extended X.25 header */
11151da177e4SLinus Torvalds 			asmptr    = skb_push(skb, X25_EXT_MIN_LEN);
11161da177e4SLinus Torvalds 			*asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_EXTSEQ;
11171da177e4SLinus Torvalds 			*asmptr++ = (x25->lci >> 0) & 0xFF;
11181da177e4SLinus Torvalds 			*asmptr++ = X25_DATA;
11191da177e4SLinus Torvalds 			*asmptr++ = X25_DATA;
11201da177e4SLinus Torvalds 		} else {
11211da177e4SLinus Torvalds 			/* Build an Standard X.25 header */
11221da177e4SLinus Torvalds 			asmptr    = skb_push(skb, X25_STD_MIN_LEN);
11231da177e4SLinus Torvalds 			*asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_STDSEQ;
11241da177e4SLinus Torvalds 			*asmptr++ = (x25->lci >> 0) & 0xFF;
11251da177e4SLinus Torvalds 			*asmptr++ = X25_DATA;
11261da177e4SLinus Torvalds 		}
11271da177e4SLinus Torvalds 
11281da177e4SLinus Torvalds 		if (qbit)
11291da177e4SLinus Torvalds 			skb->data[0] |= X25_Q_BIT;
11301da177e4SLinus Torvalds 	}
11311da177e4SLinus Torvalds 
11321da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: Built header.\n");
11331da177e4SLinus Torvalds 	SOCK_DEBUG(sk, "x25_sendmsg: Transmitting buffer\n");
11341da177e4SLinus Torvalds 
11351da177e4SLinus Torvalds 	rc = -ENOTCONN;
11361da177e4SLinus Torvalds 	if (sk->sk_state != TCP_ESTABLISHED)
11371da177e4SLinus Torvalds 		goto out_kfree_skb;
11381da177e4SLinus Torvalds 
11391da177e4SLinus Torvalds 	if (msg->msg_flags & MSG_OOB)
11401da177e4SLinus Torvalds 		skb_queue_tail(&x25->interrupt_out_queue, skb);
11411da177e4SLinus Torvalds 	else {
11428db09f26SRoel Kluin 		rc = x25_output(sk, skb);
11438db09f26SRoel Kluin 		len = rc;
11448db09f26SRoel Kluin 		if (rc < 0)
11451da177e4SLinus Torvalds 			kfree_skb(skb);
11461da177e4SLinus Torvalds 		else if (x25->qbitincl)
11471da177e4SLinus Torvalds 			len++;
11481da177e4SLinus Torvalds 	}
11491da177e4SLinus Torvalds 
11501da177e4SLinus Torvalds 	/*
11511da177e4SLinus Torvalds 	 * lock_sock() is currently only used to serialize this x25_kick()
11521da177e4SLinus Torvalds 	 * against input-driven x25_kick() calls. It currently only blocks
11531da177e4SLinus Torvalds 	 * incoming packets for this socket and does not protect against
11541da177e4SLinus Torvalds 	 * any other socket state changes and is not called from anywhere
11551da177e4SLinus Torvalds 	 * else. As x25_kick() cannot block and as long as all socket
11561da177e4SLinus Torvalds 	 * operations are BKL-wrapped, we don't need take to care about
11571da177e4SLinus Torvalds 	 * purging the backlog queue in x25_release().
11581da177e4SLinus Torvalds 	 *
11591da177e4SLinus Torvalds 	 * Using lock_sock() to protect all socket operations entirely
11601da177e4SLinus Torvalds 	 * (and making the whole x25 stack SMP aware) unfortunately would
11611da177e4SLinus Torvalds 	 * require major changes to {send,recv}msg and skb allocation methods.
11621da177e4SLinus Torvalds 	 * -> 2.5 ;)
11631da177e4SLinus Torvalds 	 */
11641da177e4SLinus Torvalds 	lock_sock(sk);
11651da177e4SLinus Torvalds 	x25_kick(sk);
11661da177e4SLinus Torvalds 	release_sock(sk);
11671da177e4SLinus Torvalds 	rc = len;
11681da177e4SLinus Torvalds out:
11691da177e4SLinus Torvalds 	return rc;
11701da177e4SLinus Torvalds out_kfree_skb:
11711da177e4SLinus Torvalds 	kfree_skb(skb);
11721da177e4SLinus Torvalds 	goto out;
11731da177e4SLinus Torvalds }
11741da177e4SLinus Torvalds 
11751da177e4SLinus Torvalds 
11761da177e4SLinus Torvalds static int x25_recvmsg(struct kiocb *iocb, struct socket *sock,
11771da177e4SLinus Torvalds 		       struct msghdr *msg, size_t size,
11781da177e4SLinus Torvalds 		       int flags)
11791da177e4SLinus Torvalds {
11801da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
11811da177e4SLinus Torvalds 	struct x25_sock *x25 = x25_sk(sk);
11821da177e4SLinus Torvalds 	struct sockaddr_x25 *sx25 = (struct sockaddr_x25 *)msg->msg_name;
11831da177e4SLinus Torvalds 	size_t copied;
11841da177e4SLinus Torvalds 	int qbit;
11851da177e4SLinus Torvalds 	struct sk_buff *skb;
11861da177e4SLinus Torvalds 	unsigned char *asmptr;
11871da177e4SLinus Torvalds 	int rc = -ENOTCONN;
11881da177e4SLinus Torvalds 
11891da177e4SLinus Torvalds 	/*
11901da177e4SLinus Torvalds 	 * This works for seqpacket too. The receiver has ordered the queue for
11911da177e4SLinus Torvalds 	 * us! We do one quick check first though
11921da177e4SLinus Torvalds 	 */
11931da177e4SLinus Torvalds 	if (sk->sk_state != TCP_ESTABLISHED)
11941da177e4SLinus Torvalds 		goto out;
11951da177e4SLinus Torvalds 
11961da177e4SLinus Torvalds 	if (flags & MSG_OOB) {
11971da177e4SLinus Torvalds 		rc = -EINVAL;
11981da177e4SLinus Torvalds 		if (sock_flag(sk, SOCK_URGINLINE) ||
11991da177e4SLinus Torvalds 		    !skb_peek(&x25->interrupt_in_queue))
12001da177e4SLinus Torvalds 			goto out;
12011da177e4SLinus Torvalds 
12021da177e4SLinus Torvalds 		skb = skb_dequeue(&x25->interrupt_in_queue);
12031da177e4SLinus Torvalds 
12041da177e4SLinus Torvalds 		skb_pull(skb, X25_STD_MIN_LEN);
12051da177e4SLinus Torvalds 
12061da177e4SLinus Torvalds 		/*
12071da177e4SLinus Torvalds 		 *	No Q bit information on Interrupt data.
12081da177e4SLinus Torvalds 		 */
12091da177e4SLinus Torvalds 		if (x25->qbitincl) {
12101da177e4SLinus Torvalds 			asmptr  = skb_push(skb, 1);
12111da177e4SLinus Torvalds 			*asmptr = 0x00;
12121da177e4SLinus Torvalds 		}
12131da177e4SLinus Torvalds 
12141da177e4SLinus Torvalds 		msg->msg_flags |= MSG_OOB;
12151da177e4SLinus Torvalds 	} else {
12161da177e4SLinus Torvalds 		/* Now we can treat all alike */
12171da177e4SLinus Torvalds 		skb = skb_recv_datagram(sk, flags & ~MSG_DONTWAIT,
12181da177e4SLinus Torvalds 					flags & MSG_DONTWAIT, &rc);
12191da177e4SLinus Torvalds 		if (!skb)
12201da177e4SLinus Torvalds 			goto out;
12211da177e4SLinus Torvalds 
12221da177e4SLinus Torvalds 		qbit = (skb->data[0] & X25_Q_BIT) == X25_Q_BIT;
12231da177e4SLinus Torvalds 
12241da177e4SLinus Torvalds 		skb_pull(skb, x25->neighbour->extended ?
12251da177e4SLinus Torvalds 				X25_EXT_MIN_LEN : X25_STD_MIN_LEN);
12261da177e4SLinus Torvalds 
12271da177e4SLinus Torvalds 		if (x25->qbitincl) {
12281da177e4SLinus Torvalds 			asmptr  = skb_push(skb, 1);
12291da177e4SLinus Torvalds 			*asmptr = qbit;
12301da177e4SLinus Torvalds 		}
12311da177e4SLinus Torvalds 	}
12321da177e4SLinus Torvalds 
1233badff6d0SArnaldo Carvalho de Melo 	skb_reset_transport_header(skb);
12341da177e4SLinus Torvalds 	copied = skb->len;
12351da177e4SLinus Torvalds 
12361da177e4SLinus Torvalds 	if (copied > size) {
12371da177e4SLinus Torvalds 		copied = size;
12381da177e4SLinus Torvalds 		msg->msg_flags |= MSG_TRUNC;
12391da177e4SLinus Torvalds 	}
12401da177e4SLinus Torvalds 
12411da177e4SLinus Torvalds 	/* Currently, each datagram always contains a complete record */
12421da177e4SLinus Torvalds 	msg->msg_flags |= MSG_EOR;
12431da177e4SLinus Torvalds 
12441da177e4SLinus Torvalds 	rc = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
12451da177e4SLinus Torvalds 	if (rc)
12461da177e4SLinus Torvalds 		goto out_free_dgram;
12471da177e4SLinus Torvalds 
12481da177e4SLinus Torvalds 	if (sx25) {
12491da177e4SLinus Torvalds 		sx25->sx25_family = AF_X25;
12501da177e4SLinus Torvalds 		sx25->sx25_addr   = x25->dest_addr;
12511da177e4SLinus Torvalds 	}
12521da177e4SLinus Torvalds 
12531da177e4SLinus Torvalds 	msg->msg_namelen = sizeof(struct sockaddr_x25);
12541da177e4SLinus Torvalds 
12551da177e4SLinus Torvalds 	lock_sock(sk);
12561da177e4SLinus Torvalds 	x25_check_rbuf(sk);
12571da177e4SLinus Torvalds 	release_sock(sk);
12581da177e4SLinus Torvalds 	rc = copied;
12591da177e4SLinus Torvalds out_free_dgram:
12601da177e4SLinus Torvalds 	skb_free_datagram(sk, skb);
12611da177e4SLinus Torvalds out:
12621da177e4SLinus Torvalds 	return rc;
12631da177e4SLinus Torvalds }
12641da177e4SLinus Torvalds 
12651da177e4SLinus Torvalds 
12661da177e4SLinus Torvalds static int x25_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
12671da177e4SLinus Torvalds {
12681da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
12691da177e4SLinus Torvalds 	struct x25_sock *x25 = x25_sk(sk);
12701da177e4SLinus Torvalds 	void __user *argp = (void __user *)arg;
12711da177e4SLinus Torvalds 	int rc;
12721da177e4SLinus Torvalds 
12731da177e4SLinus Torvalds 	switch (cmd) {
12741da177e4SLinus Torvalds 		case TIOCOUTQ: {
127531e6d363SEric Dumazet 			int amount = sk->sk_sndbuf - sk_wmem_alloc_get(sk);
127631e6d363SEric Dumazet 
12771da177e4SLinus Torvalds 			if (amount < 0)
12781da177e4SLinus Torvalds 				amount = 0;
12791da177e4SLinus Torvalds 			rc = put_user(amount, (unsigned int __user *)argp);
12801da177e4SLinus Torvalds 			break;
12811da177e4SLinus Torvalds 		}
12821da177e4SLinus Torvalds 
12831da177e4SLinus Torvalds 		case TIOCINQ: {
12841da177e4SLinus Torvalds 			struct sk_buff *skb;
12851da177e4SLinus Torvalds 			int amount = 0;
12861da177e4SLinus Torvalds 			/*
12871da177e4SLinus Torvalds 			 * These two are safe on a single CPU system as
12881da177e4SLinus Torvalds 			 * only user tasks fiddle here
12891da177e4SLinus Torvalds 			 */
12901da177e4SLinus Torvalds 			if ((skb = skb_peek(&sk->sk_receive_queue)) != NULL)
12911da177e4SLinus Torvalds 				amount = skb->len;
12921da177e4SLinus Torvalds 			rc = put_user(amount, (unsigned int __user *)argp);
12931da177e4SLinus Torvalds 			break;
12941da177e4SLinus Torvalds 		}
12951da177e4SLinus Torvalds 
12961da177e4SLinus Torvalds 		case SIOCGSTAMP:
12971da177e4SLinus Torvalds 			rc = -EINVAL;
12981da177e4SLinus Torvalds 			if (sk)
12991da177e4SLinus Torvalds 				rc = sock_get_timestamp(sk,
13001da177e4SLinus Torvalds 						(struct timeval __user *)argp);
13011da177e4SLinus Torvalds 			break;
1302ae40eb1eSEric Dumazet 		case SIOCGSTAMPNS:
1303ae40eb1eSEric Dumazet 			rc = -EINVAL;
1304ae40eb1eSEric Dumazet 			if (sk)
1305ae40eb1eSEric Dumazet 				rc = sock_get_timestampns(sk,
1306ae40eb1eSEric Dumazet 						(struct timespec __user *)argp);
1307ae40eb1eSEric Dumazet 			break;
13081da177e4SLinus Torvalds 		case SIOCGIFADDR:
13091da177e4SLinus Torvalds 		case SIOCSIFADDR:
13101da177e4SLinus Torvalds 		case SIOCGIFDSTADDR:
13111da177e4SLinus Torvalds 		case SIOCSIFDSTADDR:
13121da177e4SLinus Torvalds 		case SIOCGIFBRDADDR:
13131da177e4SLinus Torvalds 		case SIOCSIFBRDADDR:
13141da177e4SLinus Torvalds 		case SIOCGIFNETMASK:
13151da177e4SLinus Torvalds 		case SIOCSIFNETMASK:
13161da177e4SLinus Torvalds 		case SIOCGIFMETRIC:
13171da177e4SLinus Torvalds 		case SIOCSIFMETRIC:
13181da177e4SLinus Torvalds 			rc = -EINVAL;
13191da177e4SLinus Torvalds 			break;
13201da177e4SLinus Torvalds 		case SIOCADDRT:
13211da177e4SLinus Torvalds 		case SIOCDELRT:
13221da177e4SLinus Torvalds 			rc = -EPERM;
13231da177e4SLinus Torvalds 			if (!capable(CAP_NET_ADMIN))
13241da177e4SLinus Torvalds 				break;
13251da177e4SLinus Torvalds 			rc = x25_route_ioctl(cmd, argp);
13261da177e4SLinus Torvalds 			break;
13271da177e4SLinus Torvalds 		case SIOCX25GSUBSCRIP:
13281da177e4SLinus Torvalds 			rc = x25_subscr_ioctl(cmd, argp);
13291da177e4SLinus Torvalds 			break;
13301da177e4SLinus Torvalds 		case SIOCX25SSUBSCRIP:
13311da177e4SLinus Torvalds 			rc = -EPERM;
13321da177e4SLinus Torvalds 			if (!capable(CAP_NET_ADMIN))
13331da177e4SLinus Torvalds 				break;
13341da177e4SLinus Torvalds 			rc = x25_subscr_ioctl(cmd, argp);
13351da177e4SLinus Torvalds 			break;
13361da177e4SLinus Torvalds 		case SIOCX25GFACILITIES: {
13371da177e4SLinus Torvalds 			struct x25_facilities fac = x25->facilities;
13381da177e4SLinus Torvalds 			rc = copy_to_user(argp, &fac,
13391da177e4SLinus Torvalds 					  sizeof(fac)) ? -EFAULT : 0;
13401da177e4SLinus Torvalds 			break;
13411da177e4SLinus Torvalds 		}
13421da177e4SLinus Torvalds 
13431da177e4SLinus Torvalds 		case SIOCX25SFACILITIES: {
13441da177e4SLinus Torvalds 			struct x25_facilities facilities;
13451da177e4SLinus Torvalds 			rc = -EFAULT;
13461da177e4SLinus Torvalds 			if (copy_from_user(&facilities, argp,
13471da177e4SLinus Torvalds 					   sizeof(facilities)))
13481da177e4SLinus Torvalds 				break;
13491da177e4SLinus Torvalds 			rc = -EINVAL;
13501da177e4SLinus Torvalds 			if (sk->sk_state != TCP_LISTEN &&
13511da177e4SLinus Torvalds 			    sk->sk_state != TCP_CLOSE)
13521da177e4SLinus Torvalds 				break;
13531da177e4SLinus Torvalds 			if (facilities.pacsize_in < X25_PS16 ||
13541da177e4SLinus Torvalds 			    facilities.pacsize_in > X25_PS4096)
13551da177e4SLinus Torvalds 				break;
13561da177e4SLinus Torvalds 			if (facilities.pacsize_out < X25_PS16 ||
13571da177e4SLinus Torvalds 			    facilities.pacsize_out > X25_PS4096)
13581da177e4SLinus Torvalds 				break;
13591da177e4SLinus Torvalds 			if (facilities.winsize_in < 1 ||
13601da177e4SLinus Torvalds 			    facilities.winsize_in > 127)
13611da177e4SLinus Torvalds 				break;
13621da177e4SLinus Torvalds 			if (facilities.throughput < 0x03 ||
13631da177e4SLinus Torvalds 			    facilities.throughput > 0xDD)
13641da177e4SLinus Torvalds 				break;
1365ebc3f64bSShaun Pereira 			if (facilities.reverse &&
1366ebc3f64bSShaun Pereira 				(facilities.reverse | 0x81)!= 0x81)
13671da177e4SLinus Torvalds 				break;
13681da177e4SLinus Torvalds 			x25->facilities = facilities;
13691da177e4SLinus Torvalds 			rc = 0;
13701da177e4SLinus Torvalds 			break;
13711da177e4SLinus Torvalds 		}
13721da177e4SLinus Torvalds 
1373a64b7b93SShaun Pereira 		case SIOCX25GDTEFACILITIES: {
1374a64b7b93SShaun Pereira 			rc = copy_to_user(argp, &x25->dte_facilities,
1375a64b7b93SShaun Pereira 						sizeof(x25->dte_facilities));
1376a64b7b93SShaun Pereira 			if (rc)
1377a64b7b93SShaun Pereira 				rc = -EFAULT;
1378a64b7b93SShaun Pereira 			break;
1379a64b7b93SShaun Pereira 		}
1380a64b7b93SShaun Pereira 
1381a64b7b93SShaun Pereira 		case SIOCX25SDTEFACILITIES: {
1382a64b7b93SShaun Pereira 			struct x25_dte_facilities dtefacs;
1383a64b7b93SShaun Pereira 			rc = -EFAULT;
1384a64b7b93SShaun Pereira 			if (copy_from_user(&dtefacs, argp, sizeof(dtefacs)))
1385a64b7b93SShaun Pereira 				break;
1386a64b7b93SShaun Pereira 			rc = -EINVAL;
1387a64b7b93SShaun Pereira 			if (sk->sk_state != TCP_LISTEN &&
1388a64b7b93SShaun Pereira 					sk->sk_state != TCP_CLOSE)
1389a64b7b93SShaun Pereira 				break;
1390a64b7b93SShaun Pereira 			if (dtefacs.calling_len > X25_MAX_AE_LEN)
1391a64b7b93SShaun Pereira 				break;
1392a64b7b93SShaun Pereira 			if (dtefacs.calling_ae == NULL)
1393a64b7b93SShaun Pereira 				break;
1394a64b7b93SShaun Pereira 			if (dtefacs.called_len > X25_MAX_AE_LEN)
1395a64b7b93SShaun Pereira 				break;
1396a64b7b93SShaun Pereira 			if (dtefacs.called_ae == NULL)
1397a64b7b93SShaun Pereira 				break;
1398a64b7b93SShaun Pereira 			x25->dte_facilities = dtefacs;
1399a64b7b93SShaun Pereira 			rc = 0;
1400a64b7b93SShaun Pereira 			break;
1401a64b7b93SShaun Pereira 		}
1402a64b7b93SShaun Pereira 
14031da177e4SLinus Torvalds 		case SIOCX25GCALLUSERDATA: {
14041da177e4SLinus Torvalds 			struct x25_calluserdata cud = x25->calluserdata;
14051da177e4SLinus Torvalds 			rc = copy_to_user(argp, &cud,
14061da177e4SLinus Torvalds 					  sizeof(cud)) ? -EFAULT : 0;
14071da177e4SLinus Torvalds 			break;
14081da177e4SLinus Torvalds 		}
14091da177e4SLinus Torvalds 
14101da177e4SLinus Torvalds 		case SIOCX25SCALLUSERDATA: {
14111da177e4SLinus Torvalds 			struct x25_calluserdata calluserdata;
14121da177e4SLinus Torvalds 
14131da177e4SLinus Torvalds 			rc = -EFAULT;
14141da177e4SLinus Torvalds 			if (copy_from_user(&calluserdata, argp,
14151da177e4SLinus Torvalds 					   sizeof(calluserdata)))
14161da177e4SLinus Torvalds 				break;
14171da177e4SLinus Torvalds 			rc = -EINVAL;
14181da177e4SLinus Torvalds 			if (calluserdata.cudlength > X25_MAX_CUD_LEN)
14191da177e4SLinus Torvalds 				break;
14201da177e4SLinus Torvalds 			x25->calluserdata = calluserdata;
14211da177e4SLinus Torvalds 			rc = 0;
14221da177e4SLinus Torvalds 			break;
14231da177e4SLinus Torvalds 		}
14241da177e4SLinus Torvalds 
14251da177e4SLinus Torvalds 		case SIOCX25GCAUSEDIAG: {
14261da177e4SLinus Torvalds 			struct x25_causediag causediag;
14271da177e4SLinus Torvalds 			causediag = x25->causediag;
14281da177e4SLinus Torvalds 			rc = copy_to_user(argp, &causediag,
14291da177e4SLinus Torvalds 					  sizeof(causediag)) ? -EFAULT : 0;
14301da177e4SLinus Torvalds 			break;
14311da177e4SLinus Torvalds 		}
14321da177e4SLinus Torvalds 
1433cb65d506SShaun Pereira 		case SIOCX25SCUDMATCHLEN: {
1434cb65d506SShaun Pereira 			struct x25_subaddr sub_addr;
1435cb65d506SShaun Pereira 			rc = -EINVAL;
1436cb65d506SShaun Pereira 			if(sk->sk_state != TCP_CLOSE)
1437cb65d506SShaun Pereira 				break;
1438cb65d506SShaun Pereira 			rc = -EFAULT;
1439cb65d506SShaun Pereira 			if (copy_from_user(&sub_addr, argp,
1440cb65d506SShaun Pereira 					sizeof(sub_addr)))
1441cb65d506SShaun Pereira 				break;
1442cb65d506SShaun Pereira 			rc = -EINVAL;
1443cb65d506SShaun Pereira 			if(sub_addr.cudmatchlength > X25_MAX_CUD_LEN)
1444cb65d506SShaun Pereira 				break;
1445cb65d506SShaun Pereira 			x25->cudmatchlength = sub_addr.cudmatchlength;
1446cb65d506SShaun Pereira 			rc = 0;
1447cb65d506SShaun Pereira 			break;
1448cb65d506SShaun Pereira 		}
1449cb65d506SShaun Pereira 
1450ebc3f64bSShaun Pereira 		case SIOCX25CALLACCPTAPPRV: {
1451ebc3f64bSShaun Pereira 			rc = -EINVAL;
1452ebc3f64bSShaun Pereira 			if (sk->sk_state != TCP_CLOSE)
1453ebc3f64bSShaun Pereira 				break;
1454ebc3f64bSShaun Pereira 			x25->accptapprv = X25_ALLOW_ACCPT_APPRV;
1455ebc3f64bSShaun Pereira 			rc = 0;
1456ebc3f64bSShaun Pereira 			break;
1457ebc3f64bSShaun Pereira 		}
1458ebc3f64bSShaun Pereira 
1459ebc3f64bSShaun Pereira 		case SIOCX25SENDCALLACCPT:  {
1460ebc3f64bSShaun Pereira 			rc = -EINVAL;
1461ebc3f64bSShaun Pereira 			if (sk->sk_state != TCP_ESTABLISHED)
1462ebc3f64bSShaun Pereira 				break;
1463ebc3f64bSShaun Pereira 			if (x25->accptapprv)	/* must call accptapprv above */
1464ebc3f64bSShaun Pereira 				break;
1465ebc3f64bSShaun Pereira 			x25_write_internal(sk, X25_CALL_ACCEPTED);
1466ebc3f64bSShaun Pereira 			x25->state = X25_STATE_3;
1467ebc3f64bSShaun Pereira 			rc = 0;
1468ebc3f64bSShaun Pereira 			break;
1469ebc3f64bSShaun Pereira 		}
1470ebc3f64bSShaun Pereira 
14711da177e4SLinus Torvalds 		default:
1472b5e5fa5eSChristoph Hellwig 			rc = -ENOIOCTLCMD;
14731da177e4SLinus Torvalds 			break;
14741da177e4SLinus Torvalds 	}
14751da177e4SLinus Torvalds 
14761da177e4SLinus Torvalds 	return rc;
14771da177e4SLinus Torvalds }
14781da177e4SLinus Torvalds 
14791da177e4SLinus Torvalds static struct net_proto_family x25_family_ops = {
14801da177e4SLinus Torvalds 	.family =	AF_X25,
14811da177e4SLinus Torvalds 	.create =	x25_create,
14821da177e4SLinus Torvalds 	.owner	=	THIS_MODULE,
14831da177e4SLinus Torvalds };
14841da177e4SLinus Torvalds 
14851b06e6baSShaun Pereira #ifdef CONFIG_COMPAT
14861b06e6baSShaun Pereira static int compat_x25_subscr_ioctl(unsigned int cmd,
14871b06e6baSShaun Pereira 		struct compat_x25_subscrip_struct __user *x25_subscr32)
14881b06e6baSShaun Pereira {
14891b06e6baSShaun Pereira 	struct compat_x25_subscrip_struct x25_subscr;
14901b06e6baSShaun Pereira 	struct x25_neigh *nb;
14911b06e6baSShaun Pereira 	struct net_device *dev;
14921b06e6baSShaun Pereira 	int rc = -EINVAL;
14931b06e6baSShaun Pereira 
14941b06e6baSShaun Pereira 	rc = -EFAULT;
14951b06e6baSShaun Pereira 	if (copy_from_user(&x25_subscr, x25_subscr32, sizeof(*x25_subscr32)))
14961b06e6baSShaun Pereira 		goto out;
14971b06e6baSShaun Pereira 
14981b06e6baSShaun Pereira 	rc = -EINVAL;
14991b06e6baSShaun Pereira 	dev = x25_dev_get(x25_subscr.device);
15001b06e6baSShaun Pereira 	if (dev == NULL)
15011b06e6baSShaun Pereira 		goto out;
15021b06e6baSShaun Pereira 
15031b06e6baSShaun Pereira 	nb = x25_get_neigh(dev);
15041b06e6baSShaun Pereira 	if (nb == NULL)
15051b06e6baSShaun Pereira 		goto out_dev_put;
15061b06e6baSShaun Pereira 
15071b06e6baSShaun Pereira 	dev_put(dev);
15081b06e6baSShaun Pereira 
15091b06e6baSShaun Pereira 	if (cmd == SIOCX25GSUBSCRIP) {
15101b06e6baSShaun Pereira 		x25_subscr.extended = nb->extended;
15111b06e6baSShaun Pereira 		x25_subscr.global_facil_mask = nb->global_facil_mask;
15121b06e6baSShaun Pereira 		rc = copy_to_user(x25_subscr32, &x25_subscr,
15131b06e6baSShaun Pereira 				sizeof(*x25_subscr32)) ? -EFAULT : 0;
15141b06e6baSShaun Pereira 	} else {
15151b06e6baSShaun Pereira 		rc = -EINVAL;
15161b06e6baSShaun Pereira 		if (x25_subscr.extended == 0 || x25_subscr.extended == 1) {
15171b06e6baSShaun Pereira 			rc = 0;
15181b06e6baSShaun Pereira 			nb->extended = x25_subscr.extended;
15191b06e6baSShaun Pereira 			nb->global_facil_mask = x25_subscr.global_facil_mask;
15201b06e6baSShaun Pereira 		}
15211b06e6baSShaun Pereira 	}
15221b06e6baSShaun Pereira 	x25_neigh_put(nb);
15231b06e6baSShaun Pereira out:
15241b06e6baSShaun Pereira 	return rc;
15251b06e6baSShaun Pereira out_dev_put:
15261b06e6baSShaun Pereira 	dev_put(dev);
15271b06e6baSShaun Pereira 	goto out;
15281b06e6baSShaun Pereira }
15291b06e6baSShaun Pereira 
15301b06e6baSShaun Pereira static int compat_x25_ioctl(struct socket *sock, unsigned int cmd,
15311b06e6baSShaun Pereira 				unsigned long arg)
15321b06e6baSShaun Pereira {
15331b06e6baSShaun Pereira 	void __user *argp = compat_ptr(arg);
15341b06e6baSShaun Pereira 	struct sock *sk = sock->sk;
15351b06e6baSShaun Pereira 
15361b06e6baSShaun Pereira 	int rc = -ENOIOCTLCMD;
15371b06e6baSShaun Pereira 
15381b06e6baSShaun Pereira 	switch(cmd) {
15391b06e6baSShaun Pereira 	case TIOCOUTQ:
15401b06e6baSShaun Pereira 	case TIOCINQ:
15411b06e6baSShaun Pereira 		rc = x25_ioctl(sock, cmd, (unsigned long)argp);
15421b06e6baSShaun Pereira 		break;
15431b06e6baSShaun Pereira 	case SIOCGSTAMP:
15441b06e6baSShaun Pereira 		rc = -EINVAL;
15451b06e6baSShaun Pereira 		if (sk)
15461b06e6baSShaun Pereira 			rc = compat_sock_get_timestamp(sk,
15471b06e6baSShaun Pereira 					(struct timeval __user*)argp);
15481b06e6baSShaun Pereira 		break;
1549ae40eb1eSEric Dumazet 	case SIOCGSTAMPNS:
1550ae40eb1eSEric Dumazet 		rc = -EINVAL;
1551ae40eb1eSEric Dumazet 		if (sk)
1552ae40eb1eSEric Dumazet 			rc = compat_sock_get_timestampns(sk,
1553ae40eb1eSEric Dumazet 					(struct timespec __user*)argp);
1554ae40eb1eSEric Dumazet 		break;
15551b06e6baSShaun Pereira 	case SIOCGIFADDR:
15561b06e6baSShaun Pereira 	case SIOCSIFADDR:
15571b06e6baSShaun Pereira 	case SIOCGIFDSTADDR:
15581b06e6baSShaun Pereira 	case SIOCSIFDSTADDR:
15591b06e6baSShaun Pereira 	case SIOCGIFBRDADDR:
15601b06e6baSShaun Pereira 	case SIOCSIFBRDADDR:
15611b06e6baSShaun Pereira 	case SIOCGIFNETMASK:
15621b06e6baSShaun Pereira 	case SIOCSIFNETMASK:
15631b06e6baSShaun Pereira 	case SIOCGIFMETRIC:
15641b06e6baSShaun Pereira 	case SIOCSIFMETRIC:
15651b06e6baSShaun Pereira 		rc = -EINVAL;
15661b06e6baSShaun Pereira 		break;
15671b06e6baSShaun Pereira 	case SIOCADDRT:
15681b06e6baSShaun Pereira 	case SIOCDELRT:
15691b06e6baSShaun Pereira 		rc = -EPERM;
15701b06e6baSShaun Pereira 		if (!capable(CAP_NET_ADMIN))
15711b06e6baSShaun Pereira 			break;
15721b06e6baSShaun Pereira 		rc = x25_route_ioctl(cmd, argp);
15731b06e6baSShaun Pereira 		break;
15741b06e6baSShaun Pereira 	case SIOCX25GSUBSCRIP:
15751b06e6baSShaun Pereira 		rc = compat_x25_subscr_ioctl(cmd, argp);
15761b06e6baSShaun Pereira 		break;
15771b06e6baSShaun Pereira 	case SIOCX25SSUBSCRIP:
15781b06e6baSShaun Pereira 		rc = -EPERM;
15791b06e6baSShaun Pereira 		if (!capable(CAP_NET_ADMIN))
15801b06e6baSShaun Pereira 			break;
15811b06e6baSShaun Pereira 		rc = compat_x25_subscr_ioctl(cmd, argp);
15821b06e6baSShaun Pereira 		break;
15831b06e6baSShaun Pereira 	case SIOCX25GFACILITIES:
15841b06e6baSShaun Pereira 	case SIOCX25SFACILITIES:
15859a6b9f2eSShaun Pereira 	case SIOCX25GDTEFACILITIES:
15869a6b9f2eSShaun Pereira 	case SIOCX25SDTEFACILITIES:
15871b06e6baSShaun Pereira 	case SIOCX25GCALLUSERDATA:
15881b06e6baSShaun Pereira 	case SIOCX25SCALLUSERDATA:
15891b06e6baSShaun Pereira 	case SIOCX25GCAUSEDIAG:
15901b06e6baSShaun Pereira 	case SIOCX25SCUDMATCHLEN:
15911b06e6baSShaun Pereira 	case SIOCX25CALLACCPTAPPRV:
15921b06e6baSShaun Pereira 	case SIOCX25SENDCALLACCPT:
15931b06e6baSShaun Pereira 		rc = x25_ioctl(sock, cmd, (unsigned long)argp);
15941b06e6baSShaun Pereira 		break;
15951b06e6baSShaun Pereira 	default:
15961b06e6baSShaun Pereira 		rc = -ENOIOCTLCMD;
15971b06e6baSShaun Pereira 		break;
15981b06e6baSShaun Pereira 	}
15991b06e6baSShaun Pereira 	return rc;
16001b06e6baSShaun Pereira }
16011b06e6baSShaun Pereira #endif
16021b06e6baSShaun Pereira 
160390ddc4f0SEric Dumazet static const struct proto_ops SOCKOPS_WRAPPED(x25_proto_ops) = {
16041da177e4SLinus Torvalds 	.family =	AF_X25,
16051da177e4SLinus Torvalds 	.owner =	THIS_MODULE,
16061da177e4SLinus Torvalds 	.release =	x25_release,
16071da177e4SLinus Torvalds 	.bind =		x25_bind,
16081da177e4SLinus Torvalds 	.connect =	x25_connect,
16091da177e4SLinus Torvalds 	.socketpair =	sock_no_socketpair,
16101da177e4SLinus Torvalds 	.accept =	x25_accept,
16111da177e4SLinus Torvalds 	.getname =	x25_getname,
16121da177e4SLinus Torvalds 	.poll =		datagram_poll,
16131da177e4SLinus Torvalds 	.ioctl =	x25_ioctl,
16141b06e6baSShaun Pereira #ifdef CONFIG_COMPAT
16151b06e6baSShaun Pereira 	.compat_ioctl = compat_x25_ioctl,
16161b06e6baSShaun Pereira #endif
16171da177e4SLinus Torvalds 	.listen =	x25_listen,
16181da177e4SLinus Torvalds 	.shutdown =	sock_no_shutdown,
16191da177e4SLinus Torvalds 	.setsockopt =	x25_setsockopt,
16201da177e4SLinus Torvalds 	.getsockopt =	x25_getsockopt,
16211da177e4SLinus Torvalds 	.sendmsg =	x25_sendmsg,
16221da177e4SLinus Torvalds 	.recvmsg =	x25_recvmsg,
16231da177e4SLinus Torvalds 	.mmap =		sock_no_mmap,
16241da177e4SLinus Torvalds 	.sendpage =	sock_no_sendpage,
16251da177e4SLinus Torvalds };
16261da177e4SLinus Torvalds 
16271da177e4SLinus Torvalds SOCKOPS_WRAP(x25_proto, AF_X25);
16281da177e4SLinus Torvalds 
16297546dd97SStephen Hemminger static struct packet_type x25_packet_type __read_mostly = {
163009640e63SHarvey Harrison 	.type =	cpu_to_be16(ETH_P_X25),
16311da177e4SLinus Torvalds 	.func =	x25_lapb_receive_frame,
16321da177e4SLinus Torvalds };
16331da177e4SLinus Torvalds 
16341da177e4SLinus Torvalds static struct notifier_block x25_dev_notifier = {
16351da177e4SLinus Torvalds 	.notifier_call = x25_device_event,
16361da177e4SLinus Torvalds };
16371da177e4SLinus Torvalds 
16381da177e4SLinus Torvalds void x25_kill_by_neigh(struct x25_neigh *nb)
16391da177e4SLinus Torvalds {
16401da177e4SLinus Torvalds 	struct sock *s;
16411da177e4SLinus Torvalds 	struct hlist_node *node;
16421da177e4SLinus Torvalds 
16431da177e4SLinus Torvalds 	write_lock_bh(&x25_list_lock);
16441da177e4SLinus Torvalds 
16451da177e4SLinus Torvalds 	sk_for_each(s, node, &x25_list)
16461da177e4SLinus Torvalds 		if (x25_sk(s)->neighbour == nb)
16471da177e4SLinus Torvalds 			x25_disconnect(s, ENETUNREACH, 0, 0);
16481da177e4SLinus Torvalds 
16491da177e4SLinus Torvalds 	write_unlock_bh(&x25_list_lock);
165095a9dc43SAndrew Hendry 
165195a9dc43SAndrew Hendry 	/* Remove any related forwards */
165295a9dc43SAndrew Hendry 	x25_clear_forward_by_dev(nb->dev);
16531da177e4SLinus Torvalds }
16541da177e4SLinus Torvalds 
16551da177e4SLinus Torvalds static int __init x25_init(void)
16561da177e4SLinus Torvalds {
16571da177e4SLinus Torvalds 	int rc = proto_register(&x25_proto, 0);
16581da177e4SLinus Torvalds 
16591da177e4SLinus Torvalds 	if (rc != 0)
16601da177e4SLinus Torvalds 		goto out;
16611da177e4SLinus Torvalds 
16621da177e4SLinus Torvalds 	sock_register(&x25_family_ops);
16631da177e4SLinus Torvalds 
16641da177e4SLinus Torvalds 	dev_add_pack(&x25_packet_type);
16651da177e4SLinus Torvalds 
16661da177e4SLinus Torvalds 	register_netdevice_notifier(&x25_dev_notifier);
16671da177e4SLinus Torvalds 
1668a44562e4Smaximilian attems 	printk(KERN_INFO "X.25 for Linux Version 0.2\n");
16691da177e4SLinus Torvalds 
16701da177e4SLinus Torvalds #ifdef CONFIG_SYSCTL
16711da177e4SLinus Torvalds 	x25_register_sysctl();
16721da177e4SLinus Torvalds #endif
16731da177e4SLinus Torvalds 	x25_proc_init();
16741da177e4SLinus Torvalds out:
16751da177e4SLinus Torvalds 	return rc;
16761da177e4SLinus Torvalds }
16771da177e4SLinus Torvalds module_init(x25_init);
16781da177e4SLinus Torvalds 
16791da177e4SLinus Torvalds static void __exit x25_exit(void)
16801da177e4SLinus Torvalds {
16811da177e4SLinus Torvalds 	x25_proc_exit();
16821da177e4SLinus Torvalds 	x25_link_free();
16831da177e4SLinus Torvalds 	x25_route_free();
16841da177e4SLinus Torvalds 
16851da177e4SLinus Torvalds #ifdef CONFIG_SYSCTL
16861da177e4SLinus Torvalds 	x25_unregister_sysctl();
16871da177e4SLinus Torvalds #endif
16881da177e4SLinus Torvalds 
16891da177e4SLinus Torvalds 	unregister_netdevice_notifier(&x25_dev_notifier);
16901da177e4SLinus Torvalds 
16911da177e4SLinus Torvalds 	dev_remove_pack(&x25_packet_type);
16921da177e4SLinus Torvalds 
16931da177e4SLinus Torvalds 	sock_unregister(AF_X25);
16941da177e4SLinus Torvalds 	proto_unregister(&x25_proto);
16951da177e4SLinus Torvalds }
16961da177e4SLinus Torvalds module_exit(x25_exit);
16971da177e4SLinus Torvalds 
16981da177e4SLinus Torvalds MODULE_AUTHOR("Jonathan Naylor <g4klx@g4klx.demon.co.uk>");
16991da177e4SLinus Torvalds MODULE_DESCRIPTION("The X.25 Packet Layer network layer protocol");
17001da177e4SLinus Torvalds MODULE_LICENSE("GPL");
17011da177e4SLinus Torvalds MODULE_ALIAS_NETPROTO(PF_X25);
1702