adummy.c revision 5a0e3ad6af8660be21ca98a971cd00f331318c05
1fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams/*
2fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams * adummy.c: a dummy ATM driver
3fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams */
4fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
5fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/module.h>
6fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/kernel.h>
7fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/skbuff.h>
8fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/errno.h>
9fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/types.h>
10fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/string.h>
11fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/delay.h>
12fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/init.h>
13fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/mm.h>
14fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/timer.h>
15fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/interrupt.h>
165a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h>
17fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <asm/io.h>
18fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <asm/byteorder.h>
19fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <asm/uaccess.h>
20fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
21fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/atmdev.h>
22fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/atm.h>
23fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#include <linux/sonet.h>
24fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
25fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams/* version definition */
26fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
27fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#define DRV_VERSION "1.0"
28fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
29fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#define DEV_LABEL "adummy"
30fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
31fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams#define ADUMMY_DEV(dev) ((struct adummy_dev *) (dev)->dev_data)
32fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
33fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsstruct adummy_dev {
34fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	struct atm_dev *atm_dev;
35fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
36fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	struct list_head entry;
37fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams};
38fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
39fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams/* globals */
40fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
41fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsstatic LIST_HEAD(adummy_devs);
42fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
43fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsstatic int __init
44fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsadummy_start(struct atm_dev *dev)
45fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams{
46fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	dev->ci_range.vpi_bits = 4;
47fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	dev->ci_range.vci_bits = 12;
48fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
49fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	return 0;
50fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams}
51fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
52fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsstatic int
53fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsadummy_open(struct atm_vcc *vcc)
54fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams{
55fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	short vpi = vcc->vpi;
56fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	int vci = vcc->vci;
57fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
58fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	if (vci == ATM_VCI_UNSPEC || vpi == ATM_VPI_UNSPEC)
59fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		return 0;
60fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
61fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	set_bit(ATM_VF_ADDR, &vcc->flags);
62fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	set_bit(ATM_VF_READY, &vcc->flags);
63fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
64fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	return 0;
65fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams}
66fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
67fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsstatic void
68fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsadummy_close(struct atm_vcc *vcc)
69fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams{
70fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	clear_bit(ATM_VF_READY, &vcc->flags);
71fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	clear_bit(ATM_VF_ADDR, &vcc->flags);
72fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams}
73fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
74fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsstatic int
75fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsadummy_send(struct atm_vcc *vcc, struct sk_buff *skb)
76fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams{
77fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	if (vcc->pop)
78fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		vcc->pop(vcc, skb);
79fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	else
80fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		dev_kfree_skb_any(skb);
81fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	atomic_inc(&vcc->stats->tx);
82fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
83fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	return 0;
84fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams}
85fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
86fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsstatic int
87fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsadummy_proc_read(struct atm_dev *dev, loff_t *pos, char *page)
88fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams{
89fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	int left = *pos;
90fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
91fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	if (!left--)
92fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		return sprintf(page, "version %s\n", DRV_VERSION);
93fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
94fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	return 0;
95fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams}
96fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
97fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsstatic struct atmdev_ops adummy_ops =
98fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams{
99fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	.open =		adummy_open,
100fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	.close =	adummy_close,
101fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	.send =		adummy_send,
102fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	.proc_read =	adummy_proc_read,
103fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	.owner =	THIS_MODULE
104fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams};
105fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
106fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsstatic int __init adummy_init(void)
107fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams{
108fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	struct atm_dev *atm_dev;
109fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	struct adummy_dev *adummy_dev;
110fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	int err = 0;
111fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
112fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	printk(KERN_ERR "adummy: version %s\n", DRV_VERSION);
113fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
1140c1cca1d8e0d58775dad43374f925e6cddf1bebcOm Narasimhan	adummy_dev = kzalloc(sizeof(struct adummy_dev),
115fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams						   GFP_KERNEL);
116fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	if (!adummy_dev) {
1170c1cca1d8e0d58775dad43374f925e6cddf1bebcOm Narasimhan		printk(KERN_ERR DEV_LABEL ": kzalloc() failed\n");
118fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		err = -ENOMEM;
119fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		goto out;
120fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	}
1217877327d9c360ac91f22e4c7f98bcb10c0180969Al Viro	atm_dev = atm_dev_register(DEV_LABEL, &adummy_ops, -1, NULL);
122fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	if (!atm_dev) {
123fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		printk(KERN_ERR DEV_LABEL ": atm_dev_register() failed\n");
124fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		err = -ENODEV;
125fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		goto out_kfree;
126fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	}
127fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
128fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	adummy_dev->atm_dev = atm_dev;
129fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	atm_dev->dev_data = adummy_dev;
130fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
131fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	if (adummy_start(atm_dev)) {
132fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		printk(KERN_ERR DEV_LABEL ": adummy_start() failed\n");
133fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		err = -ENODEV;
134fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		goto out_unregister;
135fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	}
136fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
137fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	list_add(&adummy_dev->entry, &adummy_devs);
138fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsout:
139fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	return err;
140fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
141fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsout_unregister:
142fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	atm_dev_deregister(atm_dev);
143fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsout_kfree:
144fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	kfree(adummy_dev);
145fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	goto out;
146fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams}
147fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
148fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsstatic void __exit adummy_cleanup(void)
149fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams{
150fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	struct adummy_dev *adummy_dev, *next;
151fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
152fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	list_for_each_entry_safe(adummy_dev, next, &adummy_devs, entry) {
153fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		atm_dev_deregister(adummy_dev->atm_dev);
154fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams		kfree(adummy_dev);
155fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams	}
156fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams}
157fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
158fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsmodule_init(adummy_init);
159fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williamsmodule_exit(adummy_cleanup);
160fb29644994744a63bc57186cefa79534b5d9b5a9Chas Williams
161fb29644994744a63bc57186cefa79534b5d9b5a9Chas WilliamsMODULE_AUTHOR("chas williams <chas@cmf.nrl.navy.mil>");
162fb29644994744a63bc57186cefa79534b5d9b5a9Chas WilliamsMODULE_DESCRIPTION("dummy ATM driver");
163fb29644994744a63bc57186cefa79534b5d9b5a9Chas WilliamsMODULE_LICENSE("GPL");
164