1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/kernel.h>
20#include <linux/module.h>
21#include <linux/init.h>
22#include <linux/ptrace.h>
23#include <linux/slab.h>
24#include <linux/string.h>
25#include <linux/timer.h>
26#include <linux/ioport.h>
27#include <asm/io.h>
28#include <asm/system.h>
29
30#include <pcmcia/cistpl.h>
31#include <pcmcia/cisreg.h>
32#include <pcmcia/ds.h>
33#include "hisax_cfg.h"
34
35MODULE_DESCRIPTION("ISDN4Linux: PCMCIA client driver for Teles PCMCIA cards");
36MODULE_AUTHOR("Christof Petig, christof.petig@wtal.de, Karsten Keil, kkeil@suse.de");
37MODULE_LICENSE("GPL");
38
39
40
41
42
43
44static int protocol = 2;
45module_param(protocol, int, 0);
46
47static int teles_cs_config(struct pcmcia_device *link) __devinit ;
48static void teles_cs_release(struct pcmcia_device *link);
49static void teles_detach(struct pcmcia_device *p_dev) __devexit ;
50
51typedef struct local_info_t {
52 struct pcmcia_device *p_dev;
53 int busy;
54 int cardnr;
55} local_info_t;
56
57static int __devinit teles_probe(struct pcmcia_device *link)
58{
59 local_info_t *local;
60
61 dev_dbg(&link->dev, "teles_attach()\n");
62
63
64 local = kzalloc(sizeof(local_info_t), GFP_KERNEL);
65 if (!local) return -ENOMEM;
66 local->cardnr = -1;
67
68 local->p_dev = link;
69 link->priv = local;
70
71 link->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO;
72
73 return teles_cs_config(link);
74}
75
76static void __devexit teles_detach(struct pcmcia_device *link)
77{
78 local_info_t *info = link->priv;
79
80 dev_dbg(&link->dev, "teles_detach(0x%p)\n", link);
81
82 info->busy = 1;
83 teles_cs_release(link);
84
85 kfree(info);
86}
87
88static int teles_cs_configcheck(struct pcmcia_device *p_dev, void *priv_data)
89{
90 int j;
91
92 p_dev->io_lines = 5;
93 p_dev->resource[0]->end = 96;
94 p_dev->resource[0]->flags &= IO_DATA_PATH_WIDTH;
95 p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_AUTO;
96
97 if ((p_dev->resource[0]->end) && p_dev->resource[0]->start) {
98 printk(KERN_INFO "(teles_cs: looks like the 96 model)\n");
99 if (!pcmcia_request_io(p_dev))
100 return 0;
101 } else {
102 printk(KERN_INFO "(teles_cs: looks like the 97 model)\n");
103 for (j = 0x2f0; j > 0x100; j -= 0x10) {
104 p_dev->resource[0]->start = j;
105 if (!pcmcia_request_io(p_dev))
106 return 0;
107 }
108 }
109 return -ENODEV;
110}
111
112static int __devinit teles_cs_config(struct pcmcia_device *link)
113{
114 int i;
115 IsdnCard_t icard;
116
117 dev_dbg(&link->dev, "teles_config(0x%p)\n", link);
118
119 i = pcmcia_loop_config(link, teles_cs_configcheck, NULL);
120 if (i != 0)
121 goto cs_failed;
122
123 if (!link->irq)
124 goto cs_failed;
125
126 i = pcmcia_enable_device(link);
127 if (i != 0)
128 goto cs_failed;
129
130 icard.para[0] = link->irq;
131 icard.para[1] = link->resource[0]->start;
132 icard.protocol = protocol;
133 icard.typ = ISDN_CTYPE_TELESPCMCIA;
134
135 i = hisax_init_pcmcia(link, &(((local_info_t*)link->priv)->busy), &icard);
136 if (i < 0) {
137 printk(KERN_ERR "teles_cs: failed to initialize Teles PCMCIA %d at i/o %#x\n",
138 i, (unsigned int) link->resource[0]->start);
139 teles_cs_release(link);
140 return -ENODEV;
141 }
142
143 ((local_info_t*)link->priv)->cardnr = i;
144 return 0;
145
146cs_failed:
147 teles_cs_release(link);
148 return -ENODEV;
149}
150
151static void teles_cs_release(struct pcmcia_device *link)
152{
153 local_info_t *local = link->priv;
154
155 dev_dbg(&link->dev, "teles_cs_release(0x%p)\n", link);
156
157 if (local) {
158 if (local->cardnr >= 0) {
159
160 HiSax_closecard(local->cardnr);
161 }
162 }
163
164 pcmcia_disable_device(link);
165}
166
167static int teles_suspend(struct pcmcia_device *link)
168{
169 local_info_t *dev = link->priv;
170
171 dev->busy = 1;
172
173 return 0;
174}
175
176static int teles_resume(struct pcmcia_device *link)
177{
178 local_info_t *dev = link->priv;
179
180 dev->busy = 0;
181
182 return 0;
183}
184
185
186static const struct pcmcia_device_id teles_ids[] = {
187 PCMCIA_DEVICE_PROD_ID12("TELES", "S0/PC", 0x67b50eae, 0xe9e70119),
188 PCMCIA_DEVICE_NULL,
189};
190MODULE_DEVICE_TABLE(pcmcia, teles_ids);
191
192static struct pcmcia_driver teles_cs_driver = {
193 .owner = THIS_MODULE,
194 .name = "teles_cs",
195 .probe = teles_probe,
196 .remove = __devexit_p(teles_detach),
197 .id_table = teles_ids,
198 .suspend = teles_suspend,
199 .resume = teles_resume,
200};
201
202static int __init init_teles_cs(void)
203{
204 return pcmcia_register_driver(&teles_cs_driver);
205}
206
207static void __exit exit_teles_cs(void)
208{
209 pcmcia_unregister_driver(&teles_cs_driver);
210}
211
212module_init(init_teles_cs);
213module_exit(exit_teles_cs);
214