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