| /* $Id: avm_cs.c,v 1.4.6.3 2001/09/23 22:24:33 kai Exp $ |
| * |
| * A PCMCIA client driver for AVM B1/M1/M2 |
| * |
| * Copyright 1999 by Carsten Paeth <calle@calle.de> |
| * |
| * This software may be used and distributed according to the terms |
| * of the GNU General Public License, incorporated herein by reference. |
| * |
| */ |
| |
| #include <linux/module.h> |
| #include <linux/kernel.h> |
| #include <linux/init.h> |
| #include <linux/ptrace.h> |
| #include <linux/slab.h> |
| #include <linux/string.h> |
| #include <linux/tty.h> |
| #include <linux/serial.h> |
| #include <linux/major.h> |
| #include <asm/io.h> |
| #include <asm/system.h> |
| |
| #include <pcmcia/cs_types.h> |
| #include <pcmcia/cs.h> |
| #include <pcmcia/cistpl.h> |
| #include <pcmcia/ciscode.h> |
| #include <pcmcia/ds.h> |
| #include <pcmcia/cisreg.h> |
| |
| #include <linux/skbuff.h> |
| #include <linux/capi.h> |
| #include <linux/b1lli.h> |
| #include <linux/b1pcmcia.h> |
| |
| /*====================================================================*/ |
| |
| MODULE_DESCRIPTION("CAPI4Linux: PCMCIA client driver for AVM B1/M1/M2"); |
| MODULE_AUTHOR("Carsten Paeth"); |
| MODULE_LICENSE("GPL"); |
| |
| /*====================================================================*/ |
| |
| /* |
| The event() function is this driver's Card Services event handler. |
| It will be called by Card Services when an appropriate card status |
| event is received. The config() and release() entry points are |
| used to configure or release a socket, in response to card insertion |
| and ejection events. They are invoked from the skeleton event |
| handler. |
| */ |
| |
| static int avmcs_config(struct pcmcia_device *link); |
| static void avmcs_release(struct pcmcia_device *link); |
| |
| /* |
| The attach() and detach() entry points are used to create and destroy |
| "instances" of the driver, where each instance represents everything |
| needed to manage one actual PCMCIA card. |
| */ |
| |
| static void avmcs_detach(struct pcmcia_device *p_dev); |
| |
| /* |
| A linked list of "instances" of the skeleton device. Each actual |
| PCMCIA card corresponds to one device instance, and is described |
| by one struct pcmcia_device structure (defined in ds.h). |
| |
| You may not want to use a linked list for this -- for example, the |
| memory card driver uses an array of struct pcmcia_device pointers, where minor |
| device numbers are used to derive the corresponding array index. |
| */ |
| |
| /* |
| A driver needs to provide a dev_node_t structure for each device |
| on a card. In some cases, there is only one device per card (for |
| example, ethernet cards, modems). In other cases, there may be |
| many actual or logical devices (SCSI adapters, memory cards with |
| multiple partitions). The dev_node_t structures need to be kept |
| in a linked list starting at the 'dev' field of a struct pcmcia_device |
| structure. We allocate them in the card's private data structure, |
| because they generally can't be allocated dynamically. |
| */ |
| |
| typedef struct local_info_t { |
| dev_node_t node; |
| } local_info_t; |
| |
| /*====================================================================== |
| |
| avmcs_attach() creates an "instance" of the driver, allocating |
| local data structures for one device. The device is registered |
| with Card Services. |
| |
| The dev_link structure is initialized, but we don't actually |
| configure the card at this point -- we wait until we receive a |
| card insertion event. |
| |
| ======================================================================*/ |
| |
| static int avmcs_probe(struct pcmcia_device *p_dev) |
| { |
| local_info_t *local; |
| |
| /* The io structure describes IO port mapping */ |
| p_dev->io.NumPorts1 = 16; |
| p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8; |
| p_dev->io.NumPorts2 = 0; |
| |
| /* Interrupt setup */ |
| p_dev->irq.Attributes = IRQ_TYPE_EXCLUSIVE; |
| p_dev->irq.Attributes = IRQ_TYPE_DYNAMIC_SHARING|IRQ_FIRST_SHARED; |
| |
| p_dev->irq.IRQInfo1 = IRQ_LEVEL_ID; |
| |
| /* General socket configuration */ |
| p_dev->conf.Attributes = CONF_ENABLE_IRQ; |
| p_dev->conf.IntType = INT_MEMORY_AND_IO; |
| p_dev->conf.ConfigIndex = 1; |
| p_dev->conf.Present = PRESENT_OPTION; |
| |
| /* Allocate space for private device-specific data */ |
| local = kzalloc(sizeof(local_info_t), GFP_KERNEL); |
| if (!local) |
| goto err; |
| p_dev->priv = local; |
| |
| return avmcs_config(p_dev); |
| |
| err: |
| return -ENOMEM; |
| } /* avmcs_attach */ |
| |
| /*====================================================================== |
| |
| This deletes a driver "instance". The device is de-registered |
| with Card Services. If it has been released, all local data |
| structures are freed. Otherwise, the structures will be freed |
| when the device is released. |
| |
| ======================================================================*/ |
| |
| static void avmcs_detach(struct pcmcia_device *link) |
| { |
| avmcs_release(link); |
| kfree(link->priv); |
| } /* avmcs_detach */ |
| |
| /*====================================================================== |
| |
| avmcs_config() is scheduled to run after a CARD_INSERTION event |
| is received, to configure the PCMCIA socket, and to make the |
| ethernet device available to the system. |
| |
| ======================================================================*/ |
| |
| static int avmcs_configcheck(struct pcmcia_device *p_dev, |
| cistpl_cftable_entry_t *cf, |
| cistpl_cftable_entry_t *dflt, |
| void *priv_data) |
| { |
| if (cf->io.nwin <= 0) |
| return -ENODEV; |
| |
| p_dev->io.BasePort1 = cf->io.win[0].base; |
| p_dev->io.NumPorts1 = cf->io.win[0].len; |
| p_dev->io.NumPorts2 = 0; |
| printk(KERN_INFO "avm_cs: testing i/o %#x-%#x\n", |
| p_dev->io.BasePort1, |
| p_dev->io.BasePort1+p_dev->io.NumPorts1-1); |
| return pcmcia_request_io(p_dev, &p_dev->io); |
| } |
| |
| static int avmcs_config(struct pcmcia_device *link) |
| { |
| local_info_t *dev; |
| int i; |
| char devname[128]; |
| int cardtype; |
| int (*addcard)(unsigned int port, unsigned irq); |
| |
| dev = link->priv; |
| |
| devname[0] = 0; |
| if (link->prod_id[1]) |
| strlcpy(devname, link->prod_id[1], sizeof(devname)); |
| |
| /* |
| * find IO port |
| */ |
| if (pcmcia_loop_config(link, avmcs_configcheck, NULL)) |
| return -ENODEV; |
| |
| do { |
| /* |
| * allocate an interrupt line |
| */ |
| i = pcmcia_request_irq(link, &link->irq); |
| if (i != CS_SUCCESS) { |
| cs_error(link, RequestIRQ, i); |
| /* undo */ |
| pcmcia_disable_device(link); |
| break; |
| } |
| |
| /* |
| * configure the PCMCIA socket |
| */ |
| i = pcmcia_request_configuration(link, &link->conf); |
| if (i != CS_SUCCESS) { |
| cs_error(link, RequestConfiguration, i); |
| pcmcia_disable_device(link); |
| break; |
| } |
| |
| } while (0); |
| |
| /* At this point, the dev_node_t structure(s) should be |
| initialized and arranged in a linked list at link->dev. */ |
| |
| if (devname[0]) { |
| char *s = strrchr(devname, ' '); |
| if (!s) |
| s = devname; |
| else s++; |
| strcpy(dev->node.dev_name, s); |
| if (strcmp("M1", s) == 0) { |
| cardtype = AVM_CARDTYPE_M1; |
| } else if (strcmp("M2", s) == 0) { |
| cardtype = AVM_CARDTYPE_M2; |
| } else { |
| cardtype = AVM_CARDTYPE_B1; |
| } |
| } else { |
| strcpy(dev->node.dev_name, "b1"); |
| cardtype = AVM_CARDTYPE_B1; |
| } |
| |
| dev->node.major = 64; |
| dev->node.minor = 0; |
| link->dev_node = &dev->node; |
| |
| /* If any step failed, release any partially configured state */ |
| if (i != 0) { |
| avmcs_release(link); |
| return -ENODEV; |
| } |
| |
| |
| switch (cardtype) { |
| case AVM_CARDTYPE_M1: addcard = b1pcmcia_addcard_m1; break; |
| case AVM_CARDTYPE_M2: addcard = b1pcmcia_addcard_m2; break; |
| default: |
| case AVM_CARDTYPE_B1: addcard = b1pcmcia_addcard_b1; break; |
| } |
| if ((i = (*addcard)(link->io.BasePort1, link->irq.AssignedIRQ)) < 0) { |
| printk(KERN_ERR "avm_cs: failed to add AVM-%s-Controller at i/o %#x, irq %d\n", |
| dev->node.dev_name, link->io.BasePort1, link->irq.AssignedIRQ); |
| avmcs_release(link); |
| return -ENODEV; |
| } |
| dev->node.minor = i; |
| return 0; |
| |
| } /* avmcs_config */ |
| |
| /*====================================================================== |
| |
| After a card is removed, avmcs_release() will unregister the net |
| device, and release the PCMCIA configuration. If the device is |
| still open, this will be postponed until it is closed. |
| |
| ======================================================================*/ |
| |
| static void avmcs_release(struct pcmcia_device *link) |
| { |
| b1pcmcia_delcard(link->io.BasePort1, link->irq.AssignedIRQ); |
| pcmcia_disable_device(link); |
| } /* avmcs_release */ |
| |
| |
| static struct pcmcia_device_id avmcs_ids[] = { |
| PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335), |
| PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M1", 0x95d42008, 0x81e10430), |
| PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M2", 0x95d42008, 0x18e8558a), |
| PCMCIA_DEVICE_NULL |
| }; |
| MODULE_DEVICE_TABLE(pcmcia, avmcs_ids); |
| |
| static struct pcmcia_driver avmcs_driver = { |
| .owner = THIS_MODULE, |
| .drv = { |
| .name = "avm_cs", |
| }, |
| .probe = avmcs_probe, |
| .remove = avmcs_detach, |
| .id_table = avmcs_ids, |
| }; |
| |
| static int __init avmcs_init(void) |
| { |
| return pcmcia_register_driver(&avmcs_driver); |
| } |
| |
| static void __exit avmcs_exit(void) |
| { |
| pcmcia_unregister_driver(&avmcs_driver); |
| } |
| |
| module_init(avmcs_init); |
| module_exit(avmcs_exit); |