blob: c21353d8e91562f9318f948aa2dc4cf49ab33546 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* $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>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <linux/ptrace.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#include <linux/string.h>
17#include <linux/tty.h>
18#include <linux/serial.h>
19#include <linux/major.h>
20#include <asm/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070021
Linus Torvalds1da177e2005-04-16 15:20:36 -070022#include <pcmcia/cistpl.h>
23#include <pcmcia/ciscode.h>
24#include <pcmcia/ds.h>
25#include <pcmcia/cisreg.h>
26
27#include <linux/skbuff.h>
28#include <linux/capi.h>
29#include <linux/b1lli.h>
30#include <linux/b1pcmcia.h>
31
32/*====================================================================*/
33
34MODULE_DESCRIPTION("CAPI4Linux: PCMCIA client driver for AVM B1/M1/M2");
35MODULE_AUTHOR("Carsten Paeth");
36MODULE_LICENSE("GPL");
37
38/*====================================================================*/
39
Dominik Brodowski15b99ac2006-03-31 17:26:06 +020040static int avmcs_config(struct pcmcia_device *link);
Dominik Brodowskifba395e2006-03-31 17:21:06 +020041static void avmcs_release(struct pcmcia_device *link);
Dominik Brodowskicc3b4862005-11-14 21:23:14 +010042static void avmcs_detach(struct pcmcia_device *p_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070043
Dominik Brodowski15b99ac2006-03-31 17:26:06 +020044static int avmcs_probe(struct pcmcia_device *p_dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -070045{
Joe Perches475be4d2012-02-19 19:52:38 -080046 /* General socket configuration */
47 p_dev->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO;
48 p_dev->config_index = 1;
49 p_dev->config_regs = PRESENT_OPTION;
Linus Torvalds1da177e2005-04-16 15:20:36 -070050
Joe Perches475be4d2012-02-19 19:52:38 -080051 return avmcs_config(p_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070052} /* avmcs_attach */
53
Linus Torvalds1da177e2005-04-16 15:20:36 -070054
Dominik Brodowskifba395e2006-03-31 17:21:06 +020055static void avmcs_detach(struct pcmcia_device *link)
Linus Torvalds1da177e2005-04-16 15:20:36 -070056{
Dominik Brodowskicc3b4862005-11-14 21:23:14 +010057 avmcs_release(link);
Linus Torvalds1da177e2005-04-16 15:20:36 -070058} /* avmcs_detach */
59
Dominik Brodowski00990e72010-07-30 13:13:46 +020060static int avmcs_configcheck(struct pcmcia_device *p_dev, void *priv_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -070061{
Dominik Brodowski00990e72010-07-30 13:13:46 +020062 p_dev->resource[0]->end = 16;
63 p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
64 p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;
Linus Torvalds1da177e2005-04-16 15:20:36 -070065
Dominik Brodowski90abdc32010-07-24 17:23:51 +020066 return pcmcia_request_io(p_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070067}
68
Dominik Brodowski15b99ac2006-03-31 17:26:06 +020069static int avmcs_config(struct pcmcia_device *link)
Linus Torvalds1da177e2005-04-16 15:20:36 -070070{
Joe Perches475be4d2012-02-19 19:52:38 -080071 int i = -1;
72 char devname[128];
73 int cardtype;
74 int (*addcard)(unsigned int port, unsigned irq);
Dominik Brodowskifba395e2006-03-31 17:21:06 +020075
Joe Perches475be4d2012-02-19 19:52:38 -080076 devname[0] = 0;
77 if (link->prod_id[1])
78 strlcpy(devname, link->prod_id[1], sizeof(devname));
Dominik Brodowski50db3fd2006-01-15 10:05:19 +010079
Linus Torvalds1da177e2005-04-16 15:20:36 -070080 /*
Joe Perches475be4d2012-02-19 19:52:38 -080081 * find IO port
82 */
83 if (pcmcia_loop_config(link, avmcs_configcheck, NULL))
84 return -ENODEV;
85
86 do {
87 if (!link->irq) {
88 /* undo */
89 pcmcia_disable_device(link);
90 break;
91 }
92
93 /*
94 * configure the PCMCIA socket
95 */
96 i = pcmcia_enable_device(link);
97 if (i != 0) {
98 pcmcia_disable_device(link);
99 break;
100 }
101
102 } while (0);
103
104 if (devname[0]) {
105 char *s = strrchr(devname, ' ');
106 if (!s)
107 s = devname;
108 else s++;
109 if (strcmp("M1", s) == 0) {
110 cardtype = AVM_CARDTYPE_M1;
111 } else if (strcmp("M2", s) == 0) {
112 cardtype = AVM_CARDTYPE_M2;
113 } else {
114 cardtype = AVM_CARDTYPE_B1;
115 }
116 } else
117 cardtype = AVM_CARDTYPE_B1;
118
119 /* If any step failed, release any partially configured state */
Dominik Brodowski4c89e882008-08-03 10:07:45 +0200120 if (i != 0) {
Joe Perches475be4d2012-02-19 19:52:38 -0800121 avmcs_release(link);
122 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700123 }
124
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125
Joe Perches475be4d2012-02-19 19:52:38 -0800126 switch (cardtype) {
127 case AVM_CARDTYPE_M1: addcard = b1pcmcia_addcard_m1; break;
128 case AVM_CARDTYPE_M2: addcard = b1pcmcia_addcard_m2; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129 default:
Joe Perches475be4d2012-02-19 19:52:38 -0800130 case AVM_CARDTYPE_B1: addcard = b1pcmcia_addcard_b1; break;
131 }
132 if ((i = (*addcard)(link->resource[0]->start, link->irq)) < 0) {
133 dev_err(&link->dev,
134 "avm_cs: failed to add AVM-Controller at i/o %#x, irq %d\n",
135 (unsigned int) link->resource[0]->start, link->irq);
136 avmcs_release(link);
137 return -ENODEV;
138 }
139 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140
141} /* avmcs_config */
142
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143
Dominik Brodowskifba395e2006-03-31 17:21:06 +0200144static void avmcs_release(struct pcmcia_device *link)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145{
Dominik Brodowski9a017a92010-07-24 15:58:54 +0200146 b1pcmcia_delcard(link->resource[0]->start, link->irq);
Dominik Brodowskifba395e2006-03-31 17:21:06 +0200147 pcmcia_disable_device(link);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148} /* avmcs_release */
149
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150
Joe Perches25f8f542011-05-03 19:29:01 -0700151static const struct pcmcia_device_id avmcs_ids[] = {
Dominik Brodowskia13bcf02005-06-27 16:28:35 -0700152 PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335),
153 PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M1", 0x95d42008, 0x81e10430),
154 PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M2", 0x95d42008, 0x18e8558a),
155 PCMCIA_DEVICE_NULL
156};
157MODULE_DEVICE_TABLE(pcmcia, avmcs_ids);
158
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159static struct pcmcia_driver avmcs_driver = {
160 .owner = THIS_MODULE,
Dominik Brodowski2e9b9812010-08-08 11:36:26 +0200161 .name = "avm_cs",
Dominik Brodowski15b99ac2006-03-31 17:26:06 +0200162 .probe = avmcs_probe,
Dominik Brodowskicc3b4862005-11-14 21:23:14 +0100163 .remove = avmcs_detach,
Dominik Brodowskia13bcf02005-06-27 16:28:35 -0700164 .id_table = avmcs_ids,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165};
166
167static int __init avmcs_init(void)
168{
169 return pcmcia_register_driver(&avmcs_driver);
170}
171
172static void __exit avmcs_exit(void)
173{
174 pcmcia_unregister_driver(&avmcs_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175}
176
177module_init(avmcs_init);
178module_exit(avmcs_exit);