diff options
Diffstat (limited to 'net/atm/svc.c')
| -rw-r--r-- | net/atm/svc.c | 258 |
1 files changed, 130 insertions, 128 deletions
diff --git a/net/atm/svc.c b/net/atm/svc.c index 66e1d9b3e5de..3ba9a45a51ac 100644 --- a/net/atm/svc.c +++ b/net/atm/svc.c | |||
| @@ -2,6 +2,7 @@ | |||
| 2 | 2 | ||
| 3 | /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */ | 3 | /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */ |
| 4 | 4 | ||
| 5 | #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__ | ||
| 5 | 6 | ||
| 6 | #include <linux/string.h> | 7 | #include <linux/string.h> |
| 7 | #include <linux/net.h> /* struct socket, struct proto_ops */ | 8 | #include <linux/net.h> /* struct socket, struct proto_ops */ |
| @@ -18,14 +19,15 @@ | |||
| 18 | #include <linux/atmdev.h> | 19 | #include <linux/atmdev.h> |
| 19 | #include <linux/bitops.h> | 20 | #include <linux/bitops.h> |
| 20 | #include <net/sock.h> /* for sock_no_* */ | 21 | #include <net/sock.h> /* for sock_no_* */ |
| 21 | #include <asm/uaccess.h> | 22 | #include <linux/uaccess.h> |
| 22 | 23 | ||
| 23 | #include "resources.h" | 24 | #include "resources.h" |
| 24 | #include "common.h" /* common for PVCs and SVCs */ | 25 | #include "common.h" /* common for PVCs and SVCs */ |
| 25 | #include "signaling.h" | 26 | #include "signaling.h" |
| 26 | #include "addr.h" | 27 | #include "addr.h" |
| 27 | 28 | ||
| 28 | static int svc_create(struct net *net, struct socket *sock, int protocol, int kern); | 29 | static int svc_create(struct net *net, struct socket *sock, int protocol, |
| 30 | int kern); | ||
| 29 | 31 | ||
| 30 | /* | 32 | /* |
| 31 | * Note: since all this is still nicely synchronized with the signaling demon, | 33 | * Note: since all this is still nicely synchronized with the signaling demon, |
| @@ -34,25 +36,25 @@ static int svc_create(struct net *net, struct socket *sock, int protocol, int ke | |||
| 34 | */ | 36 | */ |
| 35 | 37 | ||
| 36 | 38 | ||
| 37 | static int svc_shutdown(struct socket *sock,int how) | 39 | static int svc_shutdown(struct socket *sock, int how) |
| 38 | { | 40 | { |
| 39 | return 0; | 41 | return 0; |
| 40 | } | 42 | } |
| 41 | 43 | ||
| 42 | |||
| 43 | static void svc_disconnect(struct atm_vcc *vcc) | 44 | static void svc_disconnect(struct atm_vcc *vcc) |
| 44 | { | 45 | { |
| 45 | DEFINE_WAIT(wait); | 46 | DEFINE_WAIT(wait); |
| 46 | struct sk_buff *skb; | 47 | struct sk_buff *skb; |
| 47 | struct sock *sk = sk_atm(vcc); | 48 | struct sock *sk = sk_atm(vcc); |
| 48 | 49 | ||
| 49 | pr_debug("svc_disconnect %p\n",vcc); | 50 | pr_debug("%p\n", vcc); |
| 50 | if (test_bit(ATM_VF_REGIS,&vcc->flags)) { | 51 | if (test_bit(ATM_VF_REGIS, &vcc->flags)) { |
| 51 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); | 52 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); |
| 52 | sigd_enq(vcc,as_close,NULL,NULL,NULL); | 53 | sigd_enq(vcc, as_close, NULL, NULL, NULL); |
| 53 | while (!test_bit(ATM_VF_RELEASED,&vcc->flags) && sigd) { | 54 | while (!test_bit(ATM_VF_RELEASED, &vcc->flags) && sigd) { |
| 54 | schedule(); | 55 | schedule(); |
| 55 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); | 56 | prepare_to_wait(sk->sk_sleep, &wait, |
| 57 | TASK_UNINTERRUPTIBLE); | ||
| 56 | } | 58 | } |
| 57 | finish_wait(sk->sk_sleep, &wait); | 59 | finish_wait(sk->sk_sleep, &wait); |
| 58 | } | 60 | } |
| @@ -61,35 +63,35 @@ static void svc_disconnect(struct atm_vcc *vcc) | |||
| 61 | while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) { | 63 | while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) { |
| 62 | atm_return(vcc, skb->truesize); | 64 | atm_return(vcc, skb->truesize); |
| 63 | pr_debug("LISTEN REL\n"); | 65 | pr_debug("LISTEN REL\n"); |
| 64 | sigd_enq2(NULL,as_reject,vcc,NULL,NULL,&vcc->qos,0); | 66 | sigd_enq2(NULL, as_reject, vcc, NULL, NULL, &vcc->qos, 0); |
| 65 | dev_kfree_skb(skb); | 67 | dev_kfree_skb(skb); |
| 66 | } | 68 | } |
| 67 | clear_bit(ATM_VF_REGIS, &vcc->flags); | 69 | clear_bit(ATM_VF_REGIS, &vcc->flags); |
| 68 | /* ... may retry later */ | 70 | /* ... may retry later */ |
| 69 | } | 71 | } |
| 70 | 72 | ||
| 71 | |||
| 72 | static int svc_release(struct socket *sock) | 73 | static int svc_release(struct socket *sock) |
| 73 | { | 74 | { |
| 74 | struct sock *sk = sock->sk; | 75 | struct sock *sk = sock->sk; |
| 75 | struct atm_vcc *vcc; | 76 | struct atm_vcc *vcc; |
| 76 | 77 | ||
| 77 | if (sk) { | 78 | if (sk) { |
| 78 | vcc = ATM_SD(sock); | 79 | vcc = ATM_SD(sock); |
| 79 | pr_debug("svc_release %p\n", vcc); | 80 | pr_debug("%p\n", vcc); |
| 80 | clear_bit(ATM_VF_READY, &vcc->flags); | 81 | clear_bit(ATM_VF_READY, &vcc->flags); |
| 81 | /* VCC pointer is used as a reference, so we must not free it | 82 | /* |
| 82 | (thereby subjecting it to re-use) before all pending connections | 83 | * VCC pointer is used as a reference, |
| 83 | are closed */ | 84 | * so we must not free it (thereby subjecting it to re-use) |
| 85 | * before all pending connections are closed | ||
| 86 | */ | ||
| 84 | svc_disconnect(vcc); | 87 | svc_disconnect(vcc); |
| 85 | vcc_release(sock); | 88 | vcc_release(sock); |
| 86 | } | 89 | } |
| 87 | return 0; | 90 | return 0; |
| 88 | } | 91 | } |
| 89 | 92 | ||
| 90 | 93 | static int svc_bind(struct socket *sock, struct sockaddr *sockaddr, | |
| 91 | static int svc_bind(struct socket *sock,struct sockaddr *sockaddr, | 94 | int sockaddr_len) |
| 92 | int sockaddr_len) | ||
| 93 | { | 95 | { |
| 94 | DEFINE_WAIT(wait); | 96 | DEFINE_WAIT(wait); |
| 95 | struct sock *sk = sock->sk; | 97 | struct sock *sk = sock->sk; |
| @@ -114,38 +116,37 @@ static int svc_bind(struct socket *sock,struct sockaddr *sockaddr, | |||
| 114 | error = -EAFNOSUPPORT; | 116 | error = -EAFNOSUPPORT; |
| 115 | goto out; | 117 | goto out; |
| 116 | } | 118 | } |
| 117 | clear_bit(ATM_VF_BOUND,&vcc->flags); | 119 | clear_bit(ATM_VF_BOUND, &vcc->flags); |
| 118 | /* failing rebind will kill old binding */ | 120 | /* failing rebind will kill old binding */ |
| 119 | /* @@@ check memory (de)allocation on rebind */ | 121 | /* @@@ check memory (de)allocation on rebind */ |
| 120 | if (!test_bit(ATM_VF_HASQOS,&vcc->flags)) { | 122 | if (!test_bit(ATM_VF_HASQOS, &vcc->flags)) { |
| 121 | error = -EBADFD; | 123 | error = -EBADFD; |
| 122 | goto out; | 124 | goto out; |
| 123 | } | 125 | } |
| 124 | vcc->local = *addr; | 126 | vcc->local = *addr; |
| 125 | set_bit(ATM_VF_WAITING, &vcc->flags); | 127 | set_bit(ATM_VF_WAITING, &vcc->flags); |
| 126 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); | 128 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); |
| 127 | sigd_enq(vcc,as_bind,NULL,NULL,&vcc->local); | 129 | sigd_enq(vcc, as_bind, NULL, NULL, &vcc->local); |
| 128 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && sigd) { | 130 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && sigd) { |
| 129 | schedule(); | 131 | schedule(); |
| 130 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); | 132 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); |
| 131 | } | 133 | } |
| 132 | finish_wait(sk->sk_sleep, &wait); | 134 | finish_wait(sk->sk_sleep, &wait); |
| 133 | clear_bit(ATM_VF_REGIS,&vcc->flags); /* doesn't count */ | 135 | clear_bit(ATM_VF_REGIS, &vcc->flags); /* doesn't count */ |
| 134 | if (!sigd) { | 136 | if (!sigd) { |
| 135 | error = -EUNATCH; | 137 | error = -EUNATCH; |
| 136 | goto out; | 138 | goto out; |
| 137 | } | 139 | } |
| 138 | if (!sk->sk_err) | 140 | if (!sk->sk_err) |
| 139 | set_bit(ATM_VF_BOUND,&vcc->flags); | 141 | set_bit(ATM_VF_BOUND, &vcc->flags); |
| 140 | error = -sk->sk_err; | 142 | error = -sk->sk_err; |
| 141 | out: | 143 | out: |
| 142 | release_sock(sk); | 144 | release_sock(sk); |
| 143 | return error; | 145 | return error; |
| 144 | } | 146 | } |
| 145 | 147 | ||
| 146 | 148 | static int svc_connect(struct socket *sock, struct sockaddr *sockaddr, | |
| 147 | static int svc_connect(struct socket *sock,struct sockaddr *sockaddr, | 149 | int sockaddr_len, int flags) |
| 148 | int sockaddr_len,int flags) | ||
| 149 | { | 150 | { |
| 150 | DEFINE_WAIT(wait); | 151 | DEFINE_WAIT(wait); |
| 151 | struct sock *sk = sock->sk; | 152 | struct sock *sk = sock->sk; |
| @@ -153,7 +154,7 @@ static int svc_connect(struct socket *sock,struct sockaddr *sockaddr, | |||
| 153 | struct atm_vcc *vcc = ATM_SD(sock); | 154 | struct atm_vcc *vcc = ATM_SD(sock); |
| 154 | int error; | 155 | int error; |
| 155 | 156 | ||
| 156 | pr_debug("svc_connect %p\n",vcc); | 157 | pr_debug("%p\n", vcc); |
| 157 | lock_sock(sk); | 158 | lock_sock(sk); |
| 158 | if (sockaddr_len != sizeof(struct sockaddr_atmsvc)) { | 159 | if (sockaddr_len != sizeof(struct sockaddr_atmsvc)) { |
| 159 | error = -EINVAL; | 160 | error = -EINVAL; |
| @@ -201,7 +202,7 @@ static int svc_connect(struct socket *sock,struct sockaddr *sockaddr, | |||
| 201 | vcc->remote = *addr; | 202 | vcc->remote = *addr; |
| 202 | set_bit(ATM_VF_WAITING, &vcc->flags); | 203 | set_bit(ATM_VF_WAITING, &vcc->flags); |
| 203 | prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE); | 204 | prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE); |
| 204 | sigd_enq(vcc,as_connect,NULL,NULL,&vcc->remote); | 205 | sigd_enq(vcc, as_connect, NULL, NULL, &vcc->remote); |
| 205 | if (flags & O_NONBLOCK) { | 206 | if (flags & O_NONBLOCK) { |
| 206 | finish_wait(sk->sk_sleep, &wait); | 207 | finish_wait(sk->sk_sleep, &wait); |
| 207 | sock->state = SS_CONNECTING; | 208 | sock->state = SS_CONNECTING; |
| @@ -212,7 +213,8 @@ static int svc_connect(struct socket *sock,struct sockaddr *sockaddr, | |||
| 212 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && sigd) { | 213 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && sigd) { |
| 213 | schedule(); | 214 | schedule(); |
| 214 | if (!signal_pending(current)) { | 215 | if (!signal_pending(current)) { |
| 215 | prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE); | 216 | prepare_to_wait(sk->sk_sleep, &wait, |
| 217 | TASK_INTERRUPTIBLE); | ||
| 216 | continue; | 218 | continue; |
| 217 | } | 219 | } |
| 218 | pr_debug("*ABORT*\n"); | 220 | pr_debug("*ABORT*\n"); |
| @@ -228,20 +230,22 @@ static int svc_connect(struct socket *sock,struct sockaddr *sockaddr, | |||
| 228 | * Kernel <--okay---- Demon | 230 | * Kernel <--okay---- Demon |
| 229 | * Kernel <--close--- Demon | 231 | * Kernel <--close--- Demon |
| 230 | */ | 232 | */ |
| 231 | sigd_enq(vcc,as_close,NULL,NULL,NULL); | 233 | sigd_enq(vcc, as_close, NULL, NULL, NULL); |
| 232 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && sigd) { | 234 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && sigd) { |
| 233 | prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE); | 235 | prepare_to_wait(sk->sk_sleep, &wait, |
| 236 | TASK_INTERRUPTIBLE); | ||
| 234 | schedule(); | 237 | schedule(); |
| 235 | } | 238 | } |
| 236 | if (!sk->sk_err) | 239 | if (!sk->sk_err) |
| 237 | while (!test_bit(ATM_VF_RELEASED,&vcc->flags) | 240 | while (!test_bit(ATM_VF_RELEASED, &vcc->flags) && |
| 238 | && sigd) { | 241 | sigd) { |
| 239 | prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE); | 242 | prepare_to_wait(sk->sk_sleep, &wait, |
| 243 | TASK_INTERRUPTIBLE); | ||
| 240 | schedule(); | 244 | schedule(); |
| 241 | } | 245 | } |
| 242 | clear_bit(ATM_VF_REGIS,&vcc->flags); | 246 | clear_bit(ATM_VF_REGIS, &vcc->flags); |
| 243 | clear_bit(ATM_VF_RELEASED,&vcc->flags); | 247 | clear_bit(ATM_VF_RELEASED, &vcc->flags); |
| 244 | clear_bit(ATM_VF_CLOSE,&vcc->flags); | 248 | clear_bit(ATM_VF_CLOSE, &vcc->flags); |
| 245 | /* we're gone now but may connect later */ | 249 | /* we're gone now but may connect later */ |
| 246 | error = -EINTR; | 250 | error = -EINTR; |
| 247 | break; | 251 | break; |
| @@ -269,37 +273,37 @@ static int svc_connect(struct socket *sock,struct sockaddr *sockaddr, | |||
| 269 | /* | 273 | /* |
| 270 | * #endif | 274 | * #endif |
| 271 | */ | 275 | */ |
| 272 | if (!(error = vcc_connect(sock, vcc->itf, vcc->vpi, vcc->vci))) | 276 | error = vcc_connect(sock, vcc->itf, vcc->vpi, vcc->vci); |
| 277 | if (!error) | ||
| 273 | sock->state = SS_CONNECTED; | 278 | sock->state = SS_CONNECTED; |
| 274 | else | 279 | else |
| 275 | (void) svc_disconnect(vcc); | 280 | (void)svc_disconnect(vcc); |
| 276 | out: | 281 | out: |
| 277 | release_sock(sk); | 282 | release_sock(sk); |
| 278 | return error; | 283 | return error; |
| 279 | } | 284 | } |
| 280 | 285 | ||
| 281 | 286 | static int svc_listen(struct socket *sock, int backlog) | |
| 282 | static int svc_listen(struct socket *sock,int backlog) | ||
| 283 | { | 287 | { |
| 284 | DEFINE_WAIT(wait); | 288 | DEFINE_WAIT(wait); |
| 285 | struct sock *sk = sock->sk; | 289 | struct sock *sk = sock->sk; |
| 286 | struct atm_vcc *vcc = ATM_SD(sock); | 290 | struct atm_vcc *vcc = ATM_SD(sock); |
| 287 | int error; | 291 | int error; |
| 288 | 292 | ||
| 289 | pr_debug("svc_listen %p\n",vcc); | 293 | pr_debug("%p\n", vcc); |
| 290 | lock_sock(sk); | 294 | lock_sock(sk); |
| 291 | /* let server handle listen on unbound sockets */ | 295 | /* let server handle listen on unbound sockets */ |
| 292 | if (test_bit(ATM_VF_SESSION,&vcc->flags)) { | 296 | if (test_bit(ATM_VF_SESSION, &vcc->flags)) { |
| 293 | error = -EINVAL; | 297 | error = -EINVAL; |
| 294 | goto out; | 298 | goto out; |
| 295 | } | 299 | } |
| 296 | if (test_bit(ATM_VF_LISTEN, &vcc->flags)) { | 300 | if (test_bit(ATM_VF_LISTEN, &vcc->flags)) { |
| 297 | error = -EADDRINUSE; | 301 | error = -EADDRINUSE; |
| 298 | goto out; | 302 | goto out; |
| 299 | } | 303 | } |
| 300 | set_bit(ATM_VF_WAITING, &vcc->flags); | 304 | set_bit(ATM_VF_WAITING, &vcc->flags); |
| 301 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); | 305 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); |
| 302 | sigd_enq(vcc,as_listen,NULL,NULL,&vcc->local); | 306 | sigd_enq(vcc, as_listen, NULL, NULL, &vcc->local); |
| 303 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && sigd) { | 307 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && sigd) { |
| 304 | schedule(); | 308 | schedule(); |
| 305 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); | 309 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); |
| @@ -309,7 +313,7 @@ static int svc_listen(struct socket *sock,int backlog) | |||
| 309 | error = -EUNATCH; | 313 | error = -EUNATCH; |
| 310 | goto out; | 314 | goto out; |
| 311 | } | 315 | } |
| 312 | set_bit(ATM_VF_LISTEN,&vcc->flags); | 316 | set_bit(ATM_VF_LISTEN, &vcc->flags); |
| 313 | vcc_insert_socket(sk); | 317 | vcc_insert_socket(sk); |
| 314 | sk->sk_max_ack_backlog = backlog > 0 ? backlog : ATM_BACKLOG_DEFAULT; | 318 | sk->sk_max_ack_backlog = backlog > 0 ? backlog : ATM_BACKLOG_DEFAULT; |
| 315 | error = -sk->sk_err; | 319 | error = -sk->sk_err; |
| @@ -318,8 +322,7 @@ out: | |||
| 318 | return error; | 322 | return error; |
| 319 | } | 323 | } |
| 320 | 324 | ||
| 321 | 325 | static int svc_accept(struct socket *sock, struct socket *newsock, int flags) | |
| 322 | static int svc_accept(struct socket *sock,struct socket *newsock,int flags) | ||
| 323 | { | 326 | { |
| 324 | struct sock *sk = sock->sk; | 327 | struct sock *sk = sock->sk; |
| 325 | struct sk_buff *skb; | 328 | struct sk_buff *skb; |
| @@ -336,15 +339,16 @@ static int svc_accept(struct socket *sock,struct socket *newsock,int flags) | |||
| 336 | 339 | ||
| 337 | new_vcc = ATM_SD(newsock); | 340 | new_vcc = ATM_SD(newsock); |
| 338 | 341 | ||
| 339 | pr_debug("svc_accept %p -> %p\n",old_vcc,new_vcc); | 342 | pr_debug("%p -> %p\n", old_vcc, new_vcc); |
| 340 | while (1) { | 343 | while (1) { |
| 341 | DEFINE_WAIT(wait); | 344 | DEFINE_WAIT(wait); |
| 342 | 345 | ||
| 343 | prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE); | 346 | prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE); |
| 344 | while (!(skb = skb_dequeue(&sk->sk_receive_queue)) && | 347 | while (!(skb = skb_dequeue(&sk->sk_receive_queue)) && |
| 345 | sigd) { | 348 | sigd) { |
| 346 | if (test_bit(ATM_VF_RELEASED,&old_vcc->flags)) break; | 349 | if (test_bit(ATM_VF_RELEASED, &old_vcc->flags)) |
| 347 | if (test_bit(ATM_VF_CLOSE,&old_vcc->flags)) { | 350 | break; |
| 351 | if (test_bit(ATM_VF_CLOSE, &old_vcc->flags)) { | ||
| 348 | error = -sk->sk_err; | 352 | error = -sk->sk_err; |
| 349 | break; | 353 | break; |
| 350 | } | 354 | } |
| @@ -359,7 +363,8 @@ static int svc_accept(struct socket *sock,struct socket *newsock,int flags) | |||
| 359 | error = -ERESTARTSYS; | 363 | error = -ERESTARTSYS; |
| 360 | break; | 364 | break; |
| 361 | } | 365 | } |
| 362 | prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE); | 366 | prepare_to_wait(sk->sk_sleep, &wait, |
| 367 | TASK_INTERRUPTIBLE); | ||
| 363 | } | 368 | } |
| 364 | finish_wait(sk->sk_sleep, &wait); | 369 | finish_wait(sk->sk_sleep, &wait); |
| 365 | if (error) | 370 | if (error) |
| @@ -368,31 +373,34 @@ static int svc_accept(struct socket *sock,struct socket *newsock,int flags) | |||
| 368 | error = -EUNATCH; | 373 | error = -EUNATCH; |
| 369 | goto out; | 374 | goto out; |
| 370 | } | 375 | } |
| 371 | msg = (struct atmsvc_msg *) skb->data; | 376 | msg = (struct atmsvc_msg *)skb->data; |
| 372 | new_vcc->qos = msg->qos; | 377 | new_vcc->qos = msg->qos; |
| 373 | set_bit(ATM_VF_HASQOS,&new_vcc->flags); | 378 | set_bit(ATM_VF_HASQOS, &new_vcc->flags); |
| 374 | new_vcc->remote = msg->svc; | 379 | new_vcc->remote = msg->svc; |
| 375 | new_vcc->local = msg->local; | 380 | new_vcc->local = msg->local; |
| 376 | new_vcc->sap = msg->sap; | 381 | new_vcc->sap = msg->sap; |
| 377 | error = vcc_connect(newsock, msg->pvc.sap_addr.itf, | 382 | error = vcc_connect(newsock, msg->pvc.sap_addr.itf, |
| 378 | msg->pvc.sap_addr.vpi, msg->pvc.sap_addr.vci); | 383 | msg->pvc.sap_addr.vpi, |
| 384 | msg->pvc.sap_addr.vci); | ||
| 379 | dev_kfree_skb(skb); | 385 | dev_kfree_skb(skb); |
| 380 | sk->sk_ack_backlog--; | 386 | sk->sk_ack_backlog--; |
| 381 | if (error) { | 387 | if (error) { |
| 382 | sigd_enq2(NULL,as_reject,old_vcc,NULL,NULL, | 388 | sigd_enq2(NULL, as_reject, old_vcc, NULL, NULL, |
| 383 | &old_vcc->qos,error); | 389 | &old_vcc->qos, error); |
| 384 | error = error == -EAGAIN ? -EBUSY : error; | 390 | error = error == -EAGAIN ? -EBUSY : error; |
| 385 | goto out; | 391 | goto out; |
| 386 | } | 392 | } |
| 387 | /* wait should be short, so we ignore the non-blocking flag */ | 393 | /* wait should be short, so we ignore the non-blocking flag */ |
| 388 | set_bit(ATM_VF_WAITING, &new_vcc->flags); | 394 | set_bit(ATM_VF_WAITING, &new_vcc->flags); |
| 389 | prepare_to_wait(sk_atm(new_vcc)->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); | 395 | prepare_to_wait(sk_atm(new_vcc)->sk_sleep, &wait, |
| 390 | sigd_enq(new_vcc,as_accept,old_vcc,NULL,NULL); | 396 | TASK_UNINTERRUPTIBLE); |
| 397 | sigd_enq(new_vcc, as_accept, old_vcc, NULL, NULL); | ||
| 391 | while (test_bit(ATM_VF_WAITING, &new_vcc->flags) && sigd) { | 398 | while (test_bit(ATM_VF_WAITING, &new_vcc->flags) && sigd) { |
| 392 | release_sock(sk); | 399 | release_sock(sk); |
| 393 | schedule(); | 400 | schedule(); |
| 394 | lock_sock(sk); | 401 | lock_sock(sk); |
| 395 | prepare_to_wait(sk_atm(new_vcc)->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); | 402 | prepare_to_wait(sk_atm(new_vcc)->sk_sleep, &wait, |
| 403 | TASK_UNINTERRUPTIBLE); | ||
| 396 | } | 404 | } |
| 397 | finish_wait(sk_atm(new_vcc)->sk_sleep, &wait); | 405 | finish_wait(sk_atm(new_vcc)->sk_sleep, &wait); |
| 398 | if (!sigd) { | 406 | if (!sigd) { |
| @@ -412,39 +420,37 @@ out: | |||
| 412 | return error; | 420 | return error; |
| 413 | } | 421 | } |
| 414 | 422 | ||
| 415 | 423 | static int svc_getname(struct socket *sock, struct sockaddr *sockaddr, | |
| 416 | static int svc_getname(struct socket *sock,struct sockaddr *sockaddr, | 424 | int *sockaddr_len, int peer) |
| 417 | int *sockaddr_len,int peer) | ||
| 418 | { | 425 | { |
| 419 | struct sockaddr_atmsvc *addr; | 426 | struct sockaddr_atmsvc *addr; |
| 420 | 427 | ||
| 421 | *sockaddr_len = sizeof(struct sockaddr_atmsvc); | 428 | *sockaddr_len = sizeof(struct sockaddr_atmsvc); |
| 422 | addr = (struct sockaddr_atmsvc *) sockaddr; | 429 | addr = (struct sockaddr_atmsvc *) sockaddr; |
| 423 | memcpy(addr,peer ? &ATM_SD(sock)->remote : &ATM_SD(sock)->local, | 430 | memcpy(addr, peer ? &ATM_SD(sock)->remote : &ATM_SD(sock)->local, |
| 424 | sizeof(struct sockaddr_atmsvc)); | 431 | sizeof(struct sockaddr_atmsvc)); |
| 425 | return 0; | 432 | return 0; |
| 426 | } | 433 | } |
| 427 | 434 | ||
| 428 | 435 | int svc_change_qos(struct atm_vcc *vcc, struct atm_qos *qos) | |
| 429 | int svc_change_qos(struct atm_vcc *vcc,struct atm_qos *qos) | ||
| 430 | { | 436 | { |
| 431 | struct sock *sk = sk_atm(vcc); | 437 | struct sock *sk = sk_atm(vcc); |
| 432 | DEFINE_WAIT(wait); | 438 | DEFINE_WAIT(wait); |
| 433 | 439 | ||
| 434 | set_bit(ATM_VF_WAITING, &vcc->flags); | 440 | set_bit(ATM_VF_WAITING, &vcc->flags); |
| 435 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); | 441 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); |
| 436 | sigd_enq2(vcc,as_modify,NULL,NULL,&vcc->local,qos,0); | 442 | sigd_enq2(vcc, as_modify, NULL, NULL, &vcc->local, qos, 0); |
| 437 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && | 443 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && |
| 438 | !test_bit(ATM_VF_RELEASED, &vcc->flags) && sigd) { | 444 | !test_bit(ATM_VF_RELEASED, &vcc->flags) && sigd) { |
| 439 | schedule(); | 445 | schedule(); |
| 440 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); | 446 | prepare_to_wait(sk->sk_sleep, &wait, TASK_UNINTERRUPTIBLE); |
| 441 | } | 447 | } |
| 442 | finish_wait(sk->sk_sleep, &wait); | 448 | finish_wait(sk->sk_sleep, &wait); |
| 443 | if (!sigd) return -EUNATCH; | 449 | if (!sigd) |
| 450 | return -EUNATCH; | ||
| 444 | return -sk->sk_err; | 451 | return -sk->sk_err; |
| 445 | } | 452 | } |
| 446 | 453 | ||
| 447 | |||
| 448 | static int svc_setsockopt(struct socket *sock, int level, int optname, | 454 | static int svc_setsockopt(struct socket *sock, int level, int optname, |
| 449 | char __user *optval, unsigned int optlen) | 455 | char __user *optval, unsigned int optlen) |
| 450 | { | 456 | { |
| @@ -454,37 +460,35 @@ static int svc_setsockopt(struct socket *sock, int level, int optname, | |||
| 454 | 460 | ||
| 455 | lock_sock(sk); | 461 | lock_sock(sk); |
| 456 | switch (optname) { | 462 | switch (optname) { |
| 457 | case SO_ATMSAP: | 463 | case SO_ATMSAP: |
| 458 | if (level != SOL_ATM || optlen != sizeof(struct atm_sap)) { | 464 | if (level != SOL_ATM || optlen != sizeof(struct atm_sap)) { |
| 459 | error = -EINVAL; | 465 | error = -EINVAL; |
| 460 | goto out; | 466 | goto out; |
| 461 | } | 467 | } |
| 462 | if (copy_from_user(&vcc->sap, optval, optlen)) { | 468 | if (copy_from_user(&vcc->sap, optval, optlen)) { |
| 463 | error = -EFAULT; | 469 | error = -EFAULT; |
| 464 | goto out; | 470 | goto out; |
| 465 | } | 471 | } |
| 466 | set_bit(ATM_VF_HASSAP, &vcc->flags); | 472 | set_bit(ATM_VF_HASSAP, &vcc->flags); |
| 467 | break; | 473 | break; |
| 468 | case SO_MULTIPOINT: | 474 | case SO_MULTIPOINT: |
| 469 | if (level != SOL_ATM || optlen != sizeof(int)) { | 475 | if (level != SOL_ATM || optlen != sizeof(int)) { |
| 470 | error = -EINVAL; | 476 | error = -EINVAL; |
| 471 | goto out; | 477 | goto out; |
| 472 | } | 478 | } |
| 473 | if (get_user(value, (int __user *) optval)) { | 479 | if (get_user(value, (int __user *)optval)) { |
| 474 | error = -EFAULT; | 480 | error = -EFAULT; |
| 475 | goto out; | 481 | goto out; |
| 476 | } | 482 | } |
| 477 | if (value == 1) { | 483 | if (value == 1) |
| 478 | set_bit(ATM_VF_SESSION, &vcc->flags); | 484 | set_bit(ATM_VF_SESSION, &vcc->flags); |
| 479 | } else if (value == 0) { | 485 | else if (value == 0) |
| 480 | clear_bit(ATM_VF_SESSION, &vcc->flags); | 486 | clear_bit(ATM_VF_SESSION, &vcc->flags); |
| 481 | } else { | 487 | else |
| 482 | error = -EINVAL; | 488 | error = -EINVAL; |
| 483 | } | 489 | break; |
| 484 | break; | 490 | default: |
| 485 | default: | 491 | error = vcc_setsockopt(sock, level, optname, optval, optlen); |
| 486 | error = vcc_setsockopt(sock, level, optname, | ||
| 487 | optval, optlen); | ||
| 488 | } | 492 | } |
| 489 | 493 | ||
| 490 | out: | 494 | out: |
| @@ -492,9 +496,8 @@ out: | |||
| 492 | return error; | 496 | return error; |
| 493 | } | 497 | } |
| 494 | 498 | ||
| 495 | 499 | static int svc_getsockopt(struct socket *sock, int level, int optname, | |
| 496 | static int svc_getsockopt(struct socket *sock,int level,int optname, | 500 | char __user *optval, int __user *optlen) |
| 497 | char __user *optval,int __user *optlen) | ||
| 498 | { | 501 | { |
| 499 | struct sock *sk = sock->sk; | 502 | struct sock *sk = sock->sk; |
| 500 | int error = 0, len; | 503 | int error = 0, len; |
| @@ -521,7 +524,6 @@ out: | |||
| 521 | return error; | 524 | return error; |
| 522 | } | 525 | } |
| 523 | 526 | ||
| 524 | |||
| 525 | static int svc_addparty(struct socket *sock, struct sockaddr *sockaddr, | 527 | static int svc_addparty(struct socket *sock, struct sockaddr *sockaddr, |
| 526 | int sockaddr_len, int flags) | 528 | int sockaddr_len, int flags) |
| 527 | { | 529 | { |
| @@ -540,7 +542,7 @@ static int svc_addparty(struct socket *sock, struct sockaddr *sockaddr, | |||
| 540 | error = -EINPROGRESS; | 542 | error = -EINPROGRESS; |
| 541 | goto out; | 543 | goto out; |
| 542 | } | 544 | } |
| 543 | pr_debug("svc_addparty added wait queue\n"); | 545 | pr_debug("added wait queue\n"); |
| 544 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && sigd) { | 546 | while (test_bit(ATM_VF_WAITING, &vcc->flags) && sigd) { |
| 545 | schedule(); | 547 | schedule(); |
| 546 | prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE); | 548 | prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE); |
| @@ -552,7 +554,6 @@ out: | |||
| 552 | return error; | 554 | return error; |
| 553 | } | 555 | } |
| 554 | 556 | ||
| 555 | |||
| 556 | static int svc_dropparty(struct socket *sock, int ep_ref) | 557 | static int svc_dropparty(struct socket *sock, int ep_ref) |
| 557 | { | 558 | { |
| 558 | DEFINE_WAIT(wait); | 559 | DEFINE_WAIT(wait); |
| @@ -579,7 +580,6 @@ out: | |||
| 579 | return error; | 580 | return error; |
| 580 | } | 581 | } |
| 581 | 582 | ||
| 582 | |||
| 583 | static int svc_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) | 583 | static int svc_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) |
| 584 | { | 584 | { |
| 585 | int error, ep_ref; | 585 | int error, ep_ref; |
| @@ -587,29 +587,31 @@ static int svc_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) | |||
| 587 | struct atm_vcc *vcc = ATM_SD(sock); | 587 | struct atm_vcc *vcc = ATM_SD(sock); |
| 588 | 588 | ||
| 589 | switch (cmd) { | 589 | switch (cmd) { |
| 590 | case ATM_ADDPARTY: | 590 | case ATM_ADDPARTY: |
| 591 | if (!test_bit(ATM_VF_SESSION, &vcc->flags)) | 591 | if (!test_bit(ATM_VF_SESSION, &vcc->flags)) |
| 592 | return -EINVAL; | 592 | return -EINVAL; |
| 593 | if (copy_from_user(&sa, (void __user *) arg, sizeof(sa))) | 593 | if (copy_from_user(&sa, (void __user *) arg, sizeof(sa))) |
| 594 | return -EFAULT; | 594 | return -EFAULT; |
| 595 | error = svc_addparty(sock, (struct sockaddr *) &sa, sizeof(sa), 0); | 595 | error = svc_addparty(sock, (struct sockaddr *)&sa, sizeof(sa), |
| 596 | break; | 596 | 0); |
| 597 | case ATM_DROPPARTY: | 597 | break; |
| 598 | if (!test_bit(ATM_VF_SESSION, &vcc->flags)) | 598 | case ATM_DROPPARTY: |
| 599 | return -EINVAL; | 599 | if (!test_bit(ATM_VF_SESSION, &vcc->flags)) |
| 600 | if (copy_from_user(&ep_ref, (void __user *) arg, sizeof(int))) | 600 | return -EINVAL; |
| 601 | return -EFAULT; | 601 | if (copy_from_user(&ep_ref, (void __user *) arg, sizeof(int))) |
| 602 | error = svc_dropparty(sock, ep_ref); | 602 | return -EFAULT; |
| 603 | break; | 603 | error = svc_dropparty(sock, ep_ref); |
| 604 | default: | 604 | break; |
| 605 | error = vcc_ioctl(sock, cmd, arg); | 605 | default: |
| 606 | error = vcc_ioctl(sock, cmd, arg); | ||
| 606 | } | 607 | } |
| 607 | 608 | ||
| 608 | return error; | 609 | return error; |
| 609 | } | 610 | } |
| 610 | 611 | ||
| 611 | #ifdef CONFIG_COMPAT | 612 | #ifdef CONFIG_COMPAT |
| 612 | static int svc_compat_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) | 613 | static int svc_compat_ioctl(struct socket *sock, unsigned int cmd, |
| 614 | unsigned long arg) | ||
| 613 | { | 615 | { |
| 614 | /* The definition of ATM_ADDPARTY uses the size of struct atm_iobuf. | 616 | /* The definition of ATM_ADDPARTY uses the size of struct atm_iobuf. |
| 615 | But actually it takes a struct sockaddr_atmsvc, which doesn't need | 617 | But actually it takes a struct sockaddr_atmsvc, which doesn't need |
| @@ -660,13 +662,13 @@ static int svc_create(struct net *net, struct socket *sock, int protocol, | |||
| 660 | 662 | ||
| 661 | sock->ops = &svc_proto_ops; | 663 | sock->ops = &svc_proto_ops; |
| 662 | error = vcc_create(net, sock, protocol, AF_ATMSVC); | 664 | error = vcc_create(net, sock, protocol, AF_ATMSVC); |
| 663 | if (error) return error; | 665 | if (error) |
| 666 | return error; | ||
| 664 | ATM_SD(sock)->local.sas_family = AF_ATMSVC; | 667 | ATM_SD(sock)->local.sas_family = AF_ATMSVC; |
| 665 | ATM_SD(sock)->remote.sas_family = AF_ATMSVC; | 668 | ATM_SD(sock)->remote.sas_family = AF_ATMSVC; |
| 666 | return 0; | 669 | return 0; |
| 667 | } | 670 | } |
| 668 | 671 | ||
| 669 | |||
| 670 | static const struct net_proto_family svc_family_ops = { | 672 | static const struct net_proto_family svc_family_ops = { |
| 671 | .family = PF_ATMSVC, | 673 | .family = PF_ATMSVC, |
| 672 | .create = svc_create, | 674 | .create = svc_create, |
