[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / atm / adummy.c

/*
 * adummy.c: a dummy ATM driver
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/skbuff.h>
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/string.h>
#include <linux/delay.h>
#include <linux/init.h>
#include <linux/mm.h>
#include <linux/timer.h>
#include <linux/interrupt.h>
#include <linux/slab.h>
#include <asm/io.h>
#include <asm/byteorder.h>
#include <asm/uaccess.h>

#include <linux/atmdev.h>
#include <linux/atm.h>
#include <linux/sonet.h>

/* version definition */

#define DRV_VERSION "1.0"

#define DEV_LABEL "adummy"

#define ADUMMY_DEV(dev) ((struct adummy_dev *) (dev)->dev_data)

struct adummy_dev {
	struct atm_dev *atm_dev;

	struct list_head entry;
};

/* globals */

static LIST_HEAD(adummy_devs);

static ssize_t __set_signal(struct device *dev,
		struct device_attribute *attr,
		const char *buf, size_t len)
{
	struct atm_dev *atm_dev = container_of(dev, struct atm_dev, class_dev);
	int signal;

	if (sscanf(buf, "%d", &signal) == 1) {

		if (signal < ATM_PHY_SIG_LOST || signal > ATM_PHY_SIG_FOUND)
			signal = ATM_PHY_SIG_UNKNOWN;

		atm_dev_signal_change(atm_dev, signal);
		return 1;
	}
	return -EINVAL;
}

static ssize_t __show_signal(struct device *dev,
	struct device_attribute *attr, char *buf)
{
	struct atm_dev *atm_dev = container_of(dev, struct atm_dev, class_dev);
	return sprintf(buf, "%d\n", atm_dev->signal);
}
static DEVICE_ATTR(signal, 0644, __show_signal, __set_signal);

static struct attribute *adummy_attrs[] = {
	&dev_attr_signal.attr,
	NULL
};

static struct attribute_group adummy_group_attrs = {
	.name = NULL, /* We want them in dev's root folder */
	.attrs = adummy_attrs
};

static int __init
adummy_start(struct atm_dev *dev)
{
	dev->ci_range.vpi_bits = 4;
	dev->ci_range.vci_bits = 12;

	return 0;
}

static int
adummy_open(struct atm_vcc *vcc)
{
	short vpi = vcc->vpi;
	int vci = vcc->vci;

	if (vci == ATM_VCI_UNSPEC || vpi == ATM_VPI_UNSPEC)
		return 0;

	set_bit(ATM_VF_ADDR, &vcc->flags);
	set_bit(ATM_VF_READY, &vcc->flags);

	return 0;
}

static void
adummy_close(struct atm_vcc *vcc)
{
	clear_bit(ATM_VF_READY, &vcc->flags);
	clear_bit(ATM_VF_ADDR, &vcc->flags);
}

static int
adummy_send(struct atm_vcc *vcc, struct sk_buff *skb)
{
	if (vcc->pop)
		vcc->pop(vcc, skb);
	else
		dev_kfree_skb_any(skb);
	atomic_inc(&vcc->stats->tx);

	return 0;
}

static int
adummy_proc_read(struct atm_dev *dev, loff_t *pos, char *page)
{
	int left = *pos;

	if (!left--)
		return sprintf(page, "version %s\n", DRV_VERSION);

	return 0;
}

static struct atmdev_ops adummy_ops =
{
	.open =		adummy_open,
	.close =	adummy_close,	
	.send =		adummy_send,
	.proc_read =	adummy_proc_read,
	.owner =	THIS_MODULE
};

static int __init adummy_init(void)
{
	struct atm_dev *atm_dev;
	struct adummy_dev *adummy_dev;
	int err = 0;

	printk(KERN_ERR "adummy: version %s\n", DRV_VERSION);

	adummy_dev = kzalloc(sizeof(struct adummy_dev),
						   GFP_KERNEL);
	if (!adummy_dev) {
		printk(KERN_ERR DEV_LABEL ": kzalloc() failed\n");
		err = -ENOMEM;
		goto out;
	}
	atm_dev = atm_dev_register(DEV_LABEL, NULL, &adummy_ops, -1, NULL);
	if (!atm_dev) {
		printk(KERN_ERR DEV_LABEL ": atm_dev_register() failed\n");
		err = -ENODEV;
		goto out_kfree;
	}

	adummy_dev->atm_dev = atm_dev;
	atm_dev->dev_data = adummy_dev;

	if (sysfs_create_group(&atm_dev->class_dev.kobj, &adummy_group_attrs))
		dev_err(&atm_dev->class_dev, "Could not register attrs for adummy\n");

	if (adummy_start(atm_dev)) {
		printk(KERN_ERR DEV_LABEL ": adummy_start() failed\n");
		err = -ENODEV;
		goto out_unregister;
	}

	list_add(&adummy_dev->entry, &adummy_devs);
out:
	return err;

out_unregister:
	atm_dev_deregister(atm_dev);
out_kfree:
	kfree(adummy_dev);
	goto out;
}

static void __exit adummy_cleanup(void)
{
	struct adummy_dev *adummy_dev, *next;

	list_for_each_entry_safe(adummy_dev, next, &adummy_devs, entry) {
		atm_dev_deregister(adummy_dev->atm_dev);
		kfree(adummy_dev);
	}
}

module_init(adummy_init);
module_exit(adummy_cleanup);

MODULE_AUTHOR("chas williams <chas@cmf.nrl.navy.mil>");
MODULE_DESCRIPTION("dummy ATM driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
fb296449 CW	1	/*
	2	* adummy.c: a dummy ATM driver
	3	*/
	4
fb296449	5	#include <linux/module.h>
fb296449 CW	6	#include <linux/kernel.h>
fb296449 CW	7	#include <linux/skbuff.h>
fb296449 CW	8	#include <linux/errno.h>
	9	#include <linux/types.h>
	10	#include <linux/string.h>
	11	#include <linux/delay.h>
	12	#include <linux/init.h>
	13	#include <linux/mm.h>
fb296449 CW	14	#include <linux/timer.h>
fb296449 CW	15	#include <linux/interrupt.h>
5a0e3ad6	16	#include <linux/slab.h>
fb296449 CW	17	#include <asm/io.h>
	18	#include <asm/byteorder.h>
	19	#include <asm/uaccess.h>
	20
	21	#include <linux/atmdev.h>
	22	#include <linux/atm.h>
	23	#include <linux/sonet.h>
	24
	25	/* version definition */
	26
	27	#define DRV_VERSION "1.0"
	28
	29	#define DEV_LABEL "adummy"
	30
	31	#define ADUMMY_DEV(dev) ((struct adummy_dev *) (dev)->dev_data)
	32
	33	struct adummy_dev {
	34	struct atm_dev *atm_dev;
	35
	36	struct list_head entry;
	37	};
	38
	39	/* globals */
	40
	41	static LIST_HEAD(adummy_devs);
	42
c69fb76e KH	43	static ssize_t __set_signal(struct device *dev,
	44	struct device_attribute *attr,
	45	const char *buf, size_t len)
	46	{
	47	struct atm_dev *atm_dev = container_of(dev, struct atm_dev, class_dev);
	48	int signal;
	49
	50	if (sscanf(buf, "%d", &signal) == 1) {
	51
	52	if (signal < ATM_PHY_SIG_LOST \|\| signal > ATM_PHY_SIG_FOUND)
	53	signal = ATM_PHY_SIG_UNKNOWN;
	54
	55	atm_dev_signal_change(atm_dev, signal);
	56	return 1;
	57	}
	58	return -EINVAL;
	59	}
	60
	61	static ssize_t __show_signal(struct device *dev,
	62	struct device_attribute attr, char buf)
	63	{
	64	struct atm_dev *atm_dev = container_of(dev, struct atm_dev, class_dev);
	65	return sprintf(buf, "%d\n", atm_dev->signal);
	66	}
	67	static DEVICE_ATTR(signal, 0644, __show_signal, __set_signal);
	68
	69	static struct attribute *adummy_attrs[] = {
	70	&dev_attr_signal.attr,
	71	NULL
	72	};
	73
	74	static struct attribute_group adummy_group_attrs = {
	75	.name = NULL, /* We want them in dev's root folder */
	76	.attrs = adummy_attrs
	77	};
	78
fb296449 CW	79	static int __init
	80	adummy_start(struct atm_dev *dev)
	81	{
	82	dev->ci_range.vpi_bits = 4;
	83	dev->ci_range.vci_bits = 12;
	84
	85	return 0;
	86	}
	87
	88	static int
	89	adummy_open(struct atm_vcc *vcc)
	90	{
	91	short vpi = vcc->vpi;
	92	int vci = vcc->vci;
	93
	94	if (vci == ATM_VCI_UNSPEC \|\| vpi == ATM_VPI_UNSPEC)
	95	return 0;
	96
	97	set_bit(ATM_VF_ADDR, &vcc->flags);
	98	set_bit(ATM_VF_READY, &vcc->flags);
	99
	100	return 0;
	101	}
	102
	103	static void
	104	adummy_close(struct atm_vcc *vcc)
	105	{
	106	clear_bit(ATM_VF_READY, &vcc->flags);
	107	clear_bit(ATM_VF_ADDR, &vcc->flags);
	108	}
	109
	110	static int
	111	adummy_send(struct atm_vcc vcc, struct sk_buff skb)
	112	{
	113	if (vcc->pop)
	114	vcc->pop(vcc, skb);
	115	else
	116	dev_kfree_skb_any(skb);
	117	atomic_inc(&vcc->stats->tx);
	118
	119	return 0;
	120	}
	121
	122	static int
	123	adummy_proc_read(struct atm_dev dev, loff_t pos, char *page)
	124	{
	125	int left = *pos;
	126
	127	if (!left--)
	128	return sprintf(page, "version %s\n", DRV_VERSION);
	129
	130	return 0;
	131	}
	132
	133	static struct atmdev_ops adummy_ops =
	134	{
	135	.open = adummy_open,
	136	.close = adummy_close,
	137	.send = adummy_send,
	138	.proc_read = adummy_proc_read,
	139	.owner = THIS_MODULE
	140	};
	141
	142	static int __init adummy_init(void)
143	{
144	struct atm_dev *atm_dev;
145	struct adummy_dev *adummy_dev;
146	int err = 0;
147
148	printk(KERN_ERR "adummy: version %s\n", DRV_VERSION);
149
0c1cca1d	150	adummy_dev = kzalloc(sizeof(struct adummy_dev),
fb296449 CW	151	GFP_KERNEL);
fb296449 CW	152	if (!adummy_dev) {
0c1cca1d	153	printk(KERN_ERR DEV_LABEL ": kzalloc() failed\n");
fb296449 CW	154	err = -ENOMEM;
	155	goto out;
	156	}
d9ca676b	157	atm_dev = atm_dev_register(DEV_LABEL, NULL, &adummy_ops, -1, NULL);
fb296449 CW	158	if (!atm_dev) {
	159	printk(KERN_ERR DEV_LABEL ": atm_dev_register() failed\n");
	160	err = -ENODEV;
	161	goto out_kfree;
	162	}
	163
	164	adummy_dev->atm_dev = atm_dev;
	165	atm_dev->dev_data = adummy_dev;
	166
c69fb76e KH	167	if (sysfs_create_group(&atm_dev->class_dev.kobj, &adummy_group_attrs))
	168	dev_err(&atm_dev->class_dev, "Could not register attrs for adummy\n");
	169
fb296449 CW	170	if (adummy_start(atm_dev)) {
	171	printk(KERN_ERR DEV_LABEL ": adummy_start() failed\n");
	172	err = -ENODEV;
	173	goto out_unregister;
	174	}
	175
	176	list_add(&adummy_dev->entry, &adummy_devs);
	177	out:
	178	return err;
	179
	180	out_unregister:
	181	atm_dev_deregister(atm_dev);
	182	out_kfree:
	183	kfree(adummy_dev);
	184	goto out;
	185	}
	186
	187	static void __exit adummy_cleanup(void)
	188	{
	189	struct adummy_dev adummy_dev, next;
	190
	191	list_for_each_entry_safe(adummy_dev, next, &adummy_devs, entry) {
	192	atm_dev_deregister(adummy_dev->atm_dev);
	193	kfree(adummy_dev);
	194	}
	195	}
	196
	197	module_init(adummy_init);
	198	module_exit(adummy_cleanup);
	199
	200	MODULE_AUTHOR("chas williams <chas@cmf.nrl.navy.mil>");
	201	MODULE_DESCRIPTION("dummy ATM driver");
	202	MODULE_LICENSE("GPL");