[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");

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

static int avmcs_config(struct pcmcia_device *link);
static void avmcs_release(struct pcmcia_device *link);
static void avmcs_detach(struct pcmcia_device *p_dev);

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 */


static void avmcs_detach(struct pcmcia_device *link)
{
	avmcs_release(link);
} /* avmcs_detach */

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 */


static void avmcs_release(struct pcmcia_device *link)
{
	b1pcmcia_delcard(link->resource[0]->start, link->irq);
	pcmcia_disable_device(link);
} /* avmcs_release */


static const 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
15b99ac1	41	static int avmcs_config(struct pcmcia_device *link);
fba395ee	42	static void avmcs_release(struct pcmcia_device *link);
cc3b4866	43	static void avmcs_detach(struct pcmcia_device *p_dev);
1da177e4	44
15b99ac1	45	static int avmcs_probe(struct pcmcia_device *p_dev)
1da177e4	46	{
1da177e4	47	/* General socket configuration */
00990e7c	48	p_dev->config_flags \|= CONF_ENABLE_IRQ \| CONF_AUTO_SET_IO;
7feabb64 DB	49	p_dev->config_index = 1;
7feabb64 DB	50	p_dev->config_regs = PRESENT_OPTION;
1da177e4	51
15b99ac1	52	return avmcs_config(p_dev);
1da177e4 LT	53	} /* avmcs_attach */
1da177e4 LT	54
1da177e4	55
fba395ee	56	static void avmcs_detach(struct pcmcia_device *link)
1da177e4	57	{
cc3b4866	58	avmcs_release(link);
1da177e4 LT	59	} /* avmcs_detach */
1da177e4 LT	60
00990e7c	61	static int avmcs_configcheck(struct pcmcia_device p_dev, void priv_data)
1da177e4	62	{
00990e7c DB	63	p_dev->resource[0]->end = 16;
	64	p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
	65	p_dev->resource[0]->flags \|= IO_DATA_PATH_WIDTH_8;
5fcd4da0	66
90abdc3b	67	return pcmcia_request_io(p_dev);
1da177e4 LT	68	}
1da177e4 LT	69
15b99ac1	70	static int avmcs_config(struct pcmcia_device *link)
1da177e4	71	{
eb14120f	72	int i = -1;
1da177e4 LT	73	char devname[128];
	74	int cardtype;
	75	int (*addcard)(unsigned int port, unsigned irq);
fba395ee	76
5fcd4da0 DB	77	devname[0] = 0;
	78	if (link->prod_id[1])
	79	strlcpy(devname, link->prod_id[1], sizeof(devname));
a9606fd3	80
5fcd4da0 DB	81	/*
	82	* find IO port
	83	*/
	84	if (pcmcia_loop_config(link, avmcs_configcheck, NULL))
	85	return -ENODEV;
50db3fdb	86
5fcd4da0	87	do {
eb14120f	88	if (!link->irq) {
50db3fdb	89	/* undo */
fba395ee	90	pcmcia_disable_device(link);
1da177e4 LT	91	break;
1da177e4 LT	92	}
50db3fdb	93
1da177e4 LT	94	/*
	95	* configure the PCMCIA socket
	96	*/
1ac71e5a	97	i = pcmcia_enable_device(link);
4c89e88b	98	if (i != 0) {
fba395ee	99	pcmcia_disable_device(link);
1da177e4 LT	100	break;
	101	}
	102
	103	} while (0);
	104
1da177e4 LT	105	if (devname[0]) {
	106	char *s = strrchr(devname, ' ');
	107	if (!s)
	108	s = devname;
	109	else s++;
1da177e4 LT	110	if (strcmp("M1", s) == 0) {
	111	cardtype = AVM_CARDTYPE_M1;
	112	} else if (strcmp("M2", s) == 0) {
	113	cardtype = AVM_CARDTYPE_M2;
	114	} else {
	115	cardtype = AVM_CARDTYPE_B1;
	116	}
ded6a1a3	117	} else
1da177e4	118	cardtype = AVM_CARDTYPE_B1;
e2d40963	119
1da177e4 LT	120	/* If any step failed, release any partially configured state */
	121	if (i != 0) {
	122	avmcs_release(link);
15b99ac1	123	return -ENODEV;
1da177e4 LT	124	}
	125
	126
	127	switch (cardtype) {
	128	case AVM_CARDTYPE_M1: addcard = b1pcmcia_addcard_m1; break;
	129	case AVM_CARDTYPE_M2: addcard = b1pcmcia_addcard_m2; break;
	130	default:
	131	case AVM_CARDTYPE_B1: addcard = b1pcmcia_addcard_b1; break;
	132	}
9a017a91 DB	133	if ((i = (*addcard)(link->resource[0]->start, link->irq)) < 0) {
	134	dev_err(&link->dev,
	135	"avm_cs: failed to add AVM-Controller at i/o %#x, irq %d\n",
	136	(unsigned int) link->resource[0]->start, link->irq);
ded6a1a3 DB	137	avmcs_release(link);
ded6a1a3 DB	138	return -ENODEV;
1da177e4	139	}
15b99ac1	140	return 0;
1da177e4 LT	141
	142	} /* avmcs_config */
	143
1da177e4	144
fba395ee	145	static void avmcs_release(struct pcmcia_device *link)
1da177e4	146	{
9a017a91	147	b1pcmcia_delcard(link->resource[0]->start, link->irq);
fba395ee	148	pcmcia_disable_device(link);
1da177e4 LT	149	} /* avmcs_release */
1da177e4 LT	150
1da177e4	151
25f8f54f	152	static const struct pcmcia_device_id avmcs_ids[] = {
a13bcf0d DB	153	PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335),
	154	PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M1", 0x95d42008, 0x81e10430),
	155	PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M2", 0x95d42008, 0x18e8558a),
	156	PCMCIA_DEVICE_NULL
	157	};
	158	MODULE_DEVICE_TABLE(pcmcia, avmcs_ids);
	159
1da177e4 LT	160	static struct pcmcia_driver avmcs_driver = {
1da177e4 LT	161	.owner = THIS_MODULE,
2e9b981a	162	.name = "avm_cs",
15b99ac1	163	.probe = avmcs_probe,
cc3b4866	164	.remove = avmcs_detach,
a13bcf0d	165	.id_table = avmcs_ids,
1da177e4 LT	166	};
	167
	168	static int __init avmcs_init(void)
	169	{
	170	return pcmcia_register_driver(&avmcs_driver);
	171	}
	172
	173	static void __exit avmcs_exit(void)
	174	{
	175	pcmcia_unregister_driver(&avmcs_driver);
1da177e4 LT	176	}
	177
	178	module_init(avmcs_init);
	179	module_exit(avmcs_exit);