linux-imx

// SPDX-License-Identifier: GPL-2.0

/* net/atm/signaling.c - ATM signaling */

​

/* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */

​

#define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__

​

#include <linux/errno.h>    /* error codes */

#include <linux/kernel.h>   /* printk */

#include <linux/skbuff.h>

#include <linux/wait.h>

#include <linux/sched.h>    /* jiffies and HZ */

#include <linux/atm.h>      /* ATM stuff */

#include <linux/atmsap.h>

#include <linux/atmsvc.h>

#include <linux/atmdev.h>

#include <linux/bitops.h>

#include <linux/slab.h>

​

#include "resources.h"

#include "signaling.h"

​

struct atm_vcc *sigd = NULL;

​

static void sigd_put_skb(struct sk_buff *skb)

{

    if (!sigd) {

        pr_debug("atmsvc: no signaling daemon\n");

        kfree_skb(skb);

        return;

    }

    atm_force_charge(sigd, skb->truesize);

    skb_queue_tail(&sk_atm(sigd)->sk_receive_queue, skb);

    sk_atm(sigd)->sk_data_ready(sk_atm(sigd));

}

​

static void modify_qos(struct atm_vcc *vcc, struct atmsvc_msg *msg)

{

    struct sk_buff *skb;

​

    if (test_bit(ATM_VF_RELEASED, &vcc->flags) ||

        !test_bit(ATM_VF_READY, &vcc->flags))

        return;

    msg->type = as_error;

    if (!vcc->dev->ops->change_qos)

        msg->reply = -EOPNOTSUPP;

    else {

        /* should lock VCC */

        msg->reply = vcc->dev->ops->change_qos(vcc, &msg->qos,

                               msg->reply);

        if (!msg->reply)

            msg->type = as_okay;

    }

    /*

     * Should probably just turn around the old skb. But the, the buffer

     * space accounting needs to follow the change too. Maybe later.

     */

    while (!(skb = alloc_skb(sizeof(struct atmsvc_msg), GFP_KERNEL)))

        schedule();

    *(struct atmsvc_msg *)skb_put(skb, sizeof(struct atmsvc_msg)) = *msg;

    sigd_put_skb(skb);

}

​

static int sigd_send(struct atm_vcc *vcc, struct sk_buff *skb)

{

    struct atmsvc_msg *msg;

    struct atm_vcc *session_vcc;

    struct sock *sk;

​

    msg = (struct atmsvc_msg *) skb->data;

    WARN_ON(refcount_sub_and_test(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc));

    vcc = *(struct atm_vcc **) &msg->vcc;

    pr_debug("%d (0x%lx)\n", (int)msg->type, (unsigned long)vcc);

    sk = sk_atm(vcc);

​

    switch (msg->type) {

    case as_okay:

        sk->sk_err = -msg->reply;

        clear_bit(ATM_VF_WAITING, &vcc->flags);

        if (!*vcc->local.sas_addr.prv && !*vcc->local.sas_addr.pub) {

            vcc->local.sas_family = AF_ATMSVC;

            memcpy(vcc->local.sas_addr.prv,

                   msg->local.sas_addr.prv, ATM_ESA_LEN);

            memcpy(vcc->local.sas_addr.pub,

                   msg->local.sas_addr.pub, ATM_E164_LEN + 1);

        }

        session_vcc = vcc->session ? vcc->session : vcc;

        if (session_vcc->vpi || session_vcc->vci)

            break;

        session_vcc->itf = msg->pvc.sap_addr.itf;

        session_vcc->vpi = msg->pvc.sap_addr.vpi;

        session_vcc->vci = msg->pvc.sap_addr.vci;