diff options
Diffstat (limited to 'net/atm/signaling.c')
-rw-r--r-- | net/atm/signaling.c | 220 |
1 files changed, 110 insertions, 110 deletions
diff --git a/net/atm/signaling.c b/net/atm/signaling.c index 229921400522..6ba6e466ee54 100644 --- a/net/atm/signaling.c +++ b/net/atm/signaling.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/errno.h> /* error codes */ | 7 | #include <linux/errno.h> /* error codes */ |
7 | #include <linux/kernel.h> /* printk */ | 8 | #include <linux/kernel.h> /* printk */ |
@@ -13,11 +14,11 @@ | |||
13 | #include <linux/atmsvc.h> | 14 | #include <linux/atmsvc.h> |
14 | #include <linux/atmdev.h> | 15 | #include <linux/atmdev.h> |
15 | #include <linux/bitops.h> | 16 | #include <linux/bitops.h> |
17 | #include <linux/slab.h> | ||
16 | 18 | ||
17 | #include "resources.h" | 19 | #include "resources.h" |
18 | #include "signaling.h" | 20 | #include "signaling.h" |
19 | 21 | ||
20 | |||
21 | #undef WAIT_FOR_DEMON /* #define this if system calls on SVC sockets | 22 | #undef WAIT_FOR_DEMON /* #define this if system calls on SVC sockets |
22 | should block until the demon runs. | 23 | should block until the demon runs. |
23 | Danger: may cause nasty hangs if the demon | 24 | Danger: may cause nasty hangs if the demon |
@@ -28,60 +29,59 @@ struct atm_vcc *sigd = NULL; | |||
28 | static DECLARE_WAIT_QUEUE_HEAD(sigd_sleep); | 29 | static DECLARE_WAIT_QUEUE_HEAD(sigd_sleep); |
29 | #endif | 30 | #endif |
30 | 31 | ||
31 | |||
32 | static void sigd_put_skb(struct sk_buff *skb) | 32 | static void sigd_put_skb(struct sk_buff *skb) |
33 | { | 33 | { |
34 | #ifdef WAIT_FOR_DEMON | 34 | #ifdef WAIT_FOR_DEMON |
35 | DECLARE_WAITQUEUE(wait,current); | 35 | DECLARE_WAITQUEUE(wait, current); |
36 | 36 | ||
37 | add_wait_queue(&sigd_sleep,&wait); | 37 | add_wait_queue(&sigd_sleep, &wait); |
38 | while (!sigd) { | 38 | while (!sigd) { |
39 | set_current_state(TASK_UNINTERRUPTIBLE); | 39 | set_current_state(TASK_UNINTERRUPTIBLE); |
40 | pr_debug("atmsvc: waiting for signaling demon...\n"); | 40 | pr_debug("atmsvc: waiting for signaling daemon...\n"); |
41 | schedule(); | 41 | schedule(); |
42 | } | 42 | } |
43 | current->state = TASK_RUNNING; | 43 | current->state = TASK_RUNNING; |
44 | remove_wait_queue(&sigd_sleep,&wait); | 44 | remove_wait_queue(&sigd_sleep, &wait); |
45 | #else | 45 | #else |
46 | if (!sigd) { | 46 | if (!sigd) { |
47 | pr_debug("atmsvc: no signaling demon\n"); | 47 | pr_debug("atmsvc: no signaling daemon\n"); |
48 | kfree_skb(skb); | 48 | kfree_skb(skb); |
49 | return; | 49 | return; |
50 | } | 50 | } |
51 | #endif | 51 | #endif |
52 | atm_force_charge(sigd,skb->truesize); | 52 | atm_force_charge(sigd, skb->truesize); |
53 | skb_queue_tail(&sk_atm(sigd)->sk_receive_queue,skb); | 53 | skb_queue_tail(&sk_atm(sigd)->sk_receive_queue, skb); |
54 | sk_atm(sigd)->sk_data_ready(sk_atm(sigd), skb->len); | 54 | sk_atm(sigd)->sk_data_ready(sk_atm(sigd), skb->len); |
55 | } | 55 | } |
56 | 56 | ||
57 | 57 | static void modify_qos(struct atm_vcc *vcc, struct atmsvc_msg *msg) | |
58 | static void modify_qos(struct atm_vcc *vcc,struct atmsvc_msg *msg) | ||
59 | { | 58 | { |
60 | struct sk_buff *skb; | 59 | struct sk_buff *skb; |
61 | 60 | ||
62 | if (test_bit(ATM_VF_RELEASED,&vcc->flags) || | 61 | if (test_bit(ATM_VF_RELEASED, &vcc->flags) || |
63 | !test_bit(ATM_VF_READY,&vcc->flags)) | 62 | !test_bit(ATM_VF_READY, &vcc->flags)) |
64 | return; | 63 | return; |
65 | msg->type = as_error; | 64 | msg->type = as_error; |
66 | if (!vcc->dev->ops->change_qos) msg->reply = -EOPNOTSUPP; | 65 | if (!vcc->dev->ops->change_qos) |
66 | msg->reply = -EOPNOTSUPP; | ||
67 | else { | 67 | else { |
68 | /* should lock VCC */ | 68 | /* should lock VCC */ |
69 | msg->reply = vcc->dev->ops->change_qos(vcc,&msg->qos, | 69 | msg->reply = vcc->dev->ops->change_qos(vcc, &msg->qos, |
70 | msg->reply); | 70 | msg->reply); |
71 | if (!msg->reply) msg->type = as_okay; | 71 | if (!msg->reply) |
72 | msg->type = as_okay; | ||
72 | } | 73 | } |
73 | /* | 74 | /* |
74 | * Should probably just turn around the old skb. But the, the buffer | 75 | * Should probably just turn around the old skb. But the, the buffer |
75 | * space accounting needs to follow the change too. Maybe later. | 76 | * space accounting needs to follow the change too. Maybe later. |
76 | */ | 77 | */ |
77 | while (!(skb = alloc_skb(sizeof(struct atmsvc_msg),GFP_KERNEL))) | 78 | while (!(skb = alloc_skb(sizeof(struct atmsvc_msg), GFP_KERNEL))) |
78 | schedule(); | 79 | schedule(); |
79 | *(struct atmsvc_msg *) skb_put(skb,sizeof(struct atmsvc_msg)) = *msg; | 80 | *(struct atmsvc_msg *)skb_put(skb, sizeof(struct atmsvc_msg)) = *msg; |
80 | sigd_put_skb(skb); | 81 | sigd_put_skb(skb); |
81 | } | 82 | } |
82 | 83 | ||
83 | 84 | static int sigd_send(struct atm_vcc *vcc, struct sk_buff *skb) | |
84 | static int sigd_send(struct atm_vcc *vcc,struct sk_buff *skb) | ||
85 | { | 85 | { |
86 | struct atmsvc_msg *msg; | 86 | struct atmsvc_msg *msg; |
87 | struct atm_vcc *session_vcc; | 87 | struct atm_vcc *session_vcc; |
@@ -90,69 +90,68 @@ static int sigd_send(struct atm_vcc *vcc,struct sk_buff *skb) | |||
90 | msg = (struct atmsvc_msg *) skb->data; | 90 | msg = (struct atmsvc_msg *) skb->data; |
91 | atomic_sub(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc); | 91 | atomic_sub(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc); |
92 | vcc = *(struct atm_vcc **) &msg->vcc; | 92 | vcc = *(struct atm_vcc **) &msg->vcc; |
93 | pr_debug("sigd_send %d (0x%lx)\n",(int) msg->type, | 93 | pr_debug("%d (0x%lx)\n", (int)msg->type, (unsigned long)vcc); |
94 | (unsigned long) vcc); | ||
95 | sk = sk_atm(vcc); | 94 | sk = sk_atm(vcc); |
96 | 95 | ||
97 | switch (msg->type) { | 96 | switch (msg->type) { |
98 | case as_okay: | 97 | case as_okay: |
99 | sk->sk_err = -msg->reply; | 98 | sk->sk_err = -msg->reply; |
100 | clear_bit(ATM_VF_WAITING, &vcc->flags); | 99 | clear_bit(ATM_VF_WAITING, &vcc->flags); |
101 | if (!*vcc->local.sas_addr.prv && | 100 | if (!*vcc->local.sas_addr.prv && !*vcc->local.sas_addr.pub) { |
102 | !*vcc->local.sas_addr.pub) { | 101 | vcc->local.sas_family = AF_ATMSVC; |
103 | vcc->local.sas_family = AF_ATMSVC; | 102 | memcpy(vcc->local.sas_addr.prv, |
104 | memcpy(vcc->local.sas_addr.prv, | 103 | msg->local.sas_addr.prv, ATM_ESA_LEN); |
105 | msg->local.sas_addr.prv,ATM_ESA_LEN); | 104 | memcpy(vcc->local.sas_addr.pub, |
106 | memcpy(vcc->local.sas_addr.pub, | 105 | msg->local.sas_addr.pub, ATM_E164_LEN + 1); |
107 | msg->local.sas_addr.pub,ATM_E164_LEN+1); | 106 | } |
108 | } | 107 | session_vcc = vcc->session ? vcc->session : vcc; |
109 | session_vcc = vcc->session ? vcc->session : vcc; | 108 | if (session_vcc->vpi || session_vcc->vci) |
110 | if (session_vcc->vpi || session_vcc->vci) break; | ||
111 | session_vcc->itf = msg->pvc.sap_addr.itf; | ||
112 | session_vcc->vpi = msg->pvc.sap_addr.vpi; | ||
113 | session_vcc->vci = msg->pvc.sap_addr.vci; | ||
114 | if (session_vcc->vpi || session_vcc->vci) | ||
115 | session_vcc->qos = msg->qos; | ||
116 | break; | ||
117 | case as_error: | ||
118 | clear_bit(ATM_VF_REGIS,&vcc->flags); | ||
119 | clear_bit(ATM_VF_READY,&vcc->flags); | ||
120 | sk->sk_err = -msg->reply; | ||
121 | clear_bit(ATM_VF_WAITING, &vcc->flags); | ||
122 | break; | 109 | break; |
123 | case as_indicate: | 110 | session_vcc->itf = msg->pvc.sap_addr.itf; |
124 | vcc = *(struct atm_vcc **) &msg->listen_vcc; | 111 | session_vcc->vpi = msg->pvc.sap_addr.vpi; |
125 | sk = sk_atm(vcc); | 112 | session_vcc->vci = msg->pvc.sap_addr.vci; |
126 | pr_debug("as_indicate!!!\n"); | 113 | if (session_vcc->vpi || session_vcc->vci) |
127 | lock_sock(sk); | 114 | session_vcc->qos = msg->qos; |
128 | if (sk_acceptq_is_full(sk)) { | 115 | break; |
129 | sigd_enq(NULL,as_reject,vcc,NULL,NULL); | 116 | case as_error: |
130 | dev_kfree_skb(skb); | 117 | clear_bit(ATM_VF_REGIS, &vcc->flags); |
131 | goto as_indicate_complete; | 118 | clear_bit(ATM_VF_READY, &vcc->flags); |
132 | } | 119 | sk->sk_err = -msg->reply; |
133 | sk->sk_ack_backlog++; | 120 | clear_bit(ATM_VF_WAITING, &vcc->flags); |
134 | skb_queue_tail(&sk->sk_receive_queue, skb); | 121 | break; |
135 | pr_debug("waking sk->sk_sleep 0x%p\n", sk->sk_sleep); | 122 | case as_indicate: |
136 | sk->sk_state_change(sk); | 123 | vcc = *(struct atm_vcc **)&msg->listen_vcc; |
124 | sk = sk_atm(vcc); | ||
125 | pr_debug("as_indicate!!!\n"); | ||
126 | lock_sock(sk); | ||
127 | if (sk_acceptq_is_full(sk)) { | ||
128 | sigd_enq(NULL, as_reject, vcc, NULL, NULL); | ||
129 | dev_kfree_skb(skb); | ||
130 | goto as_indicate_complete; | ||
131 | } | ||
132 | sk->sk_ack_backlog++; | ||
133 | skb_queue_tail(&sk->sk_receive_queue, skb); | ||
134 | pr_debug("waking sk->sk_sleep 0x%p\n", sk->sk_sleep); | ||
135 | sk->sk_state_change(sk); | ||
137 | as_indicate_complete: | 136 | as_indicate_complete: |
138 | release_sock(sk); | 137 | release_sock(sk); |
139 | return 0; | 138 | return 0; |
140 | case as_close: | 139 | case as_close: |
141 | set_bit(ATM_VF_RELEASED,&vcc->flags); | 140 | set_bit(ATM_VF_RELEASED, &vcc->flags); |
142 | vcc_release_async(vcc, msg->reply); | 141 | vcc_release_async(vcc, msg->reply); |
143 | goto out; | 142 | goto out; |
144 | case as_modify: | 143 | case as_modify: |
145 | modify_qos(vcc,msg); | 144 | modify_qos(vcc, msg); |
146 | break; | 145 | break; |
147 | case as_addparty: | 146 | case as_addparty: |
148 | case as_dropparty: | 147 | case as_dropparty: |
149 | sk->sk_err_soft = msg->reply; /* < 0 failure, otherwise ep_ref */ | 148 | sk->sk_err_soft = msg->reply; |
150 | clear_bit(ATM_VF_WAITING, &vcc->flags); | 149 | /* < 0 failure, otherwise ep_ref */ |
151 | break; | 150 | clear_bit(ATM_VF_WAITING, &vcc->flags); |
152 | default: | 151 | break; |
153 | printk(KERN_ALERT "sigd_send: bad message type %d\n", | 152 | default: |
154 | (int) msg->type); | 153 | pr_alert("bad message type %d\n", (int)msg->type); |
155 | return -EINVAL; | 154 | return -EINVAL; |
156 | } | 155 | } |
157 | sk->sk_state_change(sk); | 156 | sk->sk_state_change(sk); |
158 | out: | 157 | out: |
@@ -160,48 +159,52 @@ out: | |||
160 | return 0; | 159 | return 0; |
161 | } | 160 | } |
162 | 161 | ||
163 | 162 | void sigd_enq2(struct atm_vcc *vcc, enum atmsvc_msg_type type, | |
164 | void sigd_enq2(struct atm_vcc *vcc,enum atmsvc_msg_type type, | 163 | struct atm_vcc *listen_vcc, const struct sockaddr_atmpvc *pvc, |
165 | struct atm_vcc *listen_vcc,const struct sockaddr_atmpvc *pvc, | 164 | const struct sockaddr_atmsvc *svc, const struct atm_qos *qos, |
166 | const struct sockaddr_atmsvc *svc,const struct atm_qos *qos,int reply) | 165 | int reply) |
167 | { | 166 | { |
168 | struct sk_buff *skb; | 167 | struct sk_buff *skb; |
169 | struct atmsvc_msg *msg; | 168 | struct atmsvc_msg *msg; |
170 | static unsigned session = 0; | 169 | static unsigned session = 0; |
171 | 170 | ||
172 | pr_debug("sigd_enq %d (0x%p)\n",(int) type,vcc); | 171 | pr_debug("%d (0x%p)\n", (int)type, vcc); |
173 | while (!(skb = alloc_skb(sizeof(struct atmsvc_msg),GFP_KERNEL))) | 172 | while (!(skb = alloc_skb(sizeof(struct atmsvc_msg), GFP_KERNEL))) |
174 | schedule(); | 173 | schedule(); |
175 | msg = (struct atmsvc_msg *) skb_put(skb,sizeof(struct atmsvc_msg)); | 174 | msg = (struct atmsvc_msg *)skb_put(skb, sizeof(struct atmsvc_msg)); |
176 | memset(msg,0,sizeof(*msg)); | 175 | memset(msg, 0, sizeof(*msg)); |
177 | msg->type = type; | 176 | msg->type = type; |
178 | *(struct atm_vcc **) &msg->vcc = vcc; | 177 | *(struct atm_vcc **) &msg->vcc = vcc; |
179 | *(struct atm_vcc **) &msg->listen_vcc = listen_vcc; | 178 | *(struct atm_vcc **) &msg->listen_vcc = listen_vcc; |
180 | msg->reply = reply; | 179 | msg->reply = reply; |
181 | if (qos) msg->qos = *qos; | 180 | if (qos) |
182 | if (vcc) msg->sap = vcc->sap; | 181 | msg->qos = *qos; |
183 | if (svc) msg->svc = *svc; | 182 | if (vcc) |
184 | if (vcc) msg->local = vcc->local; | 183 | msg->sap = vcc->sap; |
185 | if (pvc) msg->pvc = *pvc; | 184 | if (svc) |
185 | msg->svc = *svc; | ||
186 | if (vcc) | ||
187 | msg->local = vcc->local; | ||
188 | if (pvc) | ||
189 | msg->pvc = *pvc; | ||
186 | if (vcc) { | 190 | if (vcc) { |
187 | if (type == as_connect && test_bit(ATM_VF_SESSION, &vcc->flags)) | 191 | if (type == as_connect && test_bit(ATM_VF_SESSION, &vcc->flags)) |
188 | msg->session = ++session; | 192 | msg->session = ++session; |
189 | /* every new pmp connect gets the next session number */ | 193 | /* every new pmp connect gets the next session number */ |
190 | } | 194 | } |
191 | sigd_put_skb(skb); | 195 | sigd_put_skb(skb); |
192 | if (vcc) set_bit(ATM_VF_REGIS,&vcc->flags); | 196 | if (vcc) |
197 | set_bit(ATM_VF_REGIS, &vcc->flags); | ||
193 | } | 198 | } |
194 | 199 | ||
195 | 200 | void sigd_enq(struct atm_vcc *vcc, enum atmsvc_msg_type type, | |
196 | void sigd_enq(struct atm_vcc *vcc,enum atmsvc_msg_type type, | 201 | struct atm_vcc *listen_vcc, const struct sockaddr_atmpvc *pvc, |
197 | struct atm_vcc *listen_vcc,const struct sockaddr_atmpvc *pvc, | 202 | const struct sockaddr_atmsvc *svc) |
198 | const struct sockaddr_atmsvc *svc) | ||
199 | { | 203 | { |
200 | sigd_enq2(vcc,type,listen_vcc,pvc,svc,vcc ? &vcc->qos : NULL,0); | 204 | sigd_enq2(vcc, type, listen_vcc, pvc, svc, vcc ? &vcc->qos : NULL, 0); |
201 | /* other ISP applications may use "reply" */ | 205 | /* other ISP applications may use "reply" */ |
202 | } | 206 | } |
203 | 207 | ||
204 | |||
205 | static void purge_vcc(struct atm_vcc *vcc) | 208 | static void purge_vcc(struct atm_vcc *vcc) |
206 | { | 209 | { |
207 | if (sk_atm(vcc)->sk_family == PF_ATMSVC && | 210 | if (sk_atm(vcc)->sk_family == PF_ATMSVC && |
@@ -212,21 +215,20 @@ static void purge_vcc(struct atm_vcc *vcc) | |||
212 | } | 215 | } |
213 | } | 216 | } |
214 | 217 | ||
215 | |||
216 | static void sigd_close(struct atm_vcc *vcc) | 218 | static void sigd_close(struct atm_vcc *vcc) |
217 | { | 219 | { |
218 | struct hlist_node *node; | 220 | struct hlist_node *node; |
219 | struct sock *s; | 221 | struct sock *s; |
220 | int i; | 222 | int i; |
221 | 223 | ||
222 | pr_debug("sigd_close\n"); | 224 | pr_debug("\n"); |
223 | sigd = NULL; | 225 | sigd = NULL; |
224 | if (skb_peek(&sk_atm(vcc)->sk_receive_queue)) | 226 | if (skb_peek(&sk_atm(vcc)->sk_receive_queue)) |
225 | printk(KERN_ERR "sigd_close: closing with requests pending\n"); | 227 | pr_err("closing with requests pending\n"); |
226 | skb_queue_purge(&sk_atm(vcc)->sk_receive_queue); | 228 | skb_queue_purge(&sk_atm(vcc)->sk_receive_queue); |
227 | 229 | ||
228 | read_lock(&vcc_sklist_lock); | 230 | read_lock(&vcc_sklist_lock); |
229 | for(i = 0; i < VCC_HTABLE_SIZE; ++i) { | 231 | for (i = 0; i < VCC_HTABLE_SIZE; ++i) { |
230 | struct hlist_head *head = &vcc_hash[i]; | 232 | struct hlist_head *head = &vcc_hash[i]; |
231 | 233 | ||
232 | sk_for_each(s, node, head) { | 234 | sk_for_each(s, node, head) { |
@@ -238,13 +240,11 @@ static void sigd_close(struct atm_vcc *vcc) | |||
238 | read_unlock(&vcc_sklist_lock); | 240 | read_unlock(&vcc_sklist_lock); |
239 | } | 241 | } |
240 | 242 | ||
241 | |||
242 | static struct atmdev_ops sigd_dev_ops = { | 243 | static struct atmdev_ops sigd_dev_ops = { |
243 | .close = sigd_close, | 244 | .close = sigd_close, |
244 | .send = sigd_send | 245 | .send = sigd_send |
245 | }; | 246 | }; |
246 | 247 | ||
247 | |||
248 | static struct atm_dev sigd_dev = { | 248 | static struct atm_dev sigd_dev = { |
249 | .ops = &sigd_dev_ops, | 249 | .ops = &sigd_dev_ops, |
250 | .type = "sig", | 250 | .type = "sig", |
@@ -252,16 +252,16 @@ static struct atm_dev sigd_dev = { | |||
252 | .lock = __SPIN_LOCK_UNLOCKED(sigd_dev.lock) | 252 | .lock = __SPIN_LOCK_UNLOCKED(sigd_dev.lock) |
253 | }; | 253 | }; |
254 | 254 | ||
255 | |||
256 | int sigd_attach(struct atm_vcc *vcc) | 255 | int sigd_attach(struct atm_vcc *vcc) |
257 | { | 256 | { |
258 | if (sigd) return -EADDRINUSE; | 257 | if (sigd) |
259 | pr_debug("sigd_attach\n"); | 258 | return -EADDRINUSE; |
259 | pr_debug("\n"); | ||
260 | sigd = vcc; | 260 | sigd = vcc; |
261 | vcc->dev = &sigd_dev; | 261 | vcc->dev = &sigd_dev; |
262 | vcc_insert_socket(sk_atm(vcc)); | 262 | vcc_insert_socket(sk_atm(vcc)); |
263 | set_bit(ATM_VF_META,&vcc->flags); | 263 | set_bit(ATM_VF_META, &vcc->flags); |
264 | set_bit(ATM_VF_READY,&vcc->flags); | 264 | set_bit(ATM_VF_READY, &vcc->flags); |
265 | #ifdef WAIT_FOR_DEMON | 265 | #ifdef WAIT_FOR_DEMON |
266 | wake_up(&sigd_sleep); | 266 | wake_up(&sigd_sleep); |
267 | #endif | 267 | #endif |