patch-2.3.15 linux/drivers/atm/atmtcp.c

• Lines: 340
• Date: Mon Aug 23 09:56:31 1999
• Orig file: v2.3.14/linux/drivers/atm/atmtcp.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.3.14/linux/drivers/atm/atmtcp.c linux/drivers/atm/atmtcp.c
@@ -0,0 +1,339 @@
+/* drivers/atm/atmtcp.c - ATM over TCP "device" driver */
+
+/* Written 1997,1998 by Werner Almesberger, EPFL LRC/ICA */
+
+
+#include <linux/module.h>
+#include <linux/atmdev.h>
+#include <linux/atm_tcp.h>
+#include <asm/uaccess.h>
+#include "../../net/atm/tunable.h" /* @@@ fix this */
+#include "../../net/atm/protocols.h" /* @@@ fix this */
+
+
+#define PRIV(dev) ((struct atmtcp_dev_data *) ((dev)->dev_data))
+
+
+struct atmtcp_dev_data {
+	struct atm_vcc *vcc;	/* control VCC; NULL if detached */
+	int persist;		/* non-zero if persistent */
+};
+
+
+#define DEV_LABEL    "atmtcp"
+
+#define MAX_VPI_BITS  8	/* simplifies life */
+#define MAX_VCI_BITS 16
+
+
+static void atmtcp_v_dev_close(struct atm_dev *dev)
+{
+	MOD_DEC_USE_COUNT;
+}
+
+
+static int atmtcp_v_open(struct atm_vcc *vcc,short vpi,int vci)
+{
+	int error;
+
+	error = atm_find_ci(vcc,&vpi,&vci);
+	if (error) return error;
+	vcc->vpi = vpi;
+	vcc->vci = vci;
+	if (vpi == ATM_VPI_UNSPEC || vci == ATM_VCI_UNSPEC) return 0;
+	vcc->flags |= ATM_VF_ADDR | ATM_VF_READY;
+	return 0;
+}
+
+
+static void atmtcp_v_close(struct atm_vcc *vcc)
+{
+	vcc->flags &= ~(ATM_VF_READY | ATM_VF_ADDR);
+}
+
+
+static int atmtcp_v_ioctl(struct atm_dev *dev,unsigned int cmd,void *arg)
+{
+	struct atm_cirange ci;
+	struct atm_vcc *vcc;
+
+	if (cmd != ATM_SETCIRANGE) return -EINVAL;
+	if (copy_from_user(&ci,(void *) arg,sizeof(ci))) return -EFAULT;
+	if (ci.vpi_bits == ATM_CI_MAX) ci.vpi_bits = MAX_VPI_BITS;
+	if (ci.vci_bits == ATM_CI_MAX) ci.vci_bits = MAX_VCI_BITS;
+	if (ci.vpi_bits > MAX_VPI_BITS || ci.vpi_bits < 0 ||
+	    ci.vci_bits > MAX_VCI_BITS || ci.vci_bits < 0) return -EINVAL;
+	for (vcc = dev->vccs; vcc; vcc = vcc->next)
+		if ((vcc->vpi >> ci.vpi_bits) ||
+		    (vcc->vci >> ci.vci_bits)) return -EBUSY;
+	dev->ci_range = ci;
+	return 0;
+}
+
+
+static int atmtcp_v_send(struct atm_vcc *vcc,struct sk_buff *skb)
+{
+	struct atmtcp_dev_data *dev_data;
+	struct atm_vcc *out_vcc;
+	struct sk_buff *new_skb;
+	struct atmtcp_hdr *hdr;
+	int size;
+
+	dev_data = PRIV(vcc->dev);
+	if (dev_data) out_vcc = dev_data->vcc;
+	if (!dev_data || !out_vcc) {
+		if (vcc->pop) vcc->pop(vcc,skb);
+		else dev_kfree_skb(skb);
+		if (dev_data) return 0;
+		vcc->stats->tx_err++;
+		return -ENOLINK;
+	}
+	size = skb->len+sizeof(struct atmtcp_hdr);
+	if (!atm_charge(out_vcc,atm_pdu2truesize(size))) new_skb = NULL;
+	else {
+		new_skb = alloc_skb(size,GFP_ATOMIC);
+		if (!new_skb)
+			atm_return(out_vcc,atm_pdu2truesize(size));
+	}
+	if (!new_skb) {
+		if (vcc->pop) vcc->pop(vcc,skb);
+		else dev_kfree_skb(skb);
+		vcc->stats->tx_err++;
+		return -ENOBUFS;
+	}
+	hdr = (void *) skb_put(new_skb,sizeof(struct atmtcp_hdr));
+	hdr->vpi = htons(vcc->vpi);
+	hdr->vci = htons(vcc->vci);
+	hdr->length = htonl(skb->len);
+	memcpy(skb_put(new_skb,skb->len),skb->data,skb->len);
+	if (vcc->pop) vcc->pop(vcc,skb);
+	else dev_kfree_skb(skb);
+	out_vcc->push(out_vcc,new_skb);
+	return 0;
+}
+
+
+static int atmtcp_v_proc(struct atm_dev *dev,loff_t *pos,char *page)
+{
+	struct atmtcp_dev_data *dev_data = PRIV(dev);
+
+	if (*pos) return 0;
+	if (!dev_data->persist) return sprintf(page,"ephemeral\n");
+	return sprintf(page,"persistent, %sconnected\n",
+	    dev_data->vcc ? "" : "dis");
+}
+
+
+static void atmtcp_c_close(struct atm_vcc *vcc)
+{
+	struct atm_dev *atmtcp_dev;
+	struct atmtcp_dev_data *dev_data;
+
+	atmtcp_dev = (struct atm_dev *) vcc->dev_data;
+	dev_data = PRIV(atmtcp_dev);
+	dev_data->vcc = NULL;
+	if (dev_data->persist) return;
+	kfree(dev_data);
+	shutdown_atm_dev(atmtcp_dev);
+	vcc->dev_data = NULL;
+}
+
+
+static int atmtcp_c_send(struct atm_vcc *vcc,struct sk_buff *skb)
+{
+	struct atm_dev *dev;
+	struct atmtcp_hdr *hdr;
+	struct atm_vcc *out_vcc;
+	struct sk_buff *new_skb;
+
+	if (!skb->len) return 0;
+	dev = vcc->dev_data;
+	hdr = (void *) skb->data;
+	for (out_vcc = dev->vccs; out_vcc; out_vcc = out_vcc->next)
+		if (out_vcc->vpi == ntohs(hdr->vpi) &&
+		    out_vcc->vci == ntohs(hdr->vci) &&
+		    out_vcc->qos.rxtp.traffic_class != ATM_NONE)
+			break;
+	if (!out_vcc) {
+		if (vcc->pop) vcc->pop(vcc,skb);
+		else dev_kfree_skb(skb);
+		vcc->stats->tx_err++;
+		return 0;
+	}
+	skb_pull(skb,sizeof(struct atmtcp_hdr));
+	if (!atm_charge(out_vcc,atm_pdu2truesize(skb->len))) new_skb = NULL;
+	else {
+		new_skb = alloc_skb(skb->len,GFP_KERNEL);
+		if (!new_skb) atm_return(out_vcc,atm_pdu2truesize(skb->len));
+        }
+	if (!new_skb) {
+		if (vcc->pop) vcc->pop(vcc,skb);
+		else dev_kfree_skb(skb);
+	 	return -ENOBUFS;
+	}
+	memcpy(skb_put(new_skb,skb->len),skb->data,skb->len);
+	if (vcc->pop) vcc->pop(vcc,skb);
+	else dev_kfree_skb(skb);
+	out_vcc->push(out_vcc,new_skb);
+	return 0;
+}
+
+
+/*
+ * Device operations for the virtual ATM devices created by ATMTCP.
+ */
+
+
+static struct atmdev_ops atmtcp_v_dev_ops = {
+	atmtcp_v_dev_close,
+	atmtcp_v_open,
+	atmtcp_v_close,
+	atmtcp_v_ioctl,
+	NULL,		/* no getsockopt */
+	NULL,		/* no setsockopt */
+	atmtcp_v_send,
+	NULL,		/* no direct writes */
+	NULL,		/* no send_oam */
+	NULL,		/* no phy_put */
+	NULL,		/* no phy_get */
+	NULL,		/* no feedback */
+	NULL,		/* no change_qos */
+	NULL,		/* no free_rx_skb */
+	atmtcp_v_proc	/* proc_read */
+};
+
+
+/*
+ * Device operations for the ATMTCP control device.
+ */
+
+
+static struct atmdev_ops atmtcp_c_dev_ops = {
+	NULL,		/* no dev_close */
+	NULL,		/* no open */
+	atmtcp_c_close,
+	NULL,		/* no ioctl */
+	NULL,		/* no getsockopt */
+	NULL,		/* no setsockopt */
+	atmtcp_c_send,
+	NULL,		/* no sg_send */
+	NULL,		/* no send_oam */
+	NULL,		/* no phy_put */
+	NULL,		/* no phy_get */
+	NULL,		/* no feedback */
+	NULL,		/* no change_qos */
+	NULL,		/* no free_rx_skb */
+	NULL		/* no proc_read */
+};
+
+
+static struct atm_dev atmtcp_control_dev = {
+	&atmtcp_c_dev_ops,
+	NULL,		/* no PHY */
+	"atmtcp",	/* type */
+	999,		/* dummy device number */
+	NULL,NULL,	/* pretend not to have any VCCs */
+	NULL,NULL,	/* no data */
+	0,		/* no flags */
+	NULL,		/* no local address */
+	{ 0 }		/* no ESI, no statistics */
+};
+
+
+static int atmtcp_create(int itf,int persist,struct atm_dev **result)
+{
+	struct atmtcp_dev_data *dev_data;
+	struct atm_dev *dev;
+
+	dev_data = kmalloc(sizeof(*dev_data),GFP_KERNEL);
+	if (!dev_data) return -ENOMEM;
+	dev = atm_dev_register(DEV_LABEL,&atmtcp_v_dev_ops,itf,0);
+	if (!dev) {
+		kfree(dev_data);
+		return itf == -1 ? -ENOMEM : -EBUSY;
+	}
+	MOD_INC_USE_COUNT;
+	dev->ci_range.vpi_bits = MAX_VPI_BITS;
+	dev->ci_range.vci_bits = MAX_VCI_BITS;
+	PRIV(dev) = dev_data;
+	PRIV(dev)->vcc = NULL;
+	PRIV(dev)->persist = persist;
+	if (result) *result = dev;
+	return 0;
+}
+
+
+int atmtcp_attach(struct atm_vcc *vcc,int itf)
+{
+	struct atm_dev *dev;
+
+	dev = NULL;
+	if (itf != -1) dev = atm_find_dev(itf);
+	if (dev) {
+		if (dev->ops != &atmtcp_v_dev_ops) return -EMEDIUMTYPE;
+		if (PRIV(dev)->vcc) return -EBUSY;
+	}
+	else {
+		int error;
+
+		error = atmtcp_create(itf,0,&dev);
+		if (error) return error;
+	}
+	PRIV(dev)->vcc = vcc;
+	bind_vcc(vcc,&atmtcp_control_dev);
+	vcc->flags |= ATM_VF_READY | ATM_VF_META;
+	vcc->dev_data = dev;
+	(void) atm_init_aal5(vcc); /* @@@ losing AAL in transit ... */
+	vcc->stats = &atmtcp_control_dev.stats.aal5;
+	return dev->number;
+}
+
+
+int atmtcp_create_persistent(int itf)
+{
+	return atmtcp_create(itf,1,NULL);
+}
+
+
+int atmtcp_remove_persistent(int itf)
+{
+	struct atm_dev *dev;
+	struct atmtcp_dev_data *dev_data;
+
+	dev = atm_find_dev(itf);
+	if (!dev) return -ENODEV;
+	if (dev->ops != &atmtcp_v_dev_ops) return -EMEDIUMTYPE;
+	dev_data = PRIV(dev);
+	if (!dev_data->persist) return 0;
+	dev_data->persist = 0;
+	if (PRIV(dev)->vcc) return 0;
+	kfree(dev_data);
+	shutdown_atm_dev(dev);
+	return 0;
+}
+
+
+#ifdef MODULE
+
+int init_module(void)
+{
+	atm_tcp_ops.attach = atmtcp_attach;
+	atm_tcp_ops.create_persistent = atmtcp_create_persistent;
+	atm_tcp_ops.remove_persistent = atmtcp_remove_persistent;
+	return 0;
+}
+
+void cleanup_module(void)
+{
+}
+
+#else
+
+struct atm_tcp_ops atm_tcp_ops = {
+	atmtcp_attach,			/* attach */
+	atmtcp_create_persistent,	/* create_persistent */
+	atmtcp_remove_persistent	/* remove_persistent */
+};
+
+#endif
+