1 /* net/atm/signaling.c - ATM signaling */
3 /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
5 #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
7 #include <linux/errno.h> /* error codes */
8 #include <linux/kernel.h> /* printk */
9 #include <linux/skbuff.h>
10 #include <linux/wait.h>
11 #include <linux/sched.h> /* jiffies and HZ */
12 #include <linux/atm.h> /* ATM stuff */
13 #include <linux/atmsap.h>
14 #include <linux/atmsvc.h>
15 #include <linux/atmdev.h>
16 #include <linux/bitops.h>
18 #include "resources.h"
19 #include "signaling.h"
21 #undef WAIT_FOR_DEMON /* #define this if system calls on SVC sockets
22 should block until the demon runs.
23 Danger: may cause nasty hangs if the demon
26 struct atm_vcc
*sigd
= NULL
;
28 static DECLARE_WAIT_QUEUE_HEAD(sigd_sleep
);
31 static void sigd_put_skb(struct sk_buff
*skb
)
34 DECLARE_WAITQUEUE(wait
, current
);
36 add_wait_queue(&sigd_sleep
, &wait
);
38 set_current_state(TASK_UNINTERRUPTIBLE
);
39 pr_debug("atmsvc: waiting for signaling daemon...\n");
42 current
->state
= TASK_RUNNING
;
43 remove_wait_queue(&sigd_sleep
, &wait
);
46 pr_debug("atmsvc: no signaling daemon\n");
51 atm_force_charge(sigd
, skb
->truesize
);
52 skb_queue_tail(&sk_atm(sigd
)->sk_receive_queue
, skb
);
53 sk_atm(sigd
)->sk_data_ready(sk_atm(sigd
), skb
->len
);
56 static void modify_qos(struct atm_vcc
*vcc
, struct atmsvc_msg
*msg
)
60 if (test_bit(ATM_VF_RELEASED
, &vcc
->flags
) ||
61 !test_bit(ATM_VF_READY
, &vcc
->flags
))
64 if (!vcc
->dev
->ops
->change_qos
)
65 msg
->reply
= -EOPNOTSUPP
;
68 msg
->reply
= vcc
->dev
->ops
->change_qos(vcc
, &msg
->qos
,
74 * Should probably just turn around the old skb. But the, the buffer
75 * space accounting needs to follow the change too. Maybe later.
77 while (!(skb
= alloc_skb(sizeof(struct atmsvc_msg
), GFP_KERNEL
)))
79 *(struct atmsvc_msg
*)skb_put(skb
, sizeof(struct atmsvc_msg
)) = *msg
;
83 static int sigd_send(struct atm_vcc
*vcc
, struct sk_buff
*skb
)
85 struct atmsvc_msg
*msg
;
86 struct atm_vcc
*session_vcc
;
89 msg
= (struct atmsvc_msg
*) skb
->data
;
90 atomic_sub(skb
->truesize
, &sk_atm(vcc
)->sk_wmem_alloc
);
91 vcc
= *(struct atm_vcc
**) &msg
->vcc
;
92 pr_debug("%d (0x%lx)\n", (int)msg
->type
, (unsigned long)vcc
);
97 sk
->sk_err
= -msg
->reply
;
98 clear_bit(ATM_VF_WAITING
, &vcc
->flags
);
99 if (!*vcc
->local
.sas_addr
.prv
&& !*vcc
->local
.sas_addr
.pub
) {
100 vcc
->local
.sas_family
= AF_ATMSVC
;
101 memcpy(vcc
->local
.sas_addr
.prv
,
102 msg
->local
.sas_addr
.prv
, ATM_ESA_LEN
);
103 memcpy(vcc
->local
.sas_addr
.pub
,
104 msg
->local
.sas_addr
.pub
, ATM_E164_LEN
+ 1);
106 session_vcc
= vcc
->session
? vcc
->session
: vcc
;
107 if (session_vcc
->vpi
|| session_vcc
->vci
)
109 session_vcc
->itf
= msg
->pvc
.sap_addr
.itf
;
110 session_vcc
->vpi
= msg
->pvc
.sap_addr
.vpi
;
111 session_vcc
->vci
= msg
->pvc
.sap_addr
.vci
;
112 if (session_vcc
->vpi
|| session_vcc
->vci
)
113 session_vcc
->qos
= msg
->qos
;
116 clear_bit(ATM_VF_REGIS
, &vcc
->flags
);
117 clear_bit(ATM_VF_READY
, &vcc
->flags
);
118 sk
->sk_err
= -msg
->reply
;
119 clear_bit(ATM_VF_WAITING
, &vcc
->flags
);
122 vcc
= *(struct atm_vcc
**)&msg
->listen_vcc
;
124 pr_debug("as_indicate!!!\n");
126 if (sk_acceptq_is_full(sk
)) {
127 sigd_enq(NULL
, as_reject
, vcc
, NULL
, NULL
);
129 goto as_indicate_complete
;
131 sk
->sk_ack_backlog
++;
132 skb_queue_tail(&sk
->sk_receive_queue
, skb
);
133 pr_debug("waking sk->sk_sleep 0x%p\n", sk
->sk_sleep
);
134 sk
->sk_state_change(sk
);
135 as_indicate_complete
:
139 set_bit(ATM_VF_RELEASED
, &vcc
->flags
);
140 vcc_release_async(vcc
, msg
->reply
);
143 modify_qos(vcc
, msg
);
147 sk
->sk_err_soft
= msg
->reply
;
148 /* < 0 failure, otherwise ep_ref */
149 clear_bit(ATM_VF_WAITING
, &vcc
->flags
);
152 pr_alert("bad message type %d\n", (int)msg
->type
);
155 sk
->sk_state_change(sk
);
161 void sigd_enq2(struct atm_vcc
*vcc
, enum atmsvc_msg_type type
,
162 struct atm_vcc
*listen_vcc
, const struct sockaddr_atmpvc
*pvc
,
163 const struct sockaddr_atmsvc
*svc
, const struct atm_qos
*qos
,
167 struct atmsvc_msg
*msg
;
168 static unsigned session
= 0;
170 pr_debug("%d (0x%p)\n", (int)type
, vcc
);
171 while (!(skb
= alloc_skb(sizeof(struct atmsvc_msg
), GFP_KERNEL
)))
173 msg
= (struct atmsvc_msg
*)skb_put(skb
, sizeof(struct atmsvc_msg
));
174 memset(msg
, 0, sizeof(*msg
));
176 *(struct atm_vcc
**) &msg
->vcc
= vcc
;
177 *(struct atm_vcc
**) &msg
->listen_vcc
= listen_vcc
;
186 msg
->local
= vcc
->local
;
190 if (type
== as_connect
&& test_bit(ATM_VF_SESSION
, &vcc
->flags
))
191 msg
->session
= ++session
;
192 /* every new pmp connect gets the next session number */
196 set_bit(ATM_VF_REGIS
, &vcc
->flags
);
199 void sigd_enq(struct atm_vcc
*vcc
, enum atmsvc_msg_type type
,
200 struct atm_vcc
*listen_vcc
, const struct sockaddr_atmpvc
*pvc
,
201 const struct sockaddr_atmsvc
*svc
)
203 sigd_enq2(vcc
, type
, listen_vcc
, pvc
, svc
, vcc
? &vcc
->qos
: NULL
, 0);
204 /* other ISP applications may use "reply" */
207 static void purge_vcc(struct atm_vcc
*vcc
)
209 if (sk_atm(vcc
)->sk_family
== PF_ATMSVC
&&
210 !test_bit(ATM_VF_META
, &vcc
->flags
)) {
211 set_bit(ATM_VF_RELEASED
, &vcc
->flags
);
212 clear_bit(ATM_VF_REGIS
, &vcc
->flags
);
213 vcc_release_async(vcc
, -EUNATCH
);
217 static void sigd_close(struct atm_vcc
*vcc
)
219 struct hlist_node
*node
;
225 if (skb_peek(&sk_atm(vcc
)->sk_receive_queue
))
226 pr_err("closing with requests pending\n");
227 skb_queue_purge(&sk_atm(vcc
)->sk_receive_queue
);
229 read_lock(&vcc_sklist_lock
);
230 for (i
= 0; i
< VCC_HTABLE_SIZE
; ++i
) {
231 struct hlist_head
*head
= &vcc_hash
[i
];
233 sk_for_each(s
, node
, head
) {
239 read_unlock(&vcc_sklist_lock
);
242 static struct atmdev_ops sigd_dev_ops
= {
247 static struct atm_dev sigd_dev
= {
248 .ops
= &sigd_dev_ops
,
251 .lock
= __SPIN_LOCK_UNLOCKED(sigd_dev
.lock
)
254 int sigd_attach(struct atm_vcc
*vcc
)
260 vcc
->dev
= &sigd_dev
;
261 vcc_insert_socket(sk_atm(vcc
));
262 set_bit(ATM_VF_META
, &vcc
->flags
);
263 set_bit(ATM_VF_READY
, &vcc
->flags
);
264 #ifdef WAIT_FOR_DEMON
265 wake_up(&sigd_sleep
);