| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | *	X.25 Packet Layer release 002 | 
|  | 3 | * | 
|  | 4 | *	This is ALPHA test software. This code may break your machine, | 
|  | 5 | *	randomly fail to work with new releases, misbehave and/or generally | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 6 | *	screw up. It might even work. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 7 | * | 
|  | 8 | *	This code REQUIRES 2.1.15 or higher | 
|  | 9 | * | 
|  | 10 | *	This module: | 
|  | 11 | *		This module is free software; you can redistribute it and/or | 
|  | 12 | *		modify it under the terms of the GNU General Public License | 
|  | 13 | *		as published by the Free Software Foundation; either version | 
|  | 14 | *		2 of the License, or (at your option) any later version. | 
|  | 15 | * | 
|  | 16 | *	History | 
|  | 17 | *	X.25 001	Jonathan Naylor	Started coding. | 
|  | 18 | *	X.25 002	Jonathan Naylor	Centralised disconnect handling. | 
|  | 19 | *					New timer architecture. | 
|  | 20 | *	2000-03-11	Henner Eisen	MSG_EOR handling more POSIX compliant. | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 21 | *	2000-03-22	Daniela Squassoni Allowed disabling/enabling of | 
|  | 22 | *					  facilities negotiation and increased | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | *					  the throughput upper limit. | 
|  | 24 | *	2000-08-27	Arnaldo C. Melo s/suser/capable/ + micro cleanups | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 25 | *	2000-09-04	Henner Eisen	Set sock->state in x25_accept(). | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | *					Fixed x25_output() related skb leakage. | 
|  | 27 | *	2000-10-02	Henner Eisen	Made x25_kick() single threaded per socket. | 
|  | 28 | *	2000-10-27	Henner Eisen    MSG_DONTWAIT for fragment allocation. | 
|  | 29 | *	2000-11-14	Henner Eisen    Closing datalink from NETDEV_GOING_DOWN | 
|  | 30 | *	2002-10-06	Arnaldo C. Melo Get rid of cli/sti, move proc stuff to | 
|  | 31 | *					x25_proc.c, using seq_file | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 32 | *	2005-04-02	Shaun Pereira	Selective sub address matching | 
|  | 33 | *					with call user data | 
| Shaun Pereira | ebc3f64 | 2005-06-22 22:16:17 -0700 | [diff] [blame] | 34 | *	2005-04-15	Shaun Pereira	Fast select with no restriction on | 
|  | 35 | *					response | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 36 | */ | 
|  | 37 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | #include <linux/module.h> | 
| Randy Dunlap | 4fc268d | 2006-01-11 12:17:47 -0800 | [diff] [blame] | 39 | #include <linux/capability.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | #include <linux/errno.h> | 
|  | 41 | #include <linux/kernel.h> | 
|  | 42 | #include <linux/sched.h> | 
|  | 43 | #include <linux/timer.h> | 
|  | 44 | #include <linux/string.h> | 
|  | 45 | #include <linux/net.h> | 
|  | 46 | #include <linux/netdevice.h> | 
|  | 47 | #include <linux/if_arp.h> | 
|  | 48 | #include <linux/skbuff.h> | 
|  | 49 | #include <net/sock.h> | 
| Arnaldo Carvalho de Melo | c752f07 | 2005-08-09 20:08:28 -0700 | [diff] [blame] | 50 | #include <net/tcp_states.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 51 | #include <asm/uaccess.h> | 
|  | 52 | #include <linux/fcntl.h> | 
|  | 53 | #include <linux/termios.h>	/* For TIOCINQ/OUTQ */ | 
|  | 54 | #include <linux/notifier.h> | 
|  | 55 | #include <linux/init.h> | 
| Shaun Pereira | 1b06e6b | 2006-03-22 00:00:12 -0800 | [diff] [blame] | 56 | #include <linux/compat.h> | 
|  | 57 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | #include <net/x25.h> | 
| Shaun Pereira | 1b06e6b | 2006-03-22 00:00:12 -0800 | [diff] [blame] | 59 | #include <net/compat.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 60 |  | 
|  | 61 | int sysctl_x25_restart_request_timeout = X25_DEFAULT_T20; | 
|  | 62 | int sysctl_x25_call_request_timeout    = X25_DEFAULT_T21; | 
|  | 63 | int sysctl_x25_reset_request_timeout   = X25_DEFAULT_T22; | 
|  | 64 | int sysctl_x25_clear_request_timeout   = X25_DEFAULT_T23; | 
|  | 65 | int sysctl_x25_ack_holdback_timeout    = X25_DEFAULT_T2; | 
| Andrew Hendry | 39e21c0 | 2007-02-08 13:34:36 -0800 | [diff] [blame] | 66 | int sysctl_x25_forward                 = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 67 |  | 
|  | 68 | HLIST_HEAD(x25_list); | 
|  | 69 | DEFINE_RWLOCK(x25_list_lock); | 
|  | 70 |  | 
| Eric Dumazet | 90ddc4f | 2005-12-22 12:49:22 -0800 | [diff] [blame] | 71 | static const struct proto_ops x25_proto_ops; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 72 |  | 
|  | 73 | static struct x25_address null_x25_address = {"               "}; | 
|  | 74 |  | 
| Shaun Pereira | 1b06e6b | 2006-03-22 00:00:12 -0800 | [diff] [blame] | 75 | #ifdef CONFIG_COMPAT | 
|  | 76 | struct compat_x25_subscrip_struct { | 
|  | 77 | char device[200-sizeof(compat_ulong_t)]; | 
|  | 78 | compat_ulong_t global_facil_mask; | 
|  | 79 | compat_uint_t extended; | 
|  | 80 | }; | 
|  | 81 | #endif | 
|  | 82 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 83 | int x25_addr_ntoa(unsigned char *p, struct x25_address *called_addr, | 
|  | 84 | struct x25_address *calling_addr) | 
|  | 85 | { | 
| Eric Dumazet | 6bf1574 | 2008-01-13 22:27:52 -0800 | [diff] [blame] | 86 | unsigned int called_len, calling_len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 | char *called, *calling; | 
| Eric Dumazet | 6bf1574 | 2008-01-13 22:27:52 -0800 | [diff] [blame] | 88 | unsigned int i; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 |  | 
|  | 90 | called_len  = (*p >> 0) & 0x0F; | 
|  | 91 | calling_len = (*p >> 4) & 0x0F; | 
|  | 92 |  | 
|  | 93 | called  = called_addr->x25_addr; | 
|  | 94 | calling = calling_addr->x25_addr; | 
|  | 95 | p++; | 
|  | 96 |  | 
|  | 97 | for (i = 0; i < (called_len + calling_len); i++) { | 
|  | 98 | if (i < called_len) { | 
|  | 99 | if (i % 2 != 0) { | 
|  | 100 | *called++ = ((*p >> 0) & 0x0F) + '0'; | 
|  | 101 | p++; | 
|  | 102 | } else { | 
|  | 103 | *called++ = ((*p >> 4) & 0x0F) + '0'; | 
|  | 104 | } | 
|  | 105 | } else { | 
|  | 106 | if (i % 2 != 0) { | 
|  | 107 | *calling++ = ((*p >> 0) & 0x0F) + '0'; | 
|  | 108 | p++; | 
|  | 109 | } else { | 
|  | 110 | *calling++ = ((*p >> 4) & 0x0F) + '0'; | 
|  | 111 | } | 
|  | 112 | } | 
|  | 113 | } | 
|  | 114 |  | 
|  | 115 | *called = *calling = '\0'; | 
|  | 116 |  | 
|  | 117 | return 1 + (called_len + calling_len + 1) / 2; | 
|  | 118 | } | 
|  | 119 |  | 
|  | 120 | int x25_addr_aton(unsigned char *p, struct x25_address *called_addr, | 
|  | 121 | struct x25_address *calling_addr) | 
|  | 122 | { | 
|  | 123 | unsigned int called_len, calling_len; | 
|  | 124 | char *called, *calling; | 
|  | 125 | int i; | 
|  | 126 |  | 
|  | 127 | called  = called_addr->x25_addr; | 
|  | 128 | calling = calling_addr->x25_addr; | 
|  | 129 |  | 
|  | 130 | called_len  = strlen(called); | 
|  | 131 | calling_len = strlen(calling); | 
|  | 132 |  | 
|  | 133 | *p++ = (calling_len << 4) | (called_len << 0); | 
|  | 134 |  | 
|  | 135 | for (i = 0; i < (called_len + calling_len); i++) { | 
|  | 136 | if (i < called_len) { | 
|  | 137 | if (i % 2 != 0) { | 
|  | 138 | *p |= (*called++ - '0') << 0; | 
|  | 139 | p++; | 
|  | 140 | } else { | 
|  | 141 | *p = 0x00; | 
|  | 142 | *p |= (*called++ - '0') << 4; | 
|  | 143 | } | 
|  | 144 | } else { | 
|  | 145 | if (i % 2 != 0) { | 
|  | 146 | *p |= (*calling++ - '0') << 0; | 
|  | 147 | p++; | 
|  | 148 | } else { | 
|  | 149 | *p = 0x00; | 
|  | 150 | *p |= (*calling++ - '0') << 4; | 
|  | 151 | } | 
|  | 152 | } | 
|  | 153 | } | 
|  | 154 |  | 
|  | 155 | return 1 + (called_len + calling_len + 1) / 2; | 
|  | 156 | } | 
|  | 157 |  | 
|  | 158 | /* | 
|  | 159 | *	Socket removal during an interrupt is now safe. | 
|  | 160 | */ | 
|  | 161 | static void x25_remove_socket(struct sock *sk) | 
|  | 162 | { | 
|  | 163 | write_lock_bh(&x25_list_lock); | 
|  | 164 | sk_del_node_init(sk); | 
|  | 165 | write_unlock_bh(&x25_list_lock); | 
|  | 166 | } | 
|  | 167 |  | 
|  | 168 | /* | 
|  | 169 | *	Kill all bound sockets on a dropped device. | 
|  | 170 | */ | 
|  | 171 | static void x25_kill_by_device(struct net_device *dev) | 
|  | 172 | { | 
|  | 173 | struct sock *s; | 
|  | 174 | struct hlist_node *node; | 
|  | 175 |  | 
|  | 176 | write_lock_bh(&x25_list_lock); | 
|  | 177 |  | 
|  | 178 | sk_for_each(s, node, &x25_list) | 
|  | 179 | if (x25_sk(s)->neighbour && x25_sk(s)->neighbour->dev == dev) | 
|  | 180 | x25_disconnect(s, ENETUNREACH, 0, 0); | 
|  | 181 |  | 
|  | 182 | write_unlock_bh(&x25_list_lock); | 
|  | 183 | } | 
|  | 184 |  | 
|  | 185 | /* | 
|  | 186 | *	Handle device status changes. | 
|  | 187 | */ | 
|  | 188 | static int x25_device_event(struct notifier_block *this, unsigned long event, | 
|  | 189 | void *ptr) | 
|  | 190 | { | 
|  | 191 | struct net_device *dev = ptr; | 
|  | 192 | struct x25_neigh *nb; | 
|  | 193 |  | 
| YOSHIFUJI Hideaki | c346dca | 2008-03-25 21:47:49 +0900 | [diff] [blame] | 194 | if (dev_net(dev) != &init_net) | 
| Eric W. Biederman | e9dc865 | 2007-09-12 13:02:17 +0200 | [diff] [blame] | 195 | return NOTIFY_DONE; | 
|  | 196 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 197 | if (dev->type == ARPHRD_X25 | 
|  | 198 | #if defined(CONFIG_LLC) || defined(CONFIG_LLC_MODULE) | 
|  | 199 | || dev->type == ARPHRD_ETHER | 
|  | 200 | #endif | 
|  | 201 | ) { | 
|  | 202 | switch (event) { | 
|  | 203 | case NETDEV_UP: | 
|  | 204 | x25_link_device_up(dev); | 
|  | 205 | break; | 
|  | 206 | case NETDEV_GOING_DOWN: | 
|  | 207 | nb = x25_get_neigh(dev); | 
|  | 208 | if (nb) { | 
|  | 209 | x25_terminate_link(nb); | 
|  | 210 | x25_neigh_put(nb); | 
|  | 211 | } | 
|  | 212 | break; | 
|  | 213 | case NETDEV_DOWN: | 
|  | 214 | x25_kill_by_device(dev); | 
|  | 215 | x25_route_device_down(dev); | 
|  | 216 | x25_link_device_down(dev); | 
|  | 217 | break; | 
|  | 218 | } | 
|  | 219 | } | 
|  | 220 |  | 
|  | 221 | return NOTIFY_DONE; | 
|  | 222 | } | 
|  | 223 |  | 
|  | 224 | /* | 
|  | 225 | *	Add a socket to the bound sockets list. | 
|  | 226 | */ | 
|  | 227 | static void x25_insert_socket(struct sock *sk) | 
|  | 228 | { | 
|  | 229 | write_lock_bh(&x25_list_lock); | 
|  | 230 | sk_add_node(sk, &x25_list); | 
|  | 231 | write_unlock_bh(&x25_list_lock); | 
|  | 232 | } | 
|  | 233 |  | 
|  | 234 | /* | 
|  | 235 | *	Find a socket that wants to accept the Call Request we just | 
|  | 236 | *	received. Check the full list for an address/cud match. | 
|  | 237 | *	If no cuds match return the next_best thing, an address match. | 
|  | 238 | *	Note: if a listening socket has cud set it must only get calls | 
|  | 239 | *	with matching cud. | 
|  | 240 | */ | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 241 | static struct sock *x25_find_listener(struct x25_address *addr, | 
|  | 242 | struct sk_buff *skb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 243 | { | 
|  | 244 | struct sock *s; | 
|  | 245 | struct sock *next_best; | 
|  | 246 | struct hlist_node *node; | 
|  | 247 |  | 
|  | 248 | read_lock_bh(&x25_list_lock); | 
|  | 249 | next_best = NULL; | 
|  | 250 |  | 
|  | 251 | sk_for_each(s, node, &x25_list) | 
|  | 252 | if ((!strcmp(addr->x25_addr, | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 253 | x25_sk(s)->source_addr.x25_addr) || | 
|  | 254 | !strcmp(addr->x25_addr, | 
|  | 255 | null_x25_address.x25_addr)) && | 
|  | 256 | s->sk_state == TCP_LISTEN) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 257 | /* | 
|  | 258 | * Found a listening socket, now check the incoming | 
|  | 259 | * call user data vs this sockets call user data | 
|  | 260 | */ | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 261 | if(skb->len > 0 && x25_sk(s)->cudmatchlength > 0) { | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 262 | if((memcmp(x25_sk(s)->calluserdata.cuddata, | 
|  | 263 | skb->data, | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 264 | x25_sk(s)->cudmatchlength)) == 0) { | 
|  | 265 | sock_hold(s); | 
|  | 266 | goto found; | 
|  | 267 | } | 
|  | 268 | } else | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 269 | next_best = s; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 270 | } | 
|  | 271 | if (next_best) { | 
|  | 272 | s = next_best; | 
|  | 273 | sock_hold(s); | 
|  | 274 | goto found; | 
|  | 275 | } | 
|  | 276 | s = NULL; | 
|  | 277 | found: | 
|  | 278 | read_unlock_bh(&x25_list_lock); | 
|  | 279 | return s; | 
|  | 280 | } | 
|  | 281 |  | 
|  | 282 | /* | 
|  | 283 | *	Find a connected X.25 socket given my LCI and neighbour. | 
|  | 284 | */ | 
|  | 285 | static struct sock *__x25_find_socket(unsigned int lci, struct x25_neigh *nb) | 
|  | 286 | { | 
|  | 287 | struct sock *s; | 
|  | 288 | struct hlist_node *node; | 
|  | 289 |  | 
|  | 290 | sk_for_each(s, node, &x25_list) | 
|  | 291 | if (x25_sk(s)->lci == lci && x25_sk(s)->neighbour == nb) { | 
|  | 292 | sock_hold(s); | 
|  | 293 | goto found; | 
|  | 294 | } | 
|  | 295 | s = NULL; | 
|  | 296 | found: | 
|  | 297 | return s; | 
|  | 298 | } | 
|  | 299 |  | 
|  | 300 | struct sock *x25_find_socket(unsigned int lci, struct x25_neigh *nb) | 
|  | 301 | { | 
|  | 302 | struct sock *s; | 
|  | 303 |  | 
|  | 304 | read_lock_bh(&x25_list_lock); | 
|  | 305 | s = __x25_find_socket(lci, nb); | 
|  | 306 | read_unlock_bh(&x25_list_lock); | 
|  | 307 | return s; | 
|  | 308 | } | 
|  | 309 |  | 
|  | 310 | /* | 
|  | 311 | *	Find a unique LCI for a given device. | 
|  | 312 | */ | 
|  | 313 | static unsigned int x25_new_lci(struct x25_neigh *nb) | 
|  | 314 | { | 
|  | 315 | unsigned int lci = 1; | 
|  | 316 | struct sock *sk; | 
|  | 317 |  | 
|  | 318 | read_lock_bh(&x25_list_lock); | 
|  | 319 |  | 
|  | 320 | while ((sk = __x25_find_socket(lci, nb)) != NULL) { | 
|  | 321 | sock_put(sk); | 
|  | 322 | if (++lci == 4096) { | 
|  | 323 | lci = 0; | 
|  | 324 | break; | 
|  | 325 | } | 
|  | 326 | } | 
|  | 327 |  | 
|  | 328 | read_unlock_bh(&x25_list_lock); | 
|  | 329 | return lci; | 
|  | 330 | } | 
|  | 331 |  | 
|  | 332 | /* | 
|  | 333 | *	Deferred destroy. | 
|  | 334 | */ | 
|  | 335 | void x25_destroy_socket(struct sock *); | 
|  | 336 |  | 
|  | 337 | /* | 
|  | 338 | *	handler for deferred kills. | 
|  | 339 | */ | 
|  | 340 | static void x25_destroy_timer(unsigned long data) | 
|  | 341 | { | 
|  | 342 | x25_destroy_socket((struct sock *)data); | 
|  | 343 | } | 
|  | 344 |  | 
|  | 345 | /* | 
|  | 346 | *	This is called from user mode and the timers. Thus it protects itself | 
|  | 347 | *	against interrupt users but doesn't worry about being called during | 
|  | 348 | *	work. Once it is removed from the queue no interrupt or bottom half | 
|  | 349 | *	will touch it and we are (fairly 8-) ) safe. | 
|  | 350 | *	Not static as it's used by the timer | 
|  | 351 | */ | 
|  | 352 | void x25_destroy_socket(struct sock *sk) | 
|  | 353 | { | 
|  | 354 | struct sk_buff *skb; | 
|  | 355 |  | 
|  | 356 | sock_hold(sk); | 
|  | 357 | lock_sock(sk); | 
|  | 358 | x25_stop_heartbeat(sk); | 
|  | 359 | x25_stop_timer(sk); | 
|  | 360 |  | 
|  | 361 | x25_remove_socket(sk); | 
|  | 362 | x25_clear_queues(sk);		/* Flush the queues */ | 
|  | 363 |  | 
|  | 364 | while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) { | 
|  | 365 | if (skb->sk != sk) {		/* A pending connection */ | 
|  | 366 | /* | 
|  | 367 | * Queue the unaccepted socket for death | 
|  | 368 | */ | 
|  | 369 | sock_set_flag(skb->sk, SOCK_DEAD); | 
|  | 370 | x25_start_heartbeat(skb->sk); | 
|  | 371 | x25_sk(skb->sk)->state = X25_STATE_0; | 
|  | 372 | } | 
|  | 373 |  | 
|  | 374 | kfree_skb(skb); | 
|  | 375 | } | 
|  | 376 |  | 
|  | 377 | if (atomic_read(&sk->sk_wmem_alloc) || | 
|  | 378 | atomic_read(&sk->sk_rmem_alloc)) { | 
|  | 379 | /* Defer: outstanding buffers */ | 
|  | 380 | sk->sk_timer.expires  = jiffies + 10 * HZ; | 
|  | 381 | sk->sk_timer.function = x25_destroy_timer; | 
|  | 382 | sk->sk_timer.data = (unsigned long)sk; | 
|  | 383 | add_timer(&sk->sk_timer); | 
|  | 384 | } else { | 
|  | 385 | /* drop last reference so sock_put will free */ | 
|  | 386 | __sock_put(sk); | 
|  | 387 | } | 
|  | 388 |  | 
|  | 389 | release_sock(sk); | 
|  | 390 | sock_put(sk); | 
|  | 391 | } | 
|  | 392 |  | 
|  | 393 | /* | 
|  | 394 | *	Handling for system calls applied via the various interfaces to a | 
|  | 395 | *	X.25 socket object. | 
|  | 396 | */ | 
|  | 397 |  | 
|  | 398 | static int x25_setsockopt(struct socket *sock, int level, int optname, | 
|  | 399 | char __user *optval, int optlen) | 
|  | 400 | { | 
|  | 401 | int opt; | 
|  | 402 | struct sock *sk = sock->sk; | 
|  | 403 | int rc = -ENOPROTOOPT; | 
|  | 404 |  | 
|  | 405 | if (level != SOL_X25 || optname != X25_QBITINCL) | 
|  | 406 | goto out; | 
|  | 407 |  | 
|  | 408 | rc = -EINVAL; | 
|  | 409 | if (optlen < sizeof(int)) | 
|  | 410 | goto out; | 
|  | 411 |  | 
|  | 412 | rc = -EFAULT; | 
|  | 413 | if (get_user(opt, (int __user *)optval)) | 
|  | 414 | goto out; | 
|  | 415 |  | 
|  | 416 | x25_sk(sk)->qbitincl = !!opt; | 
|  | 417 | rc = 0; | 
|  | 418 | out: | 
|  | 419 | return rc; | 
|  | 420 | } | 
|  | 421 |  | 
|  | 422 | static int x25_getsockopt(struct socket *sock, int level, int optname, | 
|  | 423 | char __user *optval, int __user *optlen) | 
|  | 424 | { | 
|  | 425 | struct sock *sk = sock->sk; | 
|  | 426 | int val, len, rc = -ENOPROTOOPT; | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 427 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 428 | if (level != SOL_X25 || optname != X25_QBITINCL) | 
|  | 429 | goto out; | 
|  | 430 |  | 
|  | 431 | rc = -EFAULT; | 
|  | 432 | if (get_user(len, optlen)) | 
|  | 433 | goto out; | 
|  | 434 |  | 
|  | 435 | len = min_t(unsigned int, len, sizeof(int)); | 
|  | 436 |  | 
|  | 437 | rc = -EINVAL; | 
|  | 438 | if (len < 0) | 
|  | 439 | goto out; | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 440 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 441 | rc = -EFAULT; | 
|  | 442 | if (put_user(len, optlen)) | 
|  | 443 | goto out; | 
|  | 444 |  | 
|  | 445 | val = x25_sk(sk)->qbitincl; | 
|  | 446 | rc = copy_to_user(optval, &val, len) ? -EFAULT : 0; | 
|  | 447 | out: | 
|  | 448 | return rc; | 
|  | 449 | } | 
|  | 450 |  | 
|  | 451 | static int x25_listen(struct socket *sock, int backlog) | 
|  | 452 | { | 
|  | 453 | struct sock *sk = sock->sk; | 
|  | 454 | int rc = -EOPNOTSUPP; | 
|  | 455 |  | 
|  | 456 | if (sk->sk_state != TCP_LISTEN) { | 
|  | 457 | memset(&x25_sk(sk)->dest_addr, 0, X25_ADDR_LEN); | 
|  | 458 | sk->sk_max_ack_backlog = backlog; | 
|  | 459 | sk->sk_state           = TCP_LISTEN; | 
|  | 460 | rc = 0; | 
|  | 461 | } | 
|  | 462 |  | 
|  | 463 | return rc; | 
|  | 464 | } | 
|  | 465 |  | 
|  | 466 | static struct proto x25_proto = { | 
|  | 467 | .name	  = "X25", | 
|  | 468 | .owner	  = THIS_MODULE, | 
|  | 469 | .obj_size = sizeof(struct x25_sock), | 
|  | 470 | }; | 
|  | 471 |  | 
| Eric W. Biederman | 1b8d7ae | 2007-10-08 23:24:22 -0700 | [diff] [blame] | 472 | static struct sock *x25_alloc_socket(struct net *net) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 473 | { | 
|  | 474 | struct x25_sock *x25; | 
| Pavel Emelyanov | 6257ff2 | 2007-11-01 00:39:31 -0700 | [diff] [blame] | 475 | struct sock *sk = sk_alloc(net, AF_X25, GFP_ATOMIC, &x25_proto); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 476 |  | 
|  | 477 | if (!sk) | 
|  | 478 | goto out; | 
|  | 479 |  | 
|  | 480 | sock_init_data(NULL, sk); | 
|  | 481 |  | 
|  | 482 | x25 = x25_sk(sk); | 
|  | 483 | skb_queue_head_init(&x25->ack_queue); | 
|  | 484 | skb_queue_head_init(&x25->fragment_queue); | 
|  | 485 | skb_queue_head_init(&x25->interrupt_in_queue); | 
|  | 486 | skb_queue_head_init(&x25->interrupt_out_queue); | 
|  | 487 | out: | 
|  | 488 | return sk; | 
|  | 489 | } | 
|  | 490 |  | 
| Eric W. Biederman | 1b8d7ae | 2007-10-08 23:24:22 -0700 | [diff] [blame] | 491 | static int x25_create(struct net *net, struct socket *sock, int protocol) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 492 | { | 
|  | 493 | struct sock *sk; | 
|  | 494 | struct x25_sock *x25; | 
|  | 495 | int rc = -ESOCKTNOSUPPORT; | 
|  | 496 |  | 
| Eric W. Biederman | 1b8d7ae | 2007-10-08 23:24:22 -0700 | [diff] [blame] | 497 | if (net != &init_net) | 
|  | 498 | return -EAFNOSUPPORT; | 
|  | 499 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 500 | if (sock->type != SOCK_SEQPACKET || protocol) | 
|  | 501 | goto out; | 
|  | 502 |  | 
|  | 503 | rc = -ENOMEM; | 
| Eric W. Biederman | 1b8d7ae | 2007-10-08 23:24:22 -0700 | [diff] [blame] | 504 | if ((sk = x25_alloc_socket(net)) == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 505 | goto out; | 
|  | 506 |  | 
|  | 507 | x25 = x25_sk(sk); | 
|  | 508 |  | 
|  | 509 | sock_init_data(sock, sk); | 
|  | 510 |  | 
|  | 511 | x25_init_timers(sk); | 
|  | 512 |  | 
|  | 513 | sock->ops    = &x25_proto_ops; | 
|  | 514 | sk->sk_protocol = protocol; | 
|  | 515 | sk->sk_backlog_rcv = x25_backlog_rcv; | 
|  | 516 |  | 
|  | 517 | x25->t21   = sysctl_x25_call_request_timeout; | 
|  | 518 | x25->t22   = sysctl_x25_reset_request_timeout; | 
|  | 519 | x25->t23   = sysctl_x25_clear_request_timeout; | 
|  | 520 | x25->t2    = sysctl_x25_ack_holdback_timeout; | 
|  | 521 | x25->state = X25_STATE_0; | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 522 | x25->cudmatchlength = 0; | 
| Shaun Pereira | ebc3f64 | 2005-06-22 22:16:17 -0700 | [diff] [blame] | 523 | x25->accptapprv = X25_DENY_ACCPT_APPRV;		/* normally no cud  */ | 
|  | 524 | /* on call accept   */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 525 |  | 
|  | 526 | x25->facilities.winsize_in  = X25_DEFAULT_WINDOW_SIZE; | 
|  | 527 | x25->facilities.winsize_out = X25_DEFAULT_WINDOW_SIZE; | 
|  | 528 | x25->facilities.pacsize_in  = X25_DEFAULT_PACKET_SIZE; | 
|  | 529 | x25->facilities.pacsize_out = X25_DEFAULT_PACKET_SIZE; | 
|  | 530 | x25->facilities.throughput  = X25_DEFAULT_THROUGHPUT; | 
|  | 531 | x25->facilities.reverse     = X25_DEFAULT_REVERSE; | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 532 | x25->dte_facilities.calling_len = 0; | 
|  | 533 | x25->dte_facilities.called_len = 0; | 
|  | 534 | memset(x25->dte_facilities.called_ae, '\0', | 
|  | 535 | sizeof(x25->dte_facilities.called_ae)); | 
|  | 536 | memset(x25->dte_facilities.calling_ae, '\0', | 
|  | 537 | sizeof(x25->dte_facilities.calling_ae)); | 
| Shaun Pereira | a64b7b9 | 2006-03-22 00:01:31 -0800 | [diff] [blame] | 538 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 539 | rc = 0; | 
|  | 540 | out: | 
|  | 541 | return rc; | 
|  | 542 | } | 
|  | 543 |  | 
|  | 544 | static struct sock *x25_make_new(struct sock *osk) | 
|  | 545 | { | 
|  | 546 | struct sock *sk = NULL; | 
|  | 547 | struct x25_sock *x25, *ox25; | 
|  | 548 |  | 
|  | 549 | if (osk->sk_type != SOCK_SEQPACKET) | 
|  | 550 | goto out; | 
|  | 551 |  | 
| YOSHIFUJI Hideaki | 3b1e0a6 | 2008-03-26 02:26:21 +0900 | [diff] [blame] | 552 | if ((sk = x25_alloc_socket(sock_net(osk))) == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 553 | goto out; | 
|  | 554 |  | 
|  | 555 | x25 = x25_sk(sk); | 
|  | 556 |  | 
|  | 557 | sk->sk_type        = osk->sk_type; | 
|  | 558 | sk->sk_socket      = osk->sk_socket; | 
|  | 559 | sk->sk_priority    = osk->sk_priority; | 
|  | 560 | sk->sk_protocol    = osk->sk_protocol; | 
|  | 561 | sk->sk_rcvbuf      = osk->sk_rcvbuf; | 
|  | 562 | sk->sk_sndbuf      = osk->sk_sndbuf; | 
|  | 563 | sk->sk_state       = TCP_ESTABLISHED; | 
|  | 564 | sk->sk_sleep       = osk->sk_sleep; | 
|  | 565 | sk->sk_backlog_rcv = osk->sk_backlog_rcv; | 
| Shaun Pereira | a20a855 | 2006-01-06 13:11:35 -0800 | [diff] [blame] | 566 | sock_copy_flags(sk, osk); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 567 |  | 
|  | 568 | ox25 = x25_sk(osk); | 
|  | 569 | x25->t21        = ox25->t21; | 
|  | 570 | x25->t22        = ox25->t22; | 
|  | 571 | x25->t23        = ox25->t23; | 
|  | 572 | x25->t2         = ox25->t2; | 
|  | 573 | x25->facilities = ox25->facilities; | 
|  | 574 | x25->qbitincl   = ox25->qbitincl; | 
| Shaun Pereira | a64b7b9 | 2006-03-22 00:01:31 -0800 | [diff] [blame] | 575 | x25->dte_facilities = ox25->dte_facilities; | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 576 | x25->cudmatchlength = ox25->cudmatchlength; | 
| Shaun Pereira | ebc3f64 | 2005-06-22 22:16:17 -0700 | [diff] [blame] | 577 | x25->accptapprv = ox25->accptapprv; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 578 |  | 
|  | 579 | x25_init_timers(sk); | 
|  | 580 | out: | 
|  | 581 | return sk; | 
|  | 582 | } | 
|  | 583 |  | 
|  | 584 | static int x25_release(struct socket *sock) | 
|  | 585 | { | 
|  | 586 | struct sock *sk = sock->sk; | 
|  | 587 | struct x25_sock *x25; | 
|  | 588 |  | 
|  | 589 | if (!sk) | 
|  | 590 | goto out; | 
|  | 591 |  | 
|  | 592 | x25 = x25_sk(sk); | 
|  | 593 |  | 
|  | 594 | switch (x25->state) { | 
|  | 595 |  | 
|  | 596 | case X25_STATE_0: | 
|  | 597 | case X25_STATE_2: | 
|  | 598 | x25_disconnect(sk, 0, 0, 0); | 
|  | 599 | x25_destroy_socket(sk); | 
|  | 600 | goto out; | 
|  | 601 |  | 
|  | 602 | case X25_STATE_1: | 
|  | 603 | case X25_STATE_3: | 
|  | 604 | case X25_STATE_4: | 
|  | 605 | x25_clear_queues(sk); | 
|  | 606 | x25_write_internal(sk, X25_CLEAR_REQUEST); | 
|  | 607 | x25_start_t23timer(sk); | 
|  | 608 | x25->state = X25_STATE_2; | 
|  | 609 | sk->sk_state	= TCP_CLOSE; | 
|  | 610 | sk->sk_shutdown	|= SEND_SHUTDOWN; | 
|  | 611 | sk->sk_state_change(sk); | 
|  | 612 | sock_set_flag(sk, SOCK_DEAD); | 
|  | 613 | sock_set_flag(sk, SOCK_DESTROY); | 
|  | 614 | break; | 
|  | 615 | } | 
|  | 616 |  | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 617 | sock->sk	= NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 618 | sk->sk_socket	= NULL;	/* Not used, but we should do this */ | 
|  | 619 | out: | 
|  | 620 | return 0; | 
|  | 621 | } | 
|  | 622 |  | 
|  | 623 | static int x25_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len) | 
|  | 624 | { | 
|  | 625 | struct sock *sk = sock->sk; | 
|  | 626 | struct sockaddr_x25 *addr = (struct sockaddr_x25 *)uaddr; | 
|  | 627 |  | 
|  | 628 | if (!sock_flag(sk, SOCK_ZAPPED) || | 
|  | 629 | addr_len != sizeof(struct sockaddr_x25) || | 
|  | 630 | addr->sx25_family != AF_X25) | 
|  | 631 | return -EINVAL; | 
|  | 632 |  | 
|  | 633 | x25_sk(sk)->source_addr = addr->sx25_addr; | 
|  | 634 | x25_insert_socket(sk); | 
|  | 635 | sock_reset_flag(sk, SOCK_ZAPPED); | 
|  | 636 | SOCK_DEBUG(sk, "x25_bind: socket is bound\n"); | 
|  | 637 |  | 
|  | 638 | return 0; | 
|  | 639 | } | 
|  | 640 |  | 
|  | 641 | static int x25_wait_for_connection_establishment(struct sock *sk) | 
|  | 642 | { | 
|  | 643 | DECLARE_WAITQUEUE(wait, current); | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 644 | int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 645 |  | 
|  | 646 | add_wait_queue_exclusive(sk->sk_sleep, &wait); | 
|  | 647 | for (;;) { | 
|  | 648 | __set_current_state(TASK_INTERRUPTIBLE); | 
|  | 649 | rc = -ERESTARTSYS; | 
|  | 650 | if (signal_pending(current)) | 
|  | 651 | break; | 
|  | 652 | rc = sock_error(sk); | 
|  | 653 | if (rc) { | 
|  | 654 | sk->sk_socket->state = SS_UNCONNECTED; | 
|  | 655 | break; | 
|  | 656 | } | 
|  | 657 | rc = 0; | 
|  | 658 | if (sk->sk_state != TCP_ESTABLISHED) { | 
|  | 659 | release_sock(sk); | 
|  | 660 | schedule(); | 
|  | 661 | lock_sock(sk); | 
|  | 662 | } else | 
|  | 663 | break; | 
|  | 664 | } | 
|  | 665 | __set_current_state(TASK_RUNNING); | 
|  | 666 | remove_wait_queue(sk->sk_sleep, &wait); | 
|  | 667 | return rc; | 
|  | 668 | } | 
|  | 669 |  | 
|  | 670 | static int x25_connect(struct socket *sock, struct sockaddr *uaddr, | 
|  | 671 | int addr_len, int flags) | 
|  | 672 | { | 
|  | 673 | struct sock *sk = sock->sk; | 
|  | 674 | struct x25_sock *x25 = x25_sk(sk); | 
|  | 675 | struct sockaddr_x25 *addr = (struct sockaddr_x25 *)uaddr; | 
|  | 676 | struct x25_route *rt; | 
|  | 677 | int rc = 0; | 
|  | 678 |  | 
|  | 679 | lock_sock(sk); | 
|  | 680 | if (sk->sk_state == TCP_ESTABLISHED && sock->state == SS_CONNECTING) { | 
|  | 681 | sock->state = SS_CONNECTED; | 
|  | 682 | goto out; /* Connect completed during a ERESTARTSYS event */ | 
|  | 683 | } | 
|  | 684 |  | 
|  | 685 | rc = -ECONNREFUSED; | 
|  | 686 | if (sk->sk_state == TCP_CLOSE && sock->state == SS_CONNECTING) { | 
|  | 687 | sock->state = SS_UNCONNECTED; | 
|  | 688 | goto out; | 
|  | 689 | } | 
|  | 690 |  | 
|  | 691 | rc = -EISCONN;	/* No reconnect on a seqpacket socket */ | 
|  | 692 | if (sk->sk_state == TCP_ESTABLISHED) | 
|  | 693 | goto out; | 
|  | 694 |  | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 695 | sk->sk_state   = TCP_CLOSE; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 696 | sock->state = SS_UNCONNECTED; | 
|  | 697 |  | 
|  | 698 | rc = -EINVAL; | 
|  | 699 | if (addr_len != sizeof(struct sockaddr_x25) || | 
|  | 700 | addr->sx25_family != AF_X25) | 
|  | 701 | goto out; | 
|  | 702 |  | 
|  | 703 | rc = -ENETUNREACH; | 
|  | 704 | rt = x25_get_route(&addr->sx25_addr); | 
|  | 705 | if (!rt) | 
|  | 706 | goto out; | 
|  | 707 |  | 
|  | 708 | x25->neighbour = x25_get_neigh(rt->dev); | 
|  | 709 | if (!x25->neighbour) | 
|  | 710 | goto out_put_route; | 
|  | 711 |  | 
|  | 712 | x25_limit_facilities(&x25->facilities, x25->neighbour); | 
|  | 713 |  | 
|  | 714 | x25->lci = x25_new_lci(x25->neighbour); | 
|  | 715 | if (!x25->lci) | 
|  | 716 | goto out_put_neigh; | 
|  | 717 |  | 
|  | 718 | rc = -EINVAL; | 
|  | 719 | if (sock_flag(sk, SOCK_ZAPPED)) /* Must bind first - autobinding does not work */ | 
|  | 720 | goto out_put_neigh; | 
|  | 721 |  | 
|  | 722 | if (!strcmp(x25->source_addr.x25_addr, null_x25_address.x25_addr)) | 
|  | 723 | memset(&x25->source_addr, '\0', X25_ADDR_LEN); | 
|  | 724 |  | 
|  | 725 | x25->dest_addr = addr->sx25_addr; | 
|  | 726 |  | 
|  | 727 | /* Move to connecting socket, start sending Connect Requests */ | 
|  | 728 | sock->state   = SS_CONNECTING; | 
|  | 729 | sk->sk_state  = TCP_SYN_SENT; | 
|  | 730 |  | 
|  | 731 | x25->state = X25_STATE_1; | 
|  | 732 |  | 
|  | 733 | x25_write_internal(sk, X25_CALL_REQUEST); | 
|  | 734 |  | 
|  | 735 | x25_start_heartbeat(sk); | 
|  | 736 | x25_start_t21timer(sk); | 
|  | 737 |  | 
|  | 738 | /* Now the loop */ | 
|  | 739 | rc = -EINPROGRESS; | 
|  | 740 | if (sk->sk_state != TCP_ESTABLISHED && (flags & O_NONBLOCK)) | 
|  | 741 | goto out_put_neigh; | 
|  | 742 |  | 
|  | 743 | rc = x25_wait_for_connection_establishment(sk); | 
|  | 744 | if (rc) | 
|  | 745 | goto out_put_neigh; | 
|  | 746 |  | 
|  | 747 | sock->state = SS_CONNECTED; | 
|  | 748 | rc = 0; | 
|  | 749 | out_put_neigh: | 
|  | 750 | if (rc) | 
|  | 751 | x25_neigh_put(x25->neighbour); | 
|  | 752 | out_put_route: | 
|  | 753 | x25_route_put(rt); | 
|  | 754 | out: | 
|  | 755 | release_sock(sk); | 
|  | 756 | return rc; | 
|  | 757 | } | 
|  | 758 |  | 
| Shaun Pereira | bac37ec | 2006-03-22 00:00:40 -0800 | [diff] [blame] | 759 | static int x25_wait_for_data(struct sock *sk, long timeout) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 760 | { | 
|  | 761 | DECLARE_WAITQUEUE(wait, current); | 
|  | 762 | int rc = 0; | 
|  | 763 |  | 
|  | 764 | add_wait_queue_exclusive(sk->sk_sleep, &wait); | 
|  | 765 | for (;;) { | 
|  | 766 | __set_current_state(TASK_INTERRUPTIBLE); | 
|  | 767 | if (sk->sk_shutdown & RCV_SHUTDOWN) | 
|  | 768 | break; | 
|  | 769 | rc = -ERESTARTSYS; | 
|  | 770 | if (signal_pending(current)) | 
|  | 771 | break; | 
|  | 772 | rc = -EAGAIN; | 
|  | 773 | if (!timeout) | 
|  | 774 | break; | 
|  | 775 | rc = 0; | 
|  | 776 | if (skb_queue_empty(&sk->sk_receive_queue)) { | 
|  | 777 | release_sock(sk); | 
|  | 778 | timeout = schedule_timeout(timeout); | 
|  | 779 | lock_sock(sk); | 
|  | 780 | } else | 
|  | 781 | break; | 
|  | 782 | } | 
|  | 783 | __set_current_state(TASK_RUNNING); | 
|  | 784 | remove_wait_queue(sk->sk_sleep, &wait); | 
|  | 785 | return rc; | 
|  | 786 | } | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 787 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 788 | static int x25_accept(struct socket *sock, struct socket *newsock, int flags) | 
|  | 789 | { | 
|  | 790 | struct sock *sk = sock->sk; | 
|  | 791 | struct sock *newsk; | 
|  | 792 | struct sk_buff *skb; | 
|  | 793 | int rc = -EINVAL; | 
|  | 794 |  | 
|  | 795 | if (!sk || sk->sk_state != TCP_LISTEN) | 
|  | 796 | goto out; | 
|  | 797 |  | 
|  | 798 | rc = -EOPNOTSUPP; | 
|  | 799 | if (sk->sk_type != SOCK_SEQPACKET) | 
|  | 800 | goto out; | 
|  | 801 |  | 
|  | 802 | lock_sock(sk); | 
|  | 803 | rc = x25_wait_for_data(sk, sk->sk_rcvtimeo); | 
|  | 804 | if (rc) | 
|  | 805 | goto out2; | 
|  | 806 | skb = skb_dequeue(&sk->sk_receive_queue); | 
|  | 807 | rc = -EINVAL; | 
|  | 808 | if (!skb->sk) | 
|  | 809 | goto out2; | 
|  | 810 | newsk		 = skb->sk; | 
|  | 811 | newsk->sk_socket = newsock; | 
|  | 812 | newsk->sk_sleep  = &newsock->wait; | 
|  | 813 |  | 
|  | 814 | /* Now attach up the new socket */ | 
|  | 815 | skb->sk = NULL; | 
|  | 816 | kfree_skb(skb); | 
|  | 817 | sk->sk_ack_backlog--; | 
|  | 818 | newsock->sk    = newsk; | 
|  | 819 | newsock->state = SS_CONNECTED; | 
|  | 820 | rc = 0; | 
|  | 821 | out2: | 
|  | 822 | release_sock(sk); | 
|  | 823 | out: | 
|  | 824 | return rc; | 
|  | 825 | } | 
|  | 826 |  | 
|  | 827 | static int x25_getname(struct socket *sock, struct sockaddr *uaddr, | 
|  | 828 | int *uaddr_len, int peer) | 
|  | 829 | { | 
|  | 830 | struct sockaddr_x25 *sx25 = (struct sockaddr_x25 *)uaddr; | 
|  | 831 | struct sock *sk = sock->sk; | 
|  | 832 | struct x25_sock *x25 = x25_sk(sk); | 
|  | 833 |  | 
|  | 834 | if (peer) { | 
|  | 835 | if (sk->sk_state != TCP_ESTABLISHED) | 
|  | 836 | return -ENOTCONN; | 
|  | 837 | sx25->sx25_addr = x25->dest_addr; | 
|  | 838 | } else | 
|  | 839 | sx25->sx25_addr = x25->source_addr; | 
|  | 840 |  | 
|  | 841 | sx25->sx25_family = AF_X25; | 
|  | 842 | *uaddr_len = sizeof(*sx25); | 
|  | 843 |  | 
|  | 844 | return 0; | 
|  | 845 | } | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 846 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 847 | int x25_rx_call_request(struct sk_buff *skb, struct x25_neigh *nb, | 
|  | 848 | unsigned int lci) | 
|  | 849 | { | 
|  | 850 | struct sock *sk; | 
|  | 851 | struct sock *make; | 
|  | 852 | struct x25_sock *makex25; | 
|  | 853 | struct x25_address source_addr, dest_addr; | 
|  | 854 | struct x25_facilities facilities; | 
| Shaun Pereira | a64b7b9 | 2006-03-22 00:01:31 -0800 | [diff] [blame] | 855 | struct x25_dte_facilities dte_facilities; | 
| Andrew Hendry | 95a9dc4 | 2007-02-08 13:34:02 -0800 | [diff] [blame] | 856 | int len, addr_len, rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 857 |  | 
|  | 858 | /* | 
|  | 859 | *	Remove the LCI and frame type. | 
|  | 860 | */ | 
|  | 861 | skb_pull(skb, X25_STD_MIN_LEN); | 
|  | 862 |  | 
|  | 863 | /* | 
|  | 864 | *	Extract the X.25 addresses and convert them to ASCII strings, | 
|  | 865 | *	and remove them. | 
|  | 866 | */ | 
| Andrew Hendry | 95a9dc4 | 2007-02-08 13:34:02 -0800 | [diff] [blame] | 867 | addr_len = x25_addr_ntoa(skb->data, &source_addr, &dest_addr); | 
|  | 868 | skb_pull(skb, addr_len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 869 |  | 
|  | 870 | /* | 
|  | 871 | *	Get the length of the facilities, skip past them for the moment | 
|  | 872 | *	get the call user data because this is needed to determine | 
|  | 873 | *	the correct listener | 
|  | 874 | */ | 
|  | 875 | len = skb->data[0] + 1; | 
|  | 876 | skb_pull(skb,len); | 
|  | 877 |  | 
|  | 878 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 879 | *	Find a listener for the particular address/cud pair. | 
|  | 880 | */ | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 881 | sk = x25_find_listener(&source_addr,skb); | 
|  | 882 | skb_push(skb,len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 883 |  | 
| Andrew Hendry | 95a9dc4 | 2007-02-08 13:34:02 -0800 | [diff] [blame] | 884 | if (sk != NULL && sk_acceptq_is_full(sk)) { | 
|  | 885 | goto out_sock_put; | 
|  | 886 | } | 
|  | 887 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 888 | /* | 
| Andrew Hendry | 95a9dc4 | 2007-02-08 13:34:02 -0800 | [diff] [blame] | 889 | *	We dont have any listeners for this incoming call. | 
|  | 890 | *	Try forwarding it. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 891 | */ | 
| Andrew Hendry | 95a9dc4 | 2007-02-08 13:34:02 -0800 | [diff] [blame] | 892 | if (sk == NULL) { | 
|  | 893 | skb_push(skb, addr_len + X25_STD_MIN_LEN); | 
| Andrew Hendry | 39e21c0 | 2007-02-08 13:34:36 -0800 | [diff] [blame] | 894 | if (sysctl_x25_forward && | 
|  | 895 | x25_forward_call(&dest_addr, nb, skb, lci) > 0) | 
| Andrew Hendry | 95a9dc4 | 2007-02-08 13:34:02 -0800 | [diff] [blame] | 896 | { | 
|  | 897 | /* Call was forwarded, dont process it any more */ | 
|  | 898 | kfree_skb(skb); | 
|  | 899 | rc = 1; | 
|  | 900 | goto out; | 
|  | 901 | } else { | 
|  | 902 | /* No listeners, can't forward, clear the call */ | 
|  | 903 | goto out_clear_request; | 
|  | 904 | } | 
|  | 905 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 906 |  | 
|  | 907 | /* | 
|  | 908 | *	Try to reach a compromise on the requested facilities. | 
|  | 909 | */ | 
| Shaun Pereira | a64b7b9 | 2006-03-22 00:01:31 -0800 | [diff] [blame] | 910 | len = x25_negotiate_facilities(skb, sk, &facilities, &dte_facilities); | 
|  | 911 | if (len == -1) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 912 | goto out_sock_put; | 
|  | 913 |  | 
|  | 914 | /* | 
|  | 915 | * current neighbour/link might impose additional limits | 
|  | 916 | * on certain facilties | 
|  | 917 | */ | 
|  | 918 |  | 
|  | 919 | x25_limit_facilities(&facilities, nb); | 
|  | 920 |  | 
|  | 921 | /* | 
|  | 922 | *	Try to create a new socket. | 
|  | 923 | */ | 
|  | 924 | make = x25_make_new(sk); | 
|  | 925 | if (!make) | 
|  | 926 | goto out_sock_put; | 
|  | 927 |  | 
|  | 928 | /* | 
|  | 929 | *	Remove the facilities | 
|  | 930 | */ | 
|  | 931 | skb_pull(skb, len); | 
|  | 932 |  | 
|  | 933 | skb->sk     = make; | 
|  | 934 | make->sk_state = TCP_ESTABLISHED; | 
|  | 935 |  | 
|  | 936 | makex25 = x25_sk(make); | 
|  | 937 | makex25->lci           = lci; | 
|  | 938 | makex25->dest_addr     = dest_addr; | 
|  | 939 | makex25->source_addr   = source_addr; | 
|  | 940 | makex25->neighbour     = nb; | 
|  | 941 | makex25->facilities    = facilities; | 
| Shaun Pereira | a64b7b9 | 2006-03-22 00:01:31 -0800 | [diff] [blame] | 942 | makex25->dte_facilities= dte_facilities; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 943 | makex25->vc_facil_mask = x25_sk(sk)->vc_facil_mask; | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 944 | /* ensure no reverse facil on accept */ | 
|  | 945 | makex25->vc_facil_mask &= ~X25_MASK_REVERSE; | 
| Shaun Pereira | a64b7b9 | 2006-03-22 00:01:31 -0800 | [diff] [blame] | 946 | /* ensure no calling address extension on accept */ | 
|  | 947 | makex25->vc_facil_mask &= ~X25_MASK_CALLING_AE; | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 948 | makex25->cudmatchlength = x25_sk(sk)->cudmatchlength; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 949 |  | 
| Shaun Pereira | ebc3f64 | 2005-06-22 22:16:17 -0700 | [diff] [blame] | 950 | /* Normally all calls are accepted immediatly */ | 
|  | 951 | if(makex25->accptapprv & X25_DENY_ACCPT_APPRV) { | 
|  | 952 | x25_write_internal(make, X25_CALL_ACCEPTED); | 
|  | 953 | makex25->state = X25_STATE_3; | 
|  | 954 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 955 |  | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 956 | /* | 
|  | 957 | *	Incoming Call User Data. | 
|  | 958 | */ | 
|  | 959 | if (skb->len >= 0) { | 
| Arnaldo Carvalho de Melo | d626f62 | 2007-03-27 18:55:52 -0300 | [diff] [blame] | 960 | skb_copy_from_linear_data(skb, makex25->calluserdata.cuddata, skb->len); | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 961 | makex25->calluserdata.cudlength = skb->len; | 
|  | 962 | } | 
|  | 963 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 964 | sk->sk_ack_backlog++; | 
|  | 965 |  | 
|  | 966 | x25_insert_socket(make); | 
|  | 967 |  | 
|  | 968 | skb_queue_head(&sk->sk_receive_queue, skb); | 
|  | 969 |  | 
|  | 970 | x25_start_heartbeat(make); | 
|  | 971 |  | 
|  | 972 | if (!sock_flag(sk, SOCK_DEAD)) | 
|  | 973 | sk->sk_data_ready(sk, skb->len); | 
|  | 974 | rc = 1; | 
|  | 975 | sock_put(sk); | 
|  | 976 | out: | 
|  | 977 | return rc; | 
|  | 978 | out_sock_put: | 
|  | 979 | sock_put(sk); | 
|  | 980 | out_clear_request: | 
|  | 981 | rc = 0; | 
|  | 982 | x25_transmit_clear_request(nb, lci, 0x01); | 
|  | 983 | goto out; | 
|  | 984 | } | 
|  | 985 |  | 
|  | 986 | static int x25_sendmsg(struct kiocb *iocb, struct socket *sock, | 
|  | 987 | struct msghdr *msg, size_t len) | 
|  | 988 | { | 
|  | 989 | struct sock *sk = sock->sk; | 
|  | 990 | struct x25_sock *x25 = x25_sk(sk); | 
|  | 991 | struct sockaddr_x25 *usx25 = (struct sockaddr_x25 *)msg->msg_name; | 
|  | 992 | struct sockaddr_x25 sx25; | 
|  | 993 | struct sk_buff *skb; | 
|  | 994 | unsigned char *asmptr; | 
|  | 995 | int noblock = msg->msg_flags & MSG_DONTWAIT; | 
|  | 996 | size_t size; | 
|  | 997 | int qbit = 0, rc = -EINVAL; | 
|  | 998 |  | 
|  | 999 | if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_OOB|MSG_EOR|MSG_CMSG_COMPAT)) | 
|  | 1000 | goto out; | 
|  | 1001 |  | 
|  | 1002 | /* we currently don't support segmented records at the user interface */ | 
|  | 1003 | if (!(msg->msg_flags & (MSG_EOR|MSG_OOB))) | 
|  | 1004 | goto out; | 
|  | 1005 |  | 
|  | 1006 | rc = -EADDRNOTAVAIL; | 
|  | 1007 | if (sock_flag(sk, SOCK_ZAPPED)) | 
|  | 1008 | goto out; | 
|  | 1009 |  | 
|  | 1010 | rc = -EPIPE; | 
|  | 1011 | if (sk->sk_shutdown & SEND_SHUTDOWN) { | 
|  | 1012 | send_sig(SIGPIPE, current, 0); | 
|  | 1013 | goto out; | 
|  | 1014 | } | 
|  | 1015 |  | 
|  | 1016 | rc = -ENETUNREACH; | 
|  | 1017 | if (!x25->neighbour) | 
|  | 1018 | goto out; | 
|  | 1019 |  | 
|  | 1020 | if (usx25) { | 
|  | 1021 | rc = -EINVAL; | 
|  | 1022 | if (msg->msg_namelen < sizeof(sx25)) | 
|  | 1023 | goto out; | 
|  | 1024 | memcpy(&sx25, usx25, sizeof(sx25)); | 
|  | 1025 | rc = -EISCONN; | 
|  | 1026 | if (strcmp(x25->dest_addr.x25_addr, sx25.sx25_addr.x25_addr)) | 
|  | 1027 | goto out; | 
|  | 1028 | rc = -EINVAL; | 
|  | 1029 | if (sx25.sx25_family != AF_X25) | 
|  | 1030 | goto out; | 
|  | 1031 | } else { | 
|  | 1032 | /* | 
|  | 1033 | *	FIXME 1003.1g - if the socket is like this because | 
|  | 1034 | *	it has become closed (not started closed) we ought | 
|  | 1035 | *	to SIGPIPE, EPIPE; | 
|  | 1036 | */ | 
|  | 1037 | rc = -ENOTCONN; | 
|  | 1038 | if (sk->sk_state != TCP_ESTABLISHED) | 
|  | 1039 | goto out; | 
|  | 1040 |  | 
|  | 1041 | sx25.sx25_family = AF_X25; | 
|  | 1042 | sx25.sx25_addr   = x25->dest_addr; | 
|  | 1043 | } | 
|  | 1044 |  | 
|  | 1045 | SOCK_DEBUG(sk, "x25_sendmsg: sendto: Addresses built.\n"); | 
|  | 1046 |  | 
|  | 1047 | /* Build a packet */ | 
|  | 1048 | SOCK_DEBUG(sk, "x25_sendmsg: sendto: building packet.\n"); | 
|  | 1049 |  | 
|  | 1050 | if ((msg->msg_flags & MSG_OOB) && len > 32) | 
|  | 1051 | len = 32; | 
|  | 1052 |  | 
|  | 1053 | size = len + X25_MAX_L2_LEN + X25_EXT_MIN_LEN; | 
|  | 1054 |  | 
|  | 1055 | skb = sock_alloc_send_skb(sk, size, noblock, &rc); | 
|  | 1056 | if (!skb) | 
|  | 1057 | goto out; | 
|  | 1058 | X25_SKB_CB(skb)->flags = msg->msg_flags; | 
|  | 1059 |  | 
|  | 1060 | skb_reserve(skb, X25_MAX_L2_LEN + X25_EXT_MIN_LEN); | 
|  | 1061 |  | 
|  | 1062 | /* | 
|  | 1063 | *	Put the data on the end | 
|  | 1064 | */ | 
|  | 1065 | SOCK_DEBUG(sk, "x25_sendmsg: Copying user data\n"); | 
|  | 1066 |  | 
| Arnaldo Carvalho de Melo | eeeb037 | 2007-03-14 21:04:34 -0300 | [diff] [blame] | 1067 | skb_reset_transport_header(skb); | 
|  | 1068 | skb_put(skb, len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1069 |  | 
| Arnaldo Carvalho de Melo | eeeb037 | 2007-03-14 21:04:34 -0300 | [diff] [blame] | 1070 | rc = memcpy_fromiovec(skb_transport_header(skb), msg->msg_iov, len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1071 | if (rc) | 
|  | 1072 | goto out_kfree_skb; | 
|  | 1073 |  | 
|  | 1074 | /* | 
|  | 1075 | *	If the Q BIT Include socket option is in force, the first | 
|  | 1076 | *	byte of the user data is the logical value of the Q Bit. | 
|  | 1077 | */ | 
|  | 1078 | if (x25->qbitincl) { | 
|  | 1079 | qbit = skb->data[0]; | 
|  | 1080 | skb_pull(skb, 1); | 
|  | 1081 | } | 
|  | 1082 |  | 
|  | 1083 | /* | 
|  | 1084 | *	Push down the X.25 header | 
|  | 1085 | */ | 
|  | 1086 | SOCK_DEBUG(sk, "x25_sendmsg: Building X.25 Header.\n"); | 
|  | 1087 |  | 
|  | 1088 | if (msg->msg_flags & MSG_OOB) { | 
|  | 1089 | if (x25->neighbour->extended) { | 
|  | 1090 | asmptr    = skb_push(skb, X25_STD_MIN_LEN); | 
|  | 1091 | *asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_EXTSEQ; | 
|  | 1092 | *asmptr++ = (x25->lci >> 0) & 0xFF; | 
|  | 1093 | *asmptr++ = X25_INTERRUPT; | 
|  | 1094 | } else { | 
|  | 1095 | asmptr    = skb_push(skb, X25_STD_MIN_LEN); | 
|  | 1096 | *asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_STDSEQ; | 
|  | 1097 | *asmptr++ = (x25->lci >> 0) & 0xFF; | 
|  | 1098 | *asmptr++ = X25_INTERRUPT; | 
|  | 1099 | } | 
|  | 1100 | } else { | 
|  | 1101 | if (x25->neighbour->extended) { | 
|  | 1102 | /* Build an Extended X.25 header */ | 
|  | 1103 | asmptr    = skb_push(skb, X25_EXT_MIN_LEN); | 
|  | 1104 | *asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_EXTSEQ; | 
|  | 1105 | *asmptr++ = (x25->lci >> 0) & 0xFF; | 
|  | 1106 | *asmptr++ = X25_DATA; | 
|  | 1107 | *asmptr++ = X25_DATA; | 
|  | 1108 | } else { | 
|  | 1109 | /* Build an Standard X.25 header */ | 
|  | 1110 | asmptr    = skb_push(skb, X25_STD_MIN_LEN); | 
|  | 1111 | *asmptr++ = ((x25->lci >> 8) & 0x0F) | X25_GFI_STDSEQ; | 
|  | 1112 | *asmptr++ = (x25->lci >> 0) & 0xFF; | 
|  | 1113 | *asmptr++ = X25_DATA; | 
|  | 1114 | } | 
|  | 1115 |  | 
|  | 1116 | if (qbit) | 
|  | 1117 | skb->data[0] |= X25_Q_BIT; | 
|  | 1118 | } | 
|  | 1119 |  | 
|  | 1120 | SOCK_DEBUG(sk, "x25_sendmsg: Built header.\n"); | 
|  | 1121 | SOCK_DEBUG(sk, "x25_sendmsg: Transmitting buffer\n"); | 
|  | 1122 |  | 
|  | 1123 | rc = -ENOTCONN; | 
|  | 1124 | if (sk->sk_state != TCP_ESTABLISHED) | 
|  | 1125 | goto out_kfree_skb; | 
|  | 1126 |  | 
|  | 1127 | if (msg->msg_flags & MSG_OOB) | 
|  | 1128 | skb_queue_tail(&x25->interrupt_out_queue, skb); | 
|  | 1129 | else { | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 1130 | len = x25_output(sk, skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1131 | if (len < 0) | 
|  | 1132 | kfree_skb(skb); | 
|  | 1133 | else if (x25->qbitincl) | 
|  | 1134 | len++; | 
|  | 1135 | } | 
|  | 1136 |  | 
|  | 1137 | /* | 
|  | 1138 | * lock_sock() is currently only used to serialize this x25_kick() | 
|  | 1139 | * against input-driven x25_kick() calls. It currently only blocks | 
|  | 1140 | * incoming packets for this socket and does not protect against | 
|  | 1141 | * any other socket state changes and is not called from anywhere | 
|  | 1142 | * else. As x25_kick() cannot block and as long as all socket | 
|  | 1143 | * operations are BKL-wrapped, we don't need take to care about | 
|  | 1144 | * purging the backlog queue in x25_release(). | 
|  | 1145 | * | 
|  | 1146 | * Using lock_sock() to protect all socket operations entirely | 
|  | 1147 | * (and making the whole x25 stack SMP aware) unfortunately would | 
|  | 1148 | * require major changes to {send,recv}msg and skb allocation methods. | 
|  | 1149 | * -> 2.5 ;) | 
|  | 1150 | */ | 
|  | 1151 | lock_sock(sk); | 
|  | 1152 | x25_kick(sk); | 
|  | 1153 | release_sock(sk); | 
|  | 1154 | rc = len; | 
|  | 1155 | out: | 
|  | 1156 | return rc; | 
|  | 1157 | out_kfree_skb: | 
|  | 1158 | kfree_skb(skb); | 
|  | 1159 | goto out; | 
|  | 1160 | } | 
|  | 1161 |  | 
|  | 1162 |  | 
|  | 1163 | static int x25_recvmsg(struct kiocb *iocb, struct socket *sock, | 
|  | 1164 | struct msghdr *msg, size_t size, | 
|  | 1165 | int flags) | 
|  | 1166 | { | 
|  | 1167 | struct sock *sk = sock->sk; | 
|  | 1168 | struct x25_sock *x25 = x25_sk(sk); | 
|  | 1169 | struct sockaddr_x25 *sx25 = (struct sockaddr_x25 *)msg->msg_name; | 
|  | 1170 | size_t copied; | 
|  | 1171 | int qbit; | 
|  | 1172 | struct sk_buff *skb; | 
|  | 1173 | unsigned char *asmptr; | 
|  | 1174 | int rc = -ENOTCONN; | 
|  | 1175 |  | 
|  | 1176 | /* | 
|  | 1177 | * This works for seqpacket too. The receiver has ordered the queue for | 
|  | 1178 | * us! We do one quick check first though | 
|  | 1179 | */ | 
|  | 1180 | if (sk->sk_state != TCP_ESTABLISHED) | 
|  | 1181 | goto out; | 
|  | 1182 |  | 
|  | 1183 | if (flags & MSG_OOB) { | 
|  | 1184 | rc = -EINVAL; | 
|  | 1185 | if (sock_flag(sk, SOCK_URGINLINE) || | 
|  | 1186 | !skb_peek(&x25->interrupt_in_queue)) | 
|  | 1187 | goto out; | 
|  | 1188 |  | 
|  | 1189 | skb = skb_dequeue(&x25->interrupt_in_queue); | 
|  | 1190 |  | 
|  | 1191 | skb_pull(skb, X25_STD_MIN_LEN); | 
|  | 1192 |  | 
|  | 1193 | /* | 
|  | 1194 | *	No Q bit information on Interrupt data. | 
|  | 1195 | */ | 
|  | 1196 | if (x25->qbitincl) { | 
|  | 1197 | asmptr  = skb_push(skb, 1); | 
|  | 1198 | *asmptr = 0x00; | 
|  | 1199 | } | 
|  | 1200 |  | 
|  | 1201 | msg->msg_flags |= MSG_OOB; | 
|  | 1202 | } else { | 
|  | 1203 | /* Now we can treat all alike */ | 
|  | 1204 | skb = skb_recv_datagram(sk, flags & ~MSG_DONTWAIT, | 
|  | 1205 | flags & MSG_DONTWAIT, &rc); | 
|  | 1206 | if (!skb) | 
|  | 1207 | goto out; | 
|  | 1208 |  | 
|  | 1209 | qbit = (skb->data[0] & X25_Q_BIT) == X25_Q_BIT; | 
|  | 1210 |  | 
|  | 1211 | skb_pull(skb, x25->neighbour->extended ? | 
|  | 1212 | X25_EXT_MIN_LEN : X25_STD_MIN_LEN); | 
|  | 1213 |  | 
|  | 1214 | if (x25->qbitincl) { | 
|  | 1215 | asmptr  = skb_push(skb, 1); | 
|  | 1216 | *asmptr = qbit; | 
|  | 1217 | } | 
|  | 1218 | } | 
|  | 1219 |  | 
| Arnaldo Carvalho de Melo | badff6d | 2007-03-13 13:06:52 -0300 | [diff] [blame] | 1220 | skb_reset_transport_header(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1221 | copied = skb->len; | 
|  | 1222 |  | 
|  | 1223 | if (copied > size) { | 
|  | 1224 | copied = size; | 
|  | 1225 | msg->msg_flags |= MSG_TRUNC; | 
|  | 1226 | } | 
|  | 1227 |  | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 1228 | /* Currently, each datagram always contains a complete record */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1229 | msg->msg_flags |= MSG_EOR; | 
|  | 1230 |  | 
|  | 1231 | rc = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied); | 
|  | 1232 | if (rc) | 
|  | 1233 | goto out_free_dgram; | 
|  | 1234 |  | 
|  | 1235 | if (sx25) { | 
|  | 1236 | sx25->sx25_family = AF_X25; | 
|  | 1237 | sx25->sx25_addr   = x25->dest_addr; | 
|  | 1238 | } | 
|  | 1239 |  | 
|  | 1240 | msg->msg_namelen = sizeof(struct sockaddr_x25); | 
|  | 1241 |  | 
|  | 1242 | lock_sock(sk); | 
|  | 1243 | x25_check_rbuf(sk); | 
|  | 1244 | release_sock(sk); | 
|  | 1245 | rc = copied; | 
|  | 1246 | out_free_dgram: | 
|  | 1247 | skb_free_datagram(sk, skb); | 
|  | 1248 | out: | 
|  | 1249 | return rc; | 
|  | 1250 | } | 
|  | 1251 |  | 
|  | 1252 |  | 
|  | 1253 | static int x25_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) | 
|  | 1254 | { | 
|  | 1255 | struct sock *sk = sock->sk; | 
|  | 1256 | struct x25_sock *x25 = x25_sk(sk); | 
|  | 1257 | void __user *argp = (void __user *)arg; | 
|  | 1258 | int rc; | 
|  | 1259 |  | 
|  | 1260 | switch (cmd) { | 
|  | 1261 | case TIOCOUTQ: { | 
|  | 1262 | int amount = sk->sk_sndbuf - | 
|  | 1263 | atomic_read(&sk->sk_wmem_alloc); | 
|  | 1264 | if (amount < 0) | 
|  | 1265 | amount = 0; | 
|  | 1266 | rc = put_user(amount, (unsigned int __user *)argp); | 
|  | 1267 | break; | 
|  | 1268 | } | 
|  | 1269 |  | 
|  | 1270 | case TIOCINQ: { | 
|  | 1271 | struct sk_buff *skb; | 
|  | 1272 | int amount = 0; | 
|  | 1273 | /* | 
|  | 1274 | * These two are safe on a single CPU system as | 
|  | 1275 | * only user tasks fiddle here | 
|  | 1276 | */ | 
|  | 1277 | if ((skb = skb_peek(&sk->sk_receive_queue)) != NULL) | 
|  | 1278 | amount = skb->len; | 
|  | 1279 | rc = put_user(amount, (unsigned int __user *)argp); | 
|  | 1280 | break; | 
|  | 1281 | } | 
|  | 1282 |  | 
|  | 1283 | case SIOCGSTAMP: | 
|  | 1284 | rc = -EINVAL; | 
|  | 1285 | if (sk) | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 1286 | rc = sock_get_timestamp(sk, | 
|  | 1287 | (struct timeval __user *)argp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1288 | break; | 
| Eric Dumazet | ae40eb1 | 2007-03-18 17:33:16 -0700 | [diff] [blame] | 1289 | case SIOCGSTAMPNS: | 
|  | 1290 | rc = -EINVAL; | 
|  | 1291 | if (sk) | 
|  | 1292 | rc = sock_get_timestampns(sk, | 
|  | 1293 | (struct timespec __user *)argp); | 
|  | 1294 | break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1295 | case SIOCGIFADDR: | 
|  | 1296 | case SIOCSIFADDR: | 
|  | 1297 | case SIOCGIFDSTADDR: | 
|  | 1298 | case SIOCSIFDSTADDR: | 
|  | 1299 | case SIOCGIFBRDADDR: | 
|  | 1300 | case SIOCSIFBRDADDR: | 
|  | 1301 | case SIOCGIFNETMASK: | 
|  | 1302 | case SIOCSIFNETMASK: | 
|  | 1303 | case SIOCGIFMETRIC: | 
|  | 1304 | case SIOCSIFMETRIC: | 
|  | 1305 | rc = -EINVAL; | 
|  | 1306 | break; | 
|  | 1307 | case SIOCADDRT: | 
|  | 1308 | case SIOCDELRT: | 
|  | 1309 | rc = -EPERM; | 
|  | 1310 | if (!capable(CAP_NET_ADMIN)) | 
|  | 1311 | break; | 
|  | 1312 | rc = x25_route_ioctl(cmd, argp); | 
|  | 1313 | break; | 
|  | 1314 | case SIOCX25GSUBSCRIP: | 
|  | 1315 | rc = x25_subscr_ioctl(cmd, argp); | 
|  | 1316 | break; | 
|  | 1317 | case SIOCX25SSUBSCRIP: | 
|  | 1318 | rc = -EPERM; | 
|  | 1319 | if (!capable(CAP_NET_ADMIN)) | 
|  | 1320 | break; | 
|  | 1321 | rc = x25_subscr_ioctl(cmd, argp); | 
|  | 1322 | break; | 
|  | 1323 | case SIOCX25GFACILITIES: { | 
|  | 1324 | struct x25_facilities fac = x25->facilities; | 
|  | 1325 | rc = copy_to_user(argp, &fac, | 
|  | 1326 | sizeof(fac)) ? -EFAULT : 0; | 
|  | 1327 | break; | 
|  | 1328 | } | 
|  | 1329 |  | 
|  | 1330 | case SIOCX25SFACILITIES: { | 
|  | 1331 | struct x25_facilities facilities; | 
|  | 1332 | rc = -EFAULT; | 
|  | 1333 | if (copy_from_user(&facilities, argp, | 
|  | 1334 | sizeof(facilities))) | 
|  | 1335 | break; | 
|  | 1336 | rc = -EINVAL; | 
|  | 1337 | if (sk->sk_state != TCP_LISTEN && | 
|  | 1338 | sk->sk_state != TCP_CLOSE) | 
|  | 1339 | break; | 
|  | 1340 | if (facilities.pacsize_in < X25_PS16 || | 
|  | 1341 | facilities.pacsize_in > X25_PS4096) | 
|  | 1342 | break; | 
|  | 1343 | if (facilities.pacsize_out < X25_PS16 || | 
|  | 1344 | facilities.pacsize_out > X25_PS4096) | 
|  | 1345 | break; | 
|  | 1346 | if (facilities.winsize_in < 1 || | 
|  | 1347 | facilities.winsize_in > 127) | 
|  | 1348 | break; | 
|  | 1349 | if (facilities.throughput < 0x03 || | 
|  | 1350 | facilities.throughput > 0xDD) | 
|  | 1351 | break; | 
| Shaun Pereira | ebc3f64 | 2005-06-22 22:16:17 -0700 | [diff] [blame] | 1352 | if (facilities.reverse && | 
|  | 1353 | (facilities.reverse | 0x81)!= 0x81) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1354 | break; | 
|  | 1355 | x25->facilities = facilities; | 
|  | 1356 | rc = 0; | 
|  | 1357 | break; | 
|  | 1358 | } | 
|  | 1359 |  | 
| Shaun Pereira | a64b7b9 | 2006-03-22 00:01:31 -0800 | [diff] [blame] | 1360 | case SIOCX25GDTEFACILITIES: { | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 1361 | rc = copy_to_user(argp, &x25->dte_facilities, | 
| Shaun Pereira | a64b7b9 | 2006-03-22 00:01:31 -0800 | [diff] [blame] | 1362 | sizeof(x25->dte_facilities)); | 
|  | 1363 | if (rc) | 
|  | 1364 | rc = -EFAULT; | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 1365 | break; | 
|  | 1366 | } | 
| Shaun Pereira | a64b7b9 | 2006-03-22 00:01:31 -0800 | [diff] [blame] | 1367 |  | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 1368 | case SIOCX25SDTEFACILITIES: { | 
|  | 1369 | struct x25_dte_facilities dtefacs; | 
|  | 1370 | rc = -EFAULT; | 
|  | 1371 | if (copy_from_user(&dtefacs, argp, sizeof(dtefacs))) | 
| Shaun Pereira | a64b7b9 | 2006-03-22 00:01:31 -0800 | [diff] [blame] | 1372 | break; | 
|  | 1373 | rc = -EINVAL; | 
|  | 1374 | if (sk->sk_state != TCP_LISTEN && | 
|  | 1375 | sk->sk_state != TCP_CLOSE) | 
|  | 1376 | break; | 
|  | 1377 | if (dtefacs.calling_len > X25_MAX_AE_LEN) | 
|  | 1378 | break; | 
|  | 1379 | if (dtefacs.calling_ae == NULL) | 
|  | 1380 | break; | 
|  | 1381 | if (dtefacs.called_len > X25_MAX_AE_LEN) | 
|  | 1382 | break; | 
|  | 1383 | if (dtefacs.called_ae == NULL) | 
|  | 1384 | break; | 
|  | 1385 | x25->dte_facilities = dtefacs; | 
|  | 1386 | rc = 0; | 
|  | 1387 | break; | 
|  | 1388 | } | 
|  | 1389 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1390 | case SIOCX25GCALLUSERDATA: { | 
|  | 1391 | struct x25_calluserdata cud = x25->calluserdata; | 
|  | 1392 | rc = copy_to_user(argp, &cud, | 
|  | 1393 | sizeof(cud)) ? -EFAULT : 0; | 
|  | 1394 | break; | 
|  | 1395 | } | 
|  | 1396 |  | 
|  | 1397 | case SIOCX25SCALLUSERDATA: { | 
|  | 1398 | struct x25_calluserdata calluserdata; | 
|  | 1399 |  | 
|  | 1400 | rc = -EFAULT; | 
|  | 1401 | if (copy_from_user(&calluserdata, argp, | 
|  | 1402 | sizeof(calluserdata))) | 
|  | 1403 | break; | 
|  | 1404 | rc = -EINVAL; | 
|  | 1405 | if (calluserdata.cudlength > X25_MAX_CUD_LEN) | 
|  | 1406 | break; | 
|  | 1407 | x25->calluserdata = calluserdata; | 
|  | 1408 | rc = 0; | 
|  | 1409 | break; | 
|  | 1410 | } | 
|  | 1411 |  | 
|  | 1412 | case SIOCX25GCAUSEDIAG: { | 
|  | 1413 | struct x25_causediag causediag; | 
|  | 1414 | causediag = x25->causediag; | 
|  | 1415 | rc = copy_to_user(argp, &causediag, | 
|  | 1416 | sizeof(causediag)) ? -EFAULT : 0; | 
|  | 1417 | break; | 
|  | 1418 | } | 
|  | 1419 |  | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 1420 | case SIOCX25SCUDMATCHLEN: { | 
|  | 1421 | struct x25_subaddr sub_addr; | 
|  | 1422 | rc = -EINVAL; | 
|  | 1423 | if(sk->sk_state != TCP_CLOSE) | 
|  | 1424 | break; | 
|  | 1425 | rc = -EFAULT; | 
|  | 1426 | if (copy_from_user(&sub_addr, argp, | 
|  | 1427 | sizeof(sub_addr))) | 
|  | 1428 | break; | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 1429 | rc = -EINVAL; | 
| Shaun Pereira | cb65d50 | 2005-06-22 22:15:01 -0700 | [diff] [blame] | 1430 | if(sub_addr.cudmatchlength > X25_MAX_CUD_LEN) | 
|  | 1431 | break; | 
|  | 1432 | x25->cudmatchlength = sub_addr.cudmatchlength; | 
|  | 1433 | rc = 0; | 
|  | 1434 | break; | 
|  | 1435 | } | 
|  | 1436 |  | 
| Shaun Pereira | ebc3f64 | 2005-06-22 22:16:17 -0700 | [diff] [blame] | 1437 | case SIOCX25CALLACCPTAPPRV: { | 
|  | 1438 | rc = -EINVAL; | 
|  | 1439 | if (sk->sk_state != TCP_CLOSE) | 
|  | 1440 | break; | 
|  | 1441 | x25->accptapprv = X25_ALLOW_ACCPT_APPRV; | 
|  | 1442 | rc = 0; | 
|  | 1443 | break; | 
|  | 1444 | } | 
|  | 1445 |  | 
|  | 1446 | case SIOCX25SENDCALLACCPT:  { | 
|  | 1447 | rc = -EINVAL; | 
|  | 1448 | if (sk->sk_state != TCP_ESTABLISHED) | 
|  | 1449 | break; | 
|  | 1450 | if (x25->accptapprv)	/* must call accptapprv above */ | 
|  | 1451 | break; | 
|  | 1452 | x25_write_internal(sk, X25_CALL_ACCEPTED); | 
|  | 1453 | x25->state = X25_STATE_3; | 
|  | 1454 | rc = 0; | 
|  | 1455 | break; | 
|  | 1456 | } | 
|  | 1457 |  | 
| YOSHIFUJI Hideaki | f8e1d201 | 2007-02-09 23:25:27 +0900 | [diff] [blame] | 1458 | default: | 
| Christoph Hellwig | b5e5fa5 | 2006-01-03 14:18:33 -0800 | [diff] [blame] | 1459 | rc = -ENOIOCTLCMD; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1460 | break; | 
|  | 1461 | } | 
|  | 1462 |  | 
|  | 1463 | return rc; | 
|  | 1464 | } | 
|  | 1465 |  | 
|  | 1466 | static struct net_proto_family x25_family_ops = { | 
|  | 1467 | .family =	AF_X25, | 
|  | 1468 | .create =	x25_create, | 
|  | 1469 | .owner	=	THIS_MODULE, | 
|  | 1470 | }; | 
|  | 1471 |  | 
| Shaun Pereira | 1b06e6b | 2006-03-22 00:00:12 -0800 | [diff] [blame] | 1472 | #ifdef CONFIG_COMPAT | 
|  | 1473 | static int compat_x25_subscr_ioctl(unsigned int cmd, | 
|  | 1474 | struct compat_x25_subscrip_struct __user *x25_subscr32) | 
|  | 1475 | { | 
|  | 1476 | struct compat_x25_subscrip_struct x25_subscr; | 
|  | 1477 | struct x25_neigh *nb; | 
|  | 1478 | struct net_device *dev; | 
|  | 1479 | int rc = -EINVAL; | 
|  | 1480 |  | 
|  | 1481 | rc = -EFAULT; | 
|  | 1482 | if (copy_from_user(&x25_subscr, x25_subscr32, sizeof(*x25_subscr32))) | 
|  | 1483 | goto out; | 
|  | 1484 |  | 
|  | 1485 | rc = -EINVAL; | 
|  | 1486 | dev = x25_dev_get(x25_subscr.device); | 
|  | 1487 | if (dev == NULL) | 
|  | 1488 | goto out; | 
|  | 1489 |  | 
|  | 1490 | nb = x25_get_neigh(dev); | 
|  | 1491 | if (nb == NULL) | 
|  | 1492 | goto out_dev_put; | 
|  | 1493 |  | 
|  | 1494 | dev_put(dev); | 
|  | 1495 |  | 
|  | 1496 | if (cmd == SIOCX25GSUBSCRIP) { | 
|  | 1497 | x25_subscr.extended = nb->extended; | 
|  | 1498 | x25_subscr.global_facil_mask = nb->global_facil_mask; | 
|  | 1499 | rc = copy_to_user(x25_subscr32, &x25_subscr, | 
|  | 1500 | sizeof(*x25_subscr32)) ? -EFAULT : 0; | 
|  | 1501 | } else { | 
|  | 1502 | rc = -EINVAL; | 
|  | 1503 | if (x25_subscr.extended == 0 || x25_subscr.extended == 1) { | 
|  | 1504 | rc = 0; | 
|  | 1505 | nb->extended = x25_subscr.extended; | 
|  | 1506 | nb->global_facil_mask = x25_subscr.global_facil_mask; | 
|  | 1507 | } | 
|  | 1508 | } | 
|  | 1509 | x25_neigh_put(nb); | 
|  | 1510 | out: | 
|  | 1511 | return rc; | 
|  | 1512 | out_dev_put: | 
|  | 1513 | dev_put(dev); | 
|  | 1514 | goto out; | 
|  | 1515 | } | 
|  | 1516 |  | 
|  | 1517 | static int compat_x25_ioctl(struct socket *sock, unsigned int cmd, | 
|  | 1518 | unsigned long arg) | 
|  | 1519 | { | 
|  | 1520 | void __user *argp = compat_ptr(arg); | 
|  | 1521 | struct sock *sk = sock->sk; | 
|  | 1522 |  | 
|  | 1523 | int rc = -ENOIOCTLCMD; | 
|  | 1524 |  | 
|  | 1525 | switch(cmd) { | 
|  | 1526 | case TIOCOUTQ: | 
|  | 1527 | case TIOCINQ: | 
|  | 1528 | rc = x25_ioctl(sock, cmd, (unsigned long)argp); | 
|  | 1529 | break; | 
|  | 1530 | case SIOCGSTAMP: | 
|  | 1531 | rc = -EINVAL; | 
|  | 1532 | if (sk) | 
|  | 1533 | rc = compat_sock_get_timestamp(sk, | 
|  | 1534 | (struct timeval __user*)argp); | 
|  | 1535 | break; | 
| Eric Dumazet | ae40eb1 | 2007-03-18 17:33:16 -0700 | [diff] [blame] | 1536 | case SIOCGSTAMPNS: | 
|  | 1537 | rc = -EINVAL; | 
|  | 1538 | if (sk) | 
|  | 1539 | rc = compat_sock_get_timestampns(sk, | 
|  | 1540 | (struct timespec __user*)argp); | 
|  | 1541 | break; | 
| Shaun Pereira | 1b06e6b | 2006-03-22 00:00:12 -0800 | [diff] [blame] | 1542 | case SIOCGIFADDR: | 
|  | 1543 | case SIOCSIFADDR: | 
|  | 1544 | case SIOCGIFDSTADDR: | 
|  | 1545 | case SIOCSIFDSTADDR: | 
|  | 1546 | case SIOCGIFBRDADDR: | 
|  | 1547 | case SIOCSIFBRDADDR: | 
|  | 1548 | case SIOCGIFNETMASK: | 
|  | 1549 | case SIOCSIFNETMASK: | 
|  | 1550 | case SIOCGIFMETRIC: | 
|  | 1551 | case SIOCSIFMETRIC: | 
|  | 1552 | rc = -EINVAL; | 
|  | 1553 | break; | 
|  | 1554 | case SIOCADDRT: | 
|  | 1555 | case SIOCDELRT: | 
|  | 1556 | rc = -EPERM; | 
|  | 1557 | if (!capable(CAP_NET_ADMIN)) | 
|  | 1558 | break; | 
|  | 1559 | rc = x25_route_ioctl(cmd, argp); | 
|  | 1560 | break; | 
|  | 1561 | case SIOCX25GSUBSCRIP: | 
|  | 1562 | rc = compat_x25_subscr_ioctl(cmd, argp); | 
|  | 1563 | break; | 
|  | 1564 | case SIOCX25SSUBSCRIP: | 
|  | 1565 | rc = -EPERM; | 
|  | 1566 | if (!capable(CAP_NET_ADMIN)) | 
|  | 1567 | break; | 
|  | 1568 | rc = compat_x25_subscr_ioctl(cmd, argp); | 
|  | 1569 | break; | 
|  | 1570 | case SIOCX25GFACILITIES: | 
|  | 1571 | case SIOCX25SFACILITIES: | 
| Shaun Pereira | 9a6b9f2 | 2006-03-22 00:02:00 -0800 | [diff] [blame] | 1572 | case SIOCX25GDTEFACILITIES: | 
|  | 1573 | case SIOCX25SDTEFACILITIES: | 
| Shaun Pereira | 1b06e6b | 2006-03-22 00:00:12 -0800 | [diff] [blame] | 1574 | case SIOCX25GCALLUSERDATA: | 
|  | 1575 | case SIOCX25SCALLUSERDATA: | 
|  | 1576 | case SIOCX25GCAUSEDIAG: | 
|  | 1577 | case SIOCX25SCUDMATCHLEN: | 
|  | 1578 | case SIOCX25CALLACCPTAPPRV: | 
|  | 1579 | case SIOCX25SENDCALLACCPT: | 
|  | 1580 | rc = x25_ioctl(sock, cmd, (unsigned long)argp); | 
|  | 1581 | break; | 
|  | 1582 | default: | 
|  | 1583 | rc = -ENOIOCTLCMD; | 
|  | 1584 | break; | 
|  | 1585 | } | 
|  | 1586 | return rc; | 
|  | 1587 | } | 
|  | 1588 | #endif | 
|  | 1589 |  | 
| Eric Dumazet | 90ddc4f | 2005-12-22 12:49:22 -0800 | [diff] [blame] | 1590 | static const struct proto_ops SOCKOPS_WRAPPED(x25_proto_ops) = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1591 | .family =	AF_X25, | 
|  | 1592 | .owner =	THIS_MODULE, | 
|  | 1593 | .release =	x25_release, | 
|  | 1594 | .bind =		x25_bind, | 
|  | 1595 | .connect =	x25_connect, | 
|  | 1596 | .socketpair =	sock_no_socketpair, | 
|  | 1597 | .accept =	x25_accept, | 
|  | 1598 | .getname =	x25_getname, | 
|  | 1599 | .poll =		datagram_poll, | 
|  | 1600 | .ioctl =	x25_ioctl, | 
| Shaun Pereira | 1b06e6b | 2006-03-22 00:00:12 -0800 | [diff] [blame] | 1601 | #ifdef CONFIG_COMPAT | 
|  | 1602 | .compat_ioctl = compat_x25_ioctl, | 
|  | 1603 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1604 | .listen =	x25_listen, | 
|  | 1605 | .shutdown =	sock_no_shutdown, | 
|  | 1606 | .setsockopt =	x25_setsockopt, | 
|  | 1607 | .getsockopt =	x25_getsockopt, | 
|  | 1608 | .sendmsg =	x25_sendmsg, | 
|  | 1609 | .recvmsg =	x25_recvmsg, | 
|  | 1610 | .mmap =		sock_no_mmap, | 
|  | 1611 | .sendpage =	sock_no_sendpage, | 
|  | 1612 | }; | 
|  | 1613 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1614 | SOCKOPS_WRAP(x25_proto, AF_X25); | 
|  | 1615 |  | 
|  | 1616 | static struct packet_type x25_packet_type = { | 
|  | 1617 | .type =	__constant_htons(ETH_P_X25), | 
|  | 1618 | .func =	x25_lapb_receive_frame, | 
|  | 1619 | }; | 
|  | 1620 |  | 
|  | 1621 | static struct notifier_block x25_dev_notifier = { | 
|  | 1622 | .notifier_call = x25_device_event, | 
|  | 1623 | }; | 
|  | 1624 |  | 
|  | 1625 | void x25_kill_by_neigh(struct x25_neigh *nb) | 
|  | 1626 | { | 
|  | 1627 | struct sock *s; | 
|  | 1628 | struct hlist_node *node; | 
|  | 1629 |  | 
|  | 1630 | write_lock_bh(&x25_list_lock); | 
|  | 1631 |  | 
|  | 1632 | sk_for_each(s, node, &x25_list) | 
|  | 1633 | if (x25_sk(s)->neighbour == nb) | 
|  | 1634 | x25_disconnect(s, ENETUNREACH, 0, 0); | 
|  | 1635 |  | 
|  | 1636 | write_unlock_bh(&x25_list_lock); | 
| Andrew Hendry | 95a9dc4 | 2007-02-08 13:34:02 -0800 | [diff] [blame] | 1637 |  | 
|  | 1638 | /* Remove any related forwards */ | 
|  | 1639 | x25_clear_forward_by_dev(nb->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1640 | } | 
|  | 1641 |  | 
|  | 1642 | static int __init x25_init(void) | 
|  | 1643 | { | 
|  | 1644 | int rc = proto_register(&x25_proto, 0); | 
|  | 1645 |  | 
|  | 1646 | if (rc != 0) | 
|  | 1647 | goto out; | 
|  | 1648 |  | 
|  | 1649 | sock_register(&x25_family_ops); | 
|  | 1650 |  | 
|  | 1651 | dev_add_pack(&x25_packet_type); | 
|  | 1652 |  | 
|  | 1653 | register_netdevice_notifier(&x25_dev_notifier); | 
|  | 1654 |  | 
| maximilian attems | a44562e | 2008-01-28 20:43:16 -0800 | [diff] [blame] | 1655 | printk(KERN_INFO "X.25 for Linux Version 0.2\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1656 |  | 
|  | 1657 | #ifdef CONFIG_SYSCTL | 
|  | 1658 | x25_register_sysctl(); | 
|  | 1659 | #endif | 
|  | 1660 | x25_proc_init(); | 
|  | 1661 | out: | 
|  | 1662 | return rc; | 
|  | 1663 | } | 
|  | 1664 | module_init(x25_init); | 
|  | 1665 |  | 
|  | 1666 | static void __exit x25_exit(void) | 
|  | 1667 | { | 
|  | 1668 | x25_proc_exit(); | 
|  | 1669 | x25_link_free(); | 
|  | 1670 | x25_route_free(); | 
|  | 1671 |  | 
|  | 1672 | #ifdef CONFIG_SYSCTL | 
|  | 1673 | x25_unregister_sysctl(); | 
|  | 1674 | #endif | 
|  | 1675 |  | 
|  | 1676 | unregister_netdevice_notifier(&x25_dev_notifier); | 
|  | 1677 |  | 
|  | 1678 | dev_remove_pack(&x25_packet_type); | 
|  | 1679 |  | 
|  | 1680 | sock_unregister(AF_X25); | 
|  | 1681 | proto_unregister(&x25_proto); | 
|  | 1682 | } | 
|  | 1683 | module_exit(x25_exit); | 
|  | 1684 |  | 
|  | 1685 | MODULE_AUTHOR("Jonathan Naylor <g4klx@g4klx.demon.co.uk>"); | 
|  | 1686 | MODULE_DESCRIPTION("The X.25 Packet Layer network layer protocol"); | 
|  | 1687 | MODULE_LICENSE("GPL"); | 
|  | 1688 | MODULE_ALIAS_NETPROTO(PF_X25); |