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