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