[deliverable/linux.git] / drivers / isdn / hardware / avm / avm_cs.c

/* $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/string.h>
#include <linux/tty.h>
#include <linux/serial.h>
#include <linux/major.h>
#include <asm/io.h>
#include <asm/system.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);

/*======================================================================

    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)
{
    /* General socket configuration */
    p_dev->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO;
    p_dev->config_index = 1;
    p_dev->config_regs = PRESENT_OPTION;

    return avmcs_config(p_dev);
} /* 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);
} /* 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, void *priv_data)
{
	p_dev->resource[0]->end = 16;
	p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
	p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;

	return pcmcia_request_io(p_dev);
}

static int avmcs_config(struct pcmcia_device *link)
{
    int i = -1;
    char devname[128];
    int cardtype;
    int (*addcard)(unsigned int port, unsigned irq);

    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 {
	if (!link->irq) {
	    /* undo */
	    pcmcia_disable_device(link);
	    break;
	}

	/*
         * configure the PCMCIA socket
	  */
	i = pcmcia_enable_device(link);
	if (i != 0) {
	    pcmcia_disable_device(link);
	    break;
	}

    } while (0);

    if (devname[0]) {
	char *s = strrchr(devname, ' ');
	if (!s)
	   s = devname;
	else 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
        cardtype = AVM_CARDTYPE_B1;

    /* 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->resource[0]->start, link->irq)) < 0) {
	    dev_err(&link->dev,
		    "avm_cs: failed to add AVM-Controller at i/o %#x, irq %d\n",
		    (unsigned int) link->resource[0]->start, link->irq);
	    avmcs_release(link);
	    return -ENODEV;
    }
    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->resource[0]->start, link->irq);
	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,
	.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);
Commit	Line	Data
1da177e4 LT	1	/* $Id: avm_cs.c,v 1.4.6.3 2001/09/23 22:24:33 kai Exp $
	2	*
	3	* A PCMCIA client driver for AVM B1/M1/M2
	4	*
	5	* Copyright 1999 by Carsten Paeth <calle@calle.de>
	6	*
	7	* This software may be used and distributed according to the terms
	8	* of the GNU General Public License, incorporated herein by reference.
	9	*
	10	*/
	11
	12	#include <linux/module.h>
	13	#include <linux/kernel.h>
	14	#include <linux/init.h>
1da177e4	15	#include <linux/ptrace.h>
1da177e4 LT	16	#include <linux/string.h>
	17	#include <linux/tty.h>
	18	#include <linux/serial.h>
	19	#include <linux/major.h>
	20	#include <asm/io.h>
	21	#include <asm/system.h>
	22
1da177e4 LT	23	#include <pcmcia/cistpl.h>
	24	#include <pcmcia/ciscode.h>
	25	#include <pcmcia/ds.h>
	26	#include <pcmcia/cisreg.h>
	27
	28	#include <linux/skbuff.h>
	29	#include <linux/capi.h>
	30	#include <linux/b1lli.h>
	31	#include <linux/b1pcmcia.h>
	32
	33	/====================================================================/
	34
	35	MODULE_DESCRIPTION("CAPI4Linux: PCMCIA client driver for AVM B1/M1/M2");
	36	MODULE_AUTHOR("Carsten Paeth");
	37	MODULE_LICENSE("GPL");
	38
	39	/====================================================================/
	40
	41	/*
	42	The event() function is this driver's Card Services event handler.
	43	It will be called by Card Services when an appropriate card status
	44	event is received. The config() and release() entry points are
	45	used to configure or release a socket, in response to card insertion
	46	and ejection events. They are invoked from the skeleton event
	47	handler.
	48	*/
	49
15b99ac1	50	static int avmcs_config(struct pcmcia_device *link);
fba395ee	51	static void avmcs_release(struct pcmcia_device *link);
1da177e4 LT	52
	53	/*
	54	The attach() and detach() entry points are used to create and destroy
	55	"instances" of the driver, where each instance represents everything
	56	needed to manage one actual PCMCIA card.
	57	*/
	58
cc3b4866	59	static void avmcs_detach(struct pcmcia_device *p_dev);
1da177e4	60
1da177e4 LT	61	/*======================================================================
	62
	63	avmcs_attach() creates an "instance" of the driver, allocating
	64	local data structures for one device. The device is registered
	65	with Card Services.
	66
	67	The dev_link structure is initialized, but we don't actually
	68	configure the card at this point -- we wait until we receive a
	69	card insertion event.
	70
	71	======================================================================*/
	72
15b99ac1	73	static int avmcs_probe(struct pcmcia_device *p_dev)
1da177e4	74	{
1da177e4	75	/* General socket configuration */
00990e7c	76	p_dev->config_flags \|= CONF_ENABLE_IRQ \| CONF_AUTO_SET_IO;
7feabb64 DB	77	p_dev->config_index = 1;
7feabb64 DB	78	p_dev->config_regs = PRESENT_OPTION;
1da177e4	79
15b99ac1	80	return avmcs_config(p_dev);
1da177e4 LT	81	} /* avmcs_attach */
	82
	83	/*======================================================================
	84
	85	This deletes a driver "instance". The device is de-registered
	86	with Card Services. If it has been released, all local data
	87	structures are freed. Otherwise, the structures will be freed
	88	when the device is released.
	89
	90	======================================================================*/
	91
fba395ee	92	static void avmcs_detach(struct pcmcia_device *link)
1da177e4	93	{
cc3b4866	94	avmcs_release(link);
1da177e4 LT	95	} /* avmcs_detach */
	96
	97	/*======================================================================
	98
	99	avmcs_config() is scheduled to run after a CARD_INSERTION event
	100	is received, to configure the PCMCIA socket, and to make the
	101	ethernet device available to the system.
	102
	103	======================================================================*/
	104
00990e7c	105	static int avmcs_configcheck(struct pcmcia_device p_dev, void priv_data)
1da177e4	106	{
00990e7c DB	107	p_dev->resource[0]->end = 16;
	108	p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
	109	p_dev->resource[0]->flags \|= IO_DATA_PATH_WIDTH_8;
5fcd4da0	110
90abdc3b	111	return pcmcia_request_io(p_dev);
1da177e4 LT	112	}
1da177e4 LT	113
15b99ac1	114	static int avmcs_config(struct pcmcia_device *link)
1da177e4	115	{
eb14120f	116	int i = -1;
1da177e4 LT	117	char devname[128];
	118	int cardtype;
	119	int (*addcard)(unsigned int port, unsigned irq);
fba395ee	120
5fcd4da0 DB	121	devname[0] = 0;
	122	if (link->prod_id[1])
	123	strlcpy(devname, link->prod_id[1], sizeof(devname));
a9606fd3	124
5fcd4da0 DB	125	/*
	126	* find IO port
	127	*/
	128	if (pcmcia_loop_config(link, avmcs_configcheck, NULL))
	129	return -ENODEV;
50db3fdb	130
5fcd4da0	131	do {
eb14120f	132	if (!link->irq) {
50db3fdb	133	/* undo */
fba395ee	134	pcmcia_disable_device(link);
1da177e4 LT	135	break;
1da177e4 LT	136	}
50db3fdb	137
1da177e4 LT	138	/*
	139	* configure the PCMCIA socket
	140	*/
1ac71e5a	141	i = pcmcia_enable_device(link);
4c89e88b	142	if (i != 0) {
fba395ee	143	pcmcia_disable_device(link);
1da177e4 LT	144	break;
	145	}
	146
	147	} while (0);
	148
1da177e4 LT	149	if (devname[0]) {
	150	char *s = strrchr(devname, ' ');
	151	if (!s)
	152	s = devname;
	153	else s++;
1da177e4 LT	154	if (strcmp("M1", s) == 0) {
	155	cardtype = AVM_CARDTYPE_M1;
	156	} else if (strcmp("M2", s) == 0) {
	157	cardtype = AVM_CARDTYPE_M2;
	158	} else {
	159	cardtype = AVM_CARDTYPE_B1;
	160	}
ded6a1a3	161	} else
1da177e4	162	cardtype = AVM_CARDTYPE_B1;
e2d40963	163
1da177e4 LT	164	/* If any step failed, release any partially configured state */
	165	if (i != 0) {
	166	avmcs_release(link);
15b99ac1	167	return -ENODEV;
1da177e4 LT	168	}
	169
	170
	171	switch (cardtype) {
	172	case AVM_CARDTYPE_M1: addcard = b1pcmcia_addcard_m1; break;
	173	case AVM_CARDTYPE_M2: addcard = b1pcmcia_addcard_m2; break;
	174	default:
	175	case AVM_CARDTYPE_B1: addcard = b1pcmcia_addcard_b1; break;
	176	}
9a017a91 DB	177	if ((i = (*addcard)(link->resource[0]->start, link->irq)) < 0) {
	178	dev_err(&link->dev,
	179	"avm_cs: failed to add AVM-Controller at i/o %#x, irq %d\n",
	180	(unsigned int) link->resource[0]->start, link->irq);
ded6a1a3 DB	181	avmcs_release(link);
ded6a1a3 DB	182	return -ENODEV;
1da177e4	183	}
15b99ac1	184	return 0;
1da177e4 LT	185
	186	} /* avmcs_config */
	187
	188	/*======================================================================
	189
	190	After a card is removed, avmcs_release() will unregister the net
	191	device, and release the PCMCIA configuration. If the device is
	192	still open, this will be postponed until it is closed.
	193
	194	======================================================================*/
	195
fba395ee	196	static void avmcs_release(struct pcmcia_device *link)
1da177e4	197	{
9a017a91	198	b1pcmcia_delcard(link->resource[0]->start, link->irq);
fba395ee	199	pcmcia_disable_device(link);
1da177e4 LT	200	} /* avmcs_release */
1da177e4 LT	201
1da177e4	202
a13bcf0d DB	203	static struct pcmcia_device_id avmcs_ids[] = {
	204	PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335),
	205	PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M1", 0x95d42008, 0x81e10430),
	206	PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M2", 0x95d42008, 0x18e8558a),
	207	PCMCIA_DEVICE_NULL
	208	};
	209	MODULE_DEVICE_TABLE(pcmcia, avmcs_ids);
	210
1da177e4 LT	211	static struct pcmcia_driver avmcs_driver = {
1da177e4 LT	212	.owner = THIS_MODULE,
2e9b981a	213	.name = "avm_cs",
15b99ac1	214	.probe = avmcs_probe,
cc3b4866	215	.remove = avmcs_detach,
a13bcf0d	216	.id_table = avmcs_ids,
1da177e4 LT	217	};
	218
	219	static int __init avmcs_init(void)
	220	{
	221	return pcmcia_register_driver(&avmcs_driver);
	222	}
	223
	224	static void __exit avmcs_exit(void)
	225	{
	226	pcmcia_unregister_driver(&avmcs_driver);
1da177e4 LT	227	}
	228
	229	module_init(avmcs_init);
	230	module_exit(avmcs_exit);