1b2441318SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
21da177e4SLinus Torvalds /* net/atm/signaling.c - ATM signaling */
31da177e4SLinus Torvalds
41da177e4SLinus Torvalds /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
51da177e4SLinus Torvalds
699824461SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
71da177e4SLinus Torvalds
81da177e4SLinus Torvalds #include <linux/errno.h> /* error codes */
91da177e4SLinus Torvalds #include <linux/kernel.h> /* printk */
101da177e4SLinus Torvalds #include <linux/skbuff.h>
111da177e4SLinus Torvalds #include <linux/wait.h>
121da177e4SLinus Torvalds #include <linux/sched.h> /* jiffies and HZ */
131da177e4SLinus Torvalds #include <linux/atm.h> /* ATM stuff */
141da177e4SLinus Torvalds #include <linux/atmsap.h>
151da177e4SLinus Torvalds #include <linux/atmsvc.h>
161da177e4SLinus Torvalds #include <linux/atmdev.h>
171da177e4SLinus Torvalds #include <linux/bitops.h>
185a0e3ad6STejun Heo #include <linux/slab.h>
191da177e4SLinus Torvalds
201da177e4SLinus Torvalds #include "resources.h"
211da177e4SLinus Torvalds #include "signaling.h"
221da177e4SLinus Torvalds
231da177e4SLinus Torvalds struct atm_vcc *sigd = NULL;
241da177e4SLinus Torvalds
sigd_put_skb(struct sk_buff * skb)251da177e4SLinus Torvalds static void sigd_put_skb(struct sk_buff *skb)
261da177e4SLinus Torvalds {
271da177e4SLinus Torvalds if (!sigd) {
2899824461SJoe Perches pr_debug("atmsvc: no signaling daemon\n");
291da177e4SLinus Torvalds kfree_skb(skb);
301da177e4SLinus Torvalds return;
311da177e4SLinus Torvalds }
321da177e4SLinus Torvalds atm_force_charge(sigd, skb->truesize);
331da177e4SLinus Torvalds skb_queue_tail(&sk_atm(sigd)->sk_receive_queue, skb);
34676d2369SDavid S. Miller sk_atm(sigd)->sk_data_ready(sk_atm(sigd));
351da177e4SLinus Torvalds }
361da177e4SLinus Torvalds
modify_qos(struct atm_vcc * vcc,struct atmsvc_msg * msg)371da177e4SLinus Torvalds static void modify_qos(struct atm_vcc *vcc, struct atmsvc_msg *msg)
381da177e4SLinus Torvalds {
391da177e4SLinus Torvalds struct sk_buff *skb;
401da177e4SLinus Torvalds
411da177e4SLinus Torvalds if (test_bit(ATM_VF_RELEASED, &vcc->flags) ||
421da177e4SLinus Torvalds !test_bit(ATM_VF_READY, &vcc->flags))
431da177e4SLinus Torvalds return;
441da177e4SLinus Torvalds msg->type = as_error;
450ec96e65SJoe Perches if (!vcc->dev->ops->change_qos)
460ec96e65SJoe Perches msg->reply = -EOPNOTSUPP;
471da177e4SLinus Torvalds else {
481da177e4SLinus Torvalds /* should lock VCC */
491da177e4SLinus Torvalds msg->reply = vcc->dev->ops->change_qos(vcc, &msg->qos,
501da177e4SLinus Torvalds msg->reply);
510ec96e65SJoe Perches if (!msg->reply)
520ec96e65SJoe Perches msg->type = as_okay;
531da177e4SLinus Torvalds }
541da177e4SLinus Torvalds /*
55563f63e3SRandy Dunlap * Should probably just turn around the old skb. But then, the buffer
561da177e4SLinus Torvalds * space accounting needs to follow the change too. Maybe later.
571da177e4SLinus Torvalds */
581da177e4SLinus Torvalds while (!(skb = alloc_skb(sizeof(struct atmsvc_msg), GFP_KERNEL)))
591da177e4SLinus Torvalds schedule();
601da177e4SLinus Torvalds *(struct atmsvc_msg *)skb_put(skb, sizeof(struct atmsvc_msg)) = *msg;
611da177e4SLinus Torvalds sigd_put_skb(skb);
621da177e4SLinus Torvalds }
631da177e4SLinus Torvalds
sigd_send(struct atm_vcc * vcc,struct sk_buff * skb)641da177e4SLinus Torvalds static int sigd_send(struct atm_vcc *vcc, struct sk_buff *skb)
651da177e4SLinus Torvalds {
661da177e4SLinus Torvalds struct atmsvc_msg *msg;
671da177e4SLinus Torvalds struct atm_vcc *session_vcc;
681da177e4SLinus Torvalds struct sock *sk;
691da177e4SLinus Torvalds
701da177e4SLinus Torvalds msg = (struct atmsvc_msg *) skb->data;
7114afee4bSReshetova, Elena WARN_ON(refcount_sub_and_test(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc));
721da177e4SLinus Torvalds vcc = *(struct atm_vcc **) &msg->vcc;
7399824461SJoe Perches pr_debug("%d (0x%lx)\n", (int)msg->type, (unsigned long)vcc);
741da177e4SLinus Torvalds sk = sk_atm(vcc);
751da177e4SLinus Torvalds
761da177e4SLinus Torvalds switch (msg->type) {
771da177e4SLinus Torvalds case as_okay:
781da177e4SLinus Torvalds sk->sk_err = -msg->reply;
791da177e4SLinus Torvalds clear_bit(ATM_VF_WAITING, &vcc->flags);
800ec96e65SJoe Perches if (!*vcc->local.sas_addr.prv && !*vcc->local.sas_addr.pub) {
811da177e4SLinus Torvalds vcc->local.sas_family = AF_ATMSVC;
821da177e4SLinus Torvalds memcpy(vcc->local.sas_addr.prv,
831da177e4SLinus Torvalds msg->local.sas_addr.prv, ATM_ESA_LEN);
841da177e4SLinus Torvalds memcpy(vcc->local.sas_addr.pub,
851da177e4SLinus Torvalds msg->local.sas_addr.pub, ATM_E164_LEN + 1);
861da177e4SLinus Torvalds }
871da177e4SLinus Torvalds session_vcc = vcc->session ? vcc->session : vcc;
880ec96e65SJoe Perches if (session_vcc->vpi || session_vcc->vci)
890ec96e65SJoe Perches break;
901da177e4SLinus Torvalds session_vcc->itf = msg->pvc.sap_addr.itf;
911da177e4SLinus Torvalds session_vcc->vpi = msg->pvc.sap_addr.vpi;
921da177e4SLinus Torvalds session_vcc->vci = msg->pvc.sap_addr.vci;
931da177e4SLinus Torvalds if (session_vcc->vpi || session_vcc->vci)
941da177e4SLinus Torvalds session_vcc->qos = msg->qos;
951da177e4SLinus Torvalds break;
961da177e4SLinus Torvalds case as_error:
971da177e4SLinus Torvalds clear_bit(ATM_VF_REGIS, &vcc->flags);
981da177e4SLinus Torvalds clear_bit(ATM_VF_READY, &vcc->flags);
991da177e4SLinus Torvalds sk->sk_err = -msg->reply;
1001da177e4SLinus Torvalds clear_bit(ATM_VF_WAITING, &vcc->flags);
1011da177e4SLinus Torvalds break;
1021da177e4SLinus Torvalds case as_indicate:
1031da177e4SLinus Torvalds vcc = *(struct atm_vcc **)&msg->listen_vcc;
104208a6dfbSChas Williams sk = sk_atm(vcc);
10552240062SStephen Hemminger pr_debug("as_indicate!!!\n");
1061da177e4SLinus Torvalds lock_sock(sk);
1071da177e4SLinus Torvalds if (sk_acceptq_is_full(sk)) {
1081da177e4SLinus Torvalds sigd_enq(NULL, as_reject, vcc, NULL, NULL);
1091da177e4SLinus Torvalds dev_kfree_skb(skb);
1101da177e4SLinus Torvalds goto as_indicate_complete;
1111da177e4SLinus Torvalds }
1127976a11bSEric Dumazet sk_acceptq_added(sk);
1131da177e4SLinus Torvalds skb_queue_tail(&sk->sk_receive_queue, skb);
114aa395145SEric Dumazet pr_debug("waking sk_sleep(sk) 0x%p\n", sk_sleep(sk));
1151da177e4SLinus Torvalds sk->sk_state_change(sk);
1161da177e4SLinus Torvalds as_indicate_complete:
1171da177e4SLinus Torvalds release_sock(sk);
1181da177e4SLinus Torvalds return 0;
1191da177e4SLinus Torvalds case as_close:
1201da177e4SLinus Torvalds set_bit(ATM_VF_RELEASED, &vcc->flags);
1211da177e4SLinus Torvalds vcc_release_async(vcc, msg->reply);
1221da177e4SLinus Torvalds goto out;
1231da177e4SLinus Torvalds case as_modify:
1241da177e4SLinus Torvalds modify_qos(vcc, msg);
1251da177e4SLinus Torvalds break;
1261da177e4SLinus Torvalds case as_addparty:
1271da177e4SLinus Torvalds case as_dropparty:
128*2f2d9972SEric Dumazet WRITE_ONCE(sk->sk_err_soft, -msg->reply);
1290ec96e65SJoe Perches /* < 0 failure, otherwise ep_ref */
1301da177e4SLinus Torvalds clear_bit(ATM_VF_WAITING, &vcc->flags);
1311da177e4SLinus Torvalds break;
1321da177e4SLinus Torvalds default:
13399824461SJoe Perches pr_alert("bad message type %d\n", (int)msg->type);
1341da177e4SLinus Torvalds return -EINVAL;
1351da177e4SLinus Torvalds }
1361da177e4SLinus Torvalds sk->sk_state_change(sk);
1371da177e4SLinus Torvalds out:
1381da177e4SLinus Torvalds dev_kfree_skb(skb);
1391da177e4SLinus Torvalds return 0;
1401da177e4SLinus Torvalds }
1411da177e4SLinus Torvalds
sigd_enq2(struct atm_vcc * vcc,enum atmsvc_msg_type type,struct atm_vcc * listen_vcc,const struct sockaddr_atmpvc * pvc,const struct sockaddr_atmsvc * svc,const struct atm_qos * qos,int reply)1421da177e4SLinus Torvalds void sigd_enq2(struct atm_vcc *vcc, enum atmsvc_msg_type type,
1431da177e4SLinus Torvalds struct atm_vcc *listen_vcc, const struct sockaddr_atmpvc *pvc,
1440ec96e65SJoe Perches const struct sockaddr_atmsvc *svc, const struct atm_qos *qos,
1450ec96e65SJoe Perches int reply)
1461da177e4SLinus Torvalds {
1471da177e4SLinus Torvalds struct sk_buff *skb;
1481da177e4SLinus Torvalds struct atmsvc_msg *msg;
14995c96174SEric Dumazet static unsigned int session = 0;
1501da177e4SLinus Torvalds
15199824461SJoe Perches pr_debug("%d (0x%p)\n", (int)type, vcc);
1521da177e4SLinus Torvalds while (!(skb = alloc_skb(sizeof(struct atmsvc_msg), GFP_KERNEL)))
1531da177e4SLinus Torvalds schedule();
154b080db58SJohannes Berg msg = skb_put_zero(skb, sizeof(struct atmsvc_msg));
1551da177e4SLinus Torvalds msg->type = type;
1561da177e4SLinus Torvalds *(struct atm_vcc **) &msg->vcc = vcc;
1571da177e4SLinus Torvalds *(struct atm_vcc **) &msg->listen_vcc = listen_vcc;
1581da177e4SLinus Torvalds msg->reply = reply;
1590ec96e65SJoe Perches if (qos)
1600ec96e65SJoe Perches msg->qos = *qos;
1610ec96e65SJoe Perches if (vcc)
1620ec96e65SJoe Perches msg->sap = vcc->sap;
1630ec96e65SJoe Perches if (svc)
1640ec96e65SJoe Perches msg->svc = *svc;
1650ec96e65SJoe Perches if (vcc)
1660ec96e65SJoe Perches msg->local = vcc->local;
1670ec96e65SJoe Perches if (pvc)
1680ec96e65SJoe Perches msg->pvc = *pvc;
1691da177e4SLinus Torvalds if (vcc) {
1701da177e4SLinus Torvalds if (type == as_connect && test_bit(ATM_VF_SESSION, &vcc->flags))
1711da177e4SLinus Torvalds msg->session = ++session;
1721da177e4SLinus Torvalds /* every new pmp connect gets the next session number */
1731da177e4SLinus Torvalds }
1741da177e4SLinus Torvalds sigd_put_skb(skb);
1750ec96e65SJoe Perches if (vcc)
1760ec96e65SJoe Perches set_bit(ATM_VF_REGIS, &vcc->flags);
1771da177e4SLinus Torvalds }
1781da177e4SLinus Torvalds
sigd_enq(struct atm_vcc * vcc,enum atmsvc_msg_type type,struct atm_vcc * listen_vcc,const struct sockaddr_atmpvc * pvc,const struct sockaddr_atmsvc * svc)1791da177e4SLinus Torvalds void sigd_enq(struct atm_vcc *vcc, enum atmsvc_msg_type type,
1801da177e4SLinus Torvalds struct atm_vcc *listen_vcc, const struct sockaddr_atmpvc *pvc,
1811da177e4SLinus Torvalds const struct sockaddr_atmsvc *svc)
1821da177e4SLinus Torvalds {
1831da177e4SLinus Torvalds sigd_enq2(vcc, type, listen_vcc, pvc, svc, vcc ? &vcc->qos : NULL, 0);
1841da177e4SLinus Torvalds /* other ISP applications may use "reply" */
1851da177e4SLinus Torvalds }
1861da177e4SLinus Torvalds
purge_vcc(struct atm_vcc * vcc)1871da177e4SLinus Torvalds static void purge_vcc(struct atm_vcc *vcc)
1881da177e4SLinus Torvalds {
1891da177e4SLinus Torvalds if (sk_atm(vcc)->sk_family == PF_ATMSVC &&
1901da177e4SLinus Torvalds !test_bit(ATM_VF_META, &vcc->flags)) {
1911da177e4SLinus Torvalds set_bit(ATM_VF_RELEASED, &vcc->flags);
1929301e320SChas Williams clear_bit(ATM_VF_REGIS, &vcc->flags);
1931da177e4SLinus Torvalds vcc_release_async(vcc, -EUNATCH);
1941da177e4SLinus Torvalds }
1951da177e4SLinus Torvalds }
1961da177e4SLinus Torvalds
sigd_close(struct atm_vcc * vcc)1971da177e4SLinus Torvalds static void sigd_close(struct atm_vcc *vcc)
1981da177e4SLinus Torvalds {
1991da177e4SLinus Torvalds struct sock *s;
2001da177e4SLinus Torvalds int i;
2011da177e4SLinus Torvalds
20299824461SJoe Perches pr_debug("\n");
2031da177e4SLinus Torvalds sigd = NULL;
2041da177e4SLinus Torvalds if (skb_peek(&sk_atm(vcc)->sk_receive_queue))
20599824461SJoe Perches pr_err("closing with requests pending\n");
2061da177e4SLinus Torvalds skb_queue_purge(&sk_atm(vcc)->sk_receive_queue);
2071da177e4SLinus Torvalds
2081da177e4SLinus Torvalds read_lock(&vcc_sklist_lock);
2091da177e4SLinus Torvalds for (i = 0; i < VCC_HTABLE_SIZE; ++i) {
2101da177e4SLinus Torvalds struct hlist_head *head = &vcc_hash[i];
2111da177e4SLinus Torvalds
212b67bfe0dSSasha Levin sk_for_each(s, head) {
213cfcabdccSStephen Hemminger vcc = atm_sk(s);
2141da177e4SLinus Torvalds
2151da177e4SLinus Torvalds purge_vcc(vcc);
2161da177e4SLinus Torvalds }
2171da177e4SLinus Torvalds }
2181da177e4SLinus Torvalds read_unlock(&vcc_sklist_lock);
2191da177e4SLinus Torvalds }
2201da177e4SLinus Torvalds
221800bb47eSBhumika Goyal static const struct atmdev_ops sigd_dev_ops = {
2221da177e4SLinus Torvalds .close = sigd_close,
2231da177e4SLinus Torvalds .send = sigd_send
2241da177e4SLinus Torvalds };
2251da177e4SLinus Torvalds
2261da177e4SLinus Torvalds static struct atm_dev sigd_dev = {
2271da177e4SLinus Torvalds .ops = &sigd_dev_ops,
2281da177e4SLinus Torvalds .type = "sig",
2291da177e4SLinus Torvalds .number = 999,
2304ef8d0aeSMilind Arun Choudhary .lock = __SPIN_LOCK_UNLOCKED(sigd_dev.lock)
2311da177e4SLinus Torvalds };
2321da177e4SLinus Torvalds
sigd_attach(struct atm_vcc * vcc)2331da177e4SLinus Torvalds int sigd_attach(struct atm_vcc *vcc)
2341da177e4SLinus Torvalds {
2350ec96e65SJoe Perches if (sigd)
2360ec96e65SJoe Perches return -EADDRINUSE;
23799824461SJoe Perches pr_debug("\n");
2381da177e4SLinus Torvalds sigd = vcc;
2391da177e4SLinus Torvalds vcc->dev = &sigd_dev;
2401da177e4SLinus Torvalds vcc_insert_socket(sk_atm(vcc));
2411da177e4SLinus Torvalds set_bit(ATM_VF_META, &vcc->flags);
2421da177e4SLinus Torvalds set_bit(ATM_VF_READY, &vcc->flags);
2431da177e4SLinus Torvalds return 0;
2441da177e4SLinus Torvalds }
245