| /* |
| * PCMCIA client driver for AVM A1 / Fritz!PCMCIA |
| * |
| * Author Carsten Paeth |
| * Copyright 1998-2001 by Carsten Paeth <calle@calle.in-berlin.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/sched.h> |
| #include <linux/ptrace.h> |
| #include <linux/slab.h> |
| #include <linux/string.h> |
| #include <asm/io.h> |
| #include <asm/system.h> |
| |
| #include <pcmcia/cs_types.h> |
| #include <pcmcia/cs.h> |
| #include <pcmcia/cistpl.h> |
| #include <pcmcia/ds.h> |
| #include "hisax_cfg.h" |
| |
| MODULE_DESCRIPTION("ISDN4Linux: PCMCIA client driver for AVM A1/Fritz!PCMCIA cards"); |
| MODULE_AUTHOR("Carsten Paeth"); |
| MODULE_LICENSE("GPL"); |
| |
| /* |
| All the PCMCIA modules use PCMCIA_DEBUG to control debugging. If |
| you do not define PCMCIA_DEBUG at all, all the debug code will be |
| left out. If you compile with PCMCIA_DEBUG=0, the debug code will |
| be present but disabled -- but it can then be enabled for specific |
| modules at load time with a 'pc_debug=#' option to insmod. |
| */ |
| #ifdef PCMCIA_DEBUG |
| static int pc_debug = PCMCIA_DEBUG; |
| module_param(pc_debug, int, 0); |
| #define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args); |
| static char *version = |
| "avma1_cs.c 1.00 1998/01/23 10:00:00 (Carsten Paeth)"; |
| #else |
| #define DEBUG(n, args...) |
| #endif |
| |
| /*====================================================================*/ |
| |
| /* Parameters that can be set with 'insmod' */ |
| |
| static int isdnprot = 2; |
| |
| module_param(isdnprot, int, 0); |
| |
| /*====================================================================*/ |
| |
| /* |
| 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 void avma1cs_config(dev_link_t *link); |
| static void avma1cs_release(dev_link_t *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 avma1cs_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 dev_link_t 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 dev_link_t 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 dev_link_t |
| 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; |
| |
| /*====================================================================== |
| |
| avma1cs_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 avma1cs_attach(struct pcmcia_device *p_dev) |
| { |
| dev_link_t *link; |
| local_info_t *local; |
| |
| DEBUG(0, "avma1cs_attach()\n"); |
| |
| /* Initialize the dev_link_t structure */ |
| link = kmalloc(sizeof(struct dev_link_t), GFP_KERNEL); |
| if (!link) |
| return -ENOMEM; |
| memset(link, 0, sizeof(struct dev_link_t)); |
| |
| /* Allocate space for private device-specific data */ |
| local = kmalloc(sizeof(local_info_t), GFP_KERNEL); |
| if (!local) { |
| kfree(link); |
| return -ENOMEM; |
| } |
| memset(local, 0, sizeof(local_info_t)); |
| link->priv = local; |
| |
| /* The io structure describes IO port mapping */ |
| link->io.NumPorts1 = 16; |
| link->io.Attributes1 = IO_DATA_PATH_WIDTH_8; |
| link->io.NumPorts2 = 16; |
| link->io.Attributes2 = IO_DATA_PATH_WIDTH_16; |
| link->io.IOAddrLines = 5; |
| |
| /* Interrupt setup */ |
| link->irq.Attributes = IRQ_TYPE_EXCLUSIVE; |
| link->irq.Attributes = IRQ_TYPE_DYNAMIC_SHARING|IRQ_FIRST_SHARED; |
| |
| link->irq.IRQInfo1 = IRQ_LEVEL_ID; |
| |
| /* General socket configuration */ |
| link->conf.Attributes = CONF_ENABLE_IRQ; |
| link->conf.Vcc = 50; |
| link->conf.IntType = INT_MEMORY_AND_IO; |
| link->conf.ConfigIndex = 1; |
| link->conf.Present = PRESENT_OPTION; |
| |
| link->handle = p_dev; |
| p_dev->instance = link; |
| |
| link->state |= DEV_PRESENT | DEV_CONFIG_PENDING; |
| avma1cs_config(link); |
| |
| return 0; |
| } /* avma1cs_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 avma1cs_detach(struct pcmcia_device *p_dev) |
| { |
| dev_link_t *link = dev_to_instance(p_dev); |
| |
| DEBUG(0, "avma1cs_detach(0x%p)\n", link); |
| |
| if (link->state & DEV_CONFIG) |
| avma1cs_release(link); |
| |
| kfree(link->priv); |
| kfree(link); |
| } /* avma1cs_detach */ |
| |
| /*====================================================================== |
| |
| avma1cs_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 get_tuple(client_handle_t handle, tuple_t *tuple, |
| cisparse_t *parse) |
| { |
| int i = pcmcia_get_tuple_data(handle, tuple); |
| if (i != CS_SUCCESS) return i; |
| return pcmcia_parse_tuple(handle, tuple, parse); |
| } |
| |
| static int first_tuple(client_handle_t handle, tuple_t *tuple, |
| cisparse_t *parse) |
| { |
| int i = pcmcia_get_first_tuple(handle, tuple); |
| if (i != CS_SUCCESS) return i; |
| return get_tuple(handle, tuple, parse); |
| } |
| |
| static int next_tuple(client_handle_t handle, tuple_t *tuple, |
| cisparse_t *parse) |
| { |
| int i = pcmcia_get_next_tuple(handle, tuple); |
| if (i != CS_SUCCESS) return i; |
| return get_tuple(handle, tuple, parse); |
| } |
| |
| static void avma1cs_config(dev_link_t *link) |
| { |
| client_handle_t handle; |
| tuple_t tuple; |
| cisparse_t parse; |
| cistpl_cftable_entry_t *cf = &parse.cftable_entry; |
| local_info_t *dev; |
| int i; |
| u_char buf[64]; |
| char devname[128]; |
| IsdnCard_t icard; |
| int busy = 0; |
| |
| handle = link->handle; |
| dev = link->priv; |
| |
| DEBUG(0, "avma1cs_config(0x%p)\n", link); |
| |
| /* |
| This reads the card's CONFIG tuple to find its configuration |
| registers. |
| */ |
| do { |
| tuple.DesiredTuple = CISTPL_CONFIG; |
| i = pcmcia_get_first_tuple(handle, &tuple); |
| if (i != CS_SUCCESS) break; |
| tuple.TupleData = buf; |
| tuple.TupleDataMax = 64; |
| tuple.TupleOffset = 0; |
| i = pcmcia_get_tuple_data(handle, &tuple); |
| if (i != CS_SUCCESS) break; |
| i = pcmcia_parse_tuple(handle, &tuple, &parse); |
| if (i != CS_SUCCESS) break; |
| link->conf.ConfigBase = parse.config.base; |
| } while (0); |
| if (i != CS_SUCCESS) { |
| cs_error(link->handle, ParseTuple, i); |
| link->state &= ~DEV_CONFIG_PENDING; |
| return; |
| } |
| |
| /* Configure card */ |
| link->state |= DEV_CONFIG; |
| |
| do { |
| |
| tuple.Attributes = 0; |
| tuple.TupleData = buf; |
| tuple.TupleDataMax = 254; |
| tuple.TupleOffset = 0; |
| tuple.DesiredTuple = CISTPL_VERS_1; |
| |
| devname[0] = 0; |
| if( !first_tuple(handle, &tuple, &parse) && parse.version_1.ns > 1 ) { |
| strlcpy(devname,parse.version_1.str + parse.version_1.ofs[1], |
| sizeof(devname)); |
| } |
| /* |
| * find IO port |
| */ |
| tuple.TupleData = (cisdata_t *)buf; |
| tuple.TupleOffset = 0; tuple.TupleDataMax = 255; |
| tuple.Attributes = 0; |
| tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY; |
| i = first_tuple(handle, &tuple, &parse); |
| while (i == CS_SUCCESS) { |
| if (cf->io.nwin > 0) { |
| link->conf.ConfigIndex = cf->index; |
| link->io.BasePort1 = cf->io.win[0].base; |
| link->io.NumPorts1 = cf->io.win[0].len; |
| link->io.NumPorts2 = 0; |
| printk(KERN_INFO "avma1_cs: testing i/o %#x-%#x\n", |
| link->io.BasePort1, |
| link->io.BasePort1+link->io.NumPorts1 - 1); |
| i = pcmcia_request_io(link->handle, &link->io); |
| if (i == CS_SUCCESS) goto found_port; |
| } |
| i = next_tuple(handle, &tuple, &parse); |
| } |
| |
| found_port: |
| if (i != CS_SUCCESS) { |
| cs_error(link->handle, RequestIO, i); |
| break; |
| } |
| |
| /* |
| * allocate an interrupt line |
| */ |
| i = pcmcia_request_irq(link->handle, &link->irq); |
| if (i != CS_SUCCESS) { |
| cs_error(link->handle, RequestIRQ, i); |
| pcmcia_release_io(link->handle, &link->io); |
| break; |
| } |
| |
| /* |
| * configure the PCMCIA socket |
| */ |
| i = pcmcia_request_configuration(link->handle, &link->conf); |
| if (i != CS_SUCCESS) { |
| cs_error(link->handle, RequestConfiguration, i); |
| pcmcia_release_io(link->handle, &link->io); |
| pcmcia_release_irq(link->handle, &link->irq); |
| break; |
| } |
| |
| } while (0); |
| |
| /* At this point, the dev_node_t structure(s) should be |
| initialized and arranged in a linked list at link->dev. */ |
| |
| strcpy(dev->node.dev_name, "A1"); |
| dev->node.major = 45; |
| dev->node.minor = 0; |
| link->dev = &dev->node; |
| |
| link->state &= ~DEV_CONFIG_PENDING; |
| /* If any step failed, release any partially configured state */ |
| if (i != 0) { |
| avma1cs_release(link); |
| return; |
| } |
| |
| printk(KERN_NOTICE "avma1_cs: checking at i/o %#x, irq %d\n", |
| link->io.BasePort1, link->irq.AssignedIRQ); |
| |
| icard.para[0] = link->irq.AssignedIRQ; |
| icard.para[1] = link->io.BasePort1; |
| icard.protocol = isdnprot; |
| icard.typ = ISDN_CTYPE_A1_PCMCIA; |
| |
| i = hisax_init_pcmcia(link, &busy, &icard); |
| if (i < 0) { |
| printk(KERN_ERR "avma1_cs: failed to initialize AVM A1 PCMCIA %d at i/o %#x\n", i, link->io.BasePort1); |
| avma1cs_release(link); |
| return; |
| } |
| dev->node.minor = i; |
| |
| } /* avma1cs_config */ |
| |
| /*====================================================================== |
| |
| After a card is removed, avma1cs_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 avma1cs_release(dev_link_t *link) |
| { |
| local_info_t *local = link->priv; |
| |
| DEBUG(0, "avma1cs_release(0x%p)\n", link); |
| |
| /* no unregister function with hisax */ |
| HiSax_closecard(local->node.minor); |
| |
| /* Unlink the device chain */ |
| link->dev = NULL; |
| |
| /* Don't bother checking to see if these succeed or not */ |
| pcmcia_release_configuration(link->handle); |
| pcmcia_release_io(link->handle, &link->io); |
| pcmcia_release_irq(link->handle, &link->irq); |
| link->state &= ~DEV_CONFIG; |
| } /* avma1cs_release */ |
| |
| static int avma1cs_suspend(struct pcmcia_device *dev) |
| { |
| dev_link_t *link = dev_to_instance(dev); |
| |
| link->state |= DEV_SUSPEND; |
| if (link->state & DEV_CONFIG) |
| pcmcia_release_configuration(link->handle); |
| |
| return 0; |
| } |
| |
| static int avma1cs_resume(struct pcmcia_device *dev) |
| { |
| dev_link_t *link = dev_to_instance(dev); |
| |
| link->state &= ~DEV_SUSPEND; |
| if (link->state & DEV_CONFIG) |
| pcmcia_request_configuration(link->handle, &link->conf); |
| |
| return 0; |
| } |
| |
| |
| static struct pcmcia_device_id avma1cs_ids[] = { |
| PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN A", 0x95d42008, 0xadc9d4bb), |
| PCMCIA_DEVICE_PROD_ID12("ISDN", "CARD", 0x8d9761c8, 0x01c5aa7b), |
| PCMCIA_DEVICE_NULL |
| }; |
| MODULE_DEVICE_TABLE(pcmcia, avma1cs_ids); |
| |
| static struct pcmcia_driver avma1cs_driver = { |
| .owner = THIS_MODULE, |
| .drv = { |
| .name = "avma1_cs", |
| }, |
| .probe = avma1cs_attach, |
| .remove = avma1cs_detach, |
| .id_table = avma1cs_ids, |
| .suspend = avma1cs_suspend, |
| .resume = avma1cs_resume, |
| }; |
| |
| /*====================================================================*/ |
| |
| static int __init init_avma1_cs(void) |
| { |
| return(pcmcia_register_driver(&avma1cs_driver)); |
| } |
| |
| static void __exit exit_avma1_cs(void) |
| { |
| pcmcia_unregister_driver(&avma1cs_driver); |
| } |
| |
| module_init(init_avma1_cs); |
| module_exit(exit_avma1_cs); |