[PATCH] pcmcia: add pcmcia_disable_device
[linux-2.6] / drivers / parport / parport_cs.c
1 /*======================================================================
2
3     A driver for PCMCIA parallel port adapters
4
5     (specifically, for the Quatech SPP-100 EPP card: other cards will
6     probably require driver tweaks)
7     
8     parport_cs.c 1.29 2002/10/11 06:57:41
9
10     The contents of this file are subject to the Mozilla Public
11     License Version 1.1 (the "License"); you may not use this file
12     except in compliance with the License. You may obtain a copy of
13     the License at http://www.mozilla.org/MPL/
14
15     Software distributed under the License is distributed on an "AS
16     IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
17     implied. See the License for the specific language governing
18     rights and limitations under the License.
19
20     The initial developer of the original code is David A. Hinds
21     <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
22     are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.
23
24     Alternatively, the contents of this file may be used under the
25     terms of the GNU General Public License version 2 (the "GPL"), in
26     which case the provisions of the GPL are applicable instead of the
27     above.  If you wish to allow the use of your version of this file
28     only under the terms of the GPL and not to allow others to use
29     your version of this file under the MPL, indicate your decision
30     by deleting the provisions above and replace them with the notice
31     and other provisions required by the GPL.  If you do not delete
32     the provisions above, a recipient may use your version of this
33     file under either the MPL or the GPL.
34     
35 ======================================================================*/
36
37 #include <linux/kernel.h>
38 #include <linux/module.h>
39 #include <linux/init.h>
40 #include <linux/sched.h>
41 #include <linux/ptrace.h>
42 #include <linux/slab.h>
43 #include <linux/string.h>
44 #include <linux/timer.h>
45 #include <linux/ioport.h>
46 #include <linux/major.h>
47
48 #include <linux/parport.h>
49 #include <linux/parport_pc.h>
50
51 #include <pcmcia/cs_types.h>
52 #include <pcmcia/cs.h>
53 #include <pcmcia/cistpl.h>
54 #include <pcmcia/ds.h>
55 #include <pcmcia/cisreg.h>
56 #include <pcmcia/ciscode.h>
57
58 /*====================================================================*/
59
60 /* Module parameters */
61
62 MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
63 MODULE_DESCRIPTION("PCMCIA parallel port card driver");
64 MODULE_LICENSE("Dual MPL/GPL");
65
66 #define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0)
67
68 INT_MODULE_PARM(epp_mode, 1);
69
70 #ifdef PCMCIA_DEBUG
71 INT_MODULE_PARM(pc_debug, PCMCIA_DEBUG);
72 #define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
73 static char *version =
74 "parport_cs.c 1.29 2002/10/11 06:57:41 (David Hinds)";
75 #else
76 #define DEBUG(n, args...)
77 #endif
78
79 /*====================================================================*/
80
81 #define FORCE_EPP_MODE  0x08
82
83 typedef struct parport_info_t {
84     dev_link_t          link;
85     int                 ndev;
86     dev_node_t          node;
87     struct parport      *port;
88 } parport_info_t;
89
90 static void parport_detach(struct pcmcia_device *p_dev);
91 static void parport_config(dev_link_t *link);
92 static void parport_cs_release(dev_link_t *);
93
94 /*======================================================================
95
96     parport_attach() creates an "instance" of the driver, allocating
97     local data structures for one device.  The device is registered
98     with Card Services.
99
100 ======================================================================*/
101
102 static int parport_attach(struct pcmcia_device *p_dev)
103 {
104     parport_info_t *info;
105     dev_link_t *link;
106
107     DEBUG(0, "parport_attach()\n");
108
109     /* Create new parport device */
110     info = kmalloc(sizeof(*info), GFP_KERNEL);
111     if (!info) return -ENOMEM;
112     memset(info, 0, sizeof(*info));
113     link = &info->link; link->priv = info;
114
115     link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
116     link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
117     link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
118     link->irq.IRQInfo1 = IRQ_LEVEL_ID;
119     link->conf.Attributes = CONF_ENABLE_IRQ;
120     link->conf.Vcc = 50;
121     link->conf.IntType = INT_MEMORY_AND_IO;
122
123     link->handle = p_dev;
124     p_dev->instance = link;
125
126     link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
127     parport_config(link);
128
129     return 0;
130 } /* parport_attach */
131
132 /*======================================================================
133
134     This deletes a driver "instance".  The device is de-registered
135     with Card Services.  If it has been released, all local data
136     structures are freed.  Otherwise, the structures will be freed
137     when the device is released.
138
139 ======================================================================*/
140
141 static void parport_detach(struct pcmcia_device *p_dev)
142 {
143     dev_link_t *link = dev_to_instance(p_dev);
144
145     DEBUG(0, "parport_detach(0x%p)\n", link);
146
147     if (link->state & DEV_CONFIG)
148         parport_cs_release(link);
149
150     kfree(link->priv);
151 } /* parport_detach */
152
153 /*======================================================================
154
155     parport_config() is scheduled to run after a CARD_INSERTION event
156     is received, to configure the PCMCIA socket, and to make the
157     parport device available to the system.
158
159 ======================================================================*/
160
161 #define CS_CHECK(fn, ret) \
162 do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
163
164 void parport_config(dev_link_t *link)
165 {
166     client_handle_t handle = link->handle;
167     parport_info_t *info = link->priv;
168     tuple_t tuple;
169     u_short buf[128];
170     cisparse_t parse;
171     config_info_t conf;
172     cistpl_cftable_entry_t *cfg = &parse.cftable_entry;
173     cistpl_cftable_entry_t dflt = { 0 };
174     struct parport *p;
175     int last_ret, last_fn;
176     
177     DEBUG(0, "parport_config(0x%p)\n", link);
178     
179     tuple.TupleData = (cisdata_t *)buf;
180     tuple.TupleOffset = 0; tuple.TupleDataMax = 255;
181     tuple.Attributes = 0;
182     tuple.DesiredTuple = CISTPL_CONFIG;
183     CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
184     CS_CHECK(GetTupleData, pcmcia_get_tuple_data(handle, &tuple));
185     CS_CHECK(ParseTuple, pcmcia_parse_tuple(handle, &tuple, &parse));
186     link->conf.ConfigBase = parse.config.base;
187     link->conf.Present = parse.config.rmask[0];
188     
189     /* Configure card */
190     link->state |= DEV_CONFIG;
191
192     /* Not sure if this is right... look up the current Vcc */
193     CS_CHECK(GetConfigurationInfo, pcmcia_get_configuration_info(handle, &conf));
194     
195     tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
196     tuple.Attributes = 0;
197     CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
198     while (1) {
199         if (pcmcia_get_tuple_data(handle, &tuple) != 0 ||
200                 pcmcia_parse_tuple(handle, &tuple, &parse) != 0)
201             goto next_entry;
202
203         if ((cfg->io.nwin > 0) || (dflt.io.nwin > 0)) {
204             cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
205             link->conf.ConfigIndex = cfg->index;
206             if (epp_mode)
207                 link->conf.ConfigIndex |= FORCE_EPP_MODE;
208             link->io.BasePort1 = io->win[0].base;
209             link->io.NumPorts1 = io->win[0].len;
210             link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
211             if (io->nwin == 2) {
212                 link->io.BasePort2 = io->win[1].base;
213                 link->io.NumPorts2 = io->win[1].len;
214             }
215             if (pcmcia_request_io(link->handle, &link->io) != 0)
216                 goto next_entry;
217             /* If we've got this far, we're done */
218             break;
219         }
220         
221     next_entry:
222         if (cfg->flags & CISTPL_CFTABLE_DEFAULT) dflt = *cfg;
223         CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(handle, &tuple));
224     }
225     
226     CS_CHECK(RequestIRQ, pcmcia_request_irq(handle, &link->irq));
227     CS_CHECK(RequestConfiguration, pcmcia_request_configuration(handle, &link->conf));
228
229     p = parport_pc_probe_port(link->io.BasePort1, link->io.BasePort2,
230                               link->irq.AssignedIRQ, PARPORT_DMA_NONE,
231                               NULL);
232     if (p == NULL) {
233         printk(KERN_NOTICE "parport_cs: parport_pc_probe_port() at "
234                "0x%3x, irq %u failed\n", link->io.BasePort1,
235                link->irq.AssignedIRQ);
236         goto failed;
237     }
238
239     p->modes |= PARPORT_MODE_PCSPP;
240     if (epp_mode)
241         p->modes |= PARPORT_MODE_TRISTATE | PARPORT_MODE_EPP;
242     info->ndev = 1;
243     info->node.major = LP_MAJOR;
244     info->node.minor = p->number;
245     info->port = p;
246     strcpy(info->node.dev_name, p->name);
247     link->dev = &info->node;
248
249     link->state &= ~DEV_CONFIG_PENDING;
250     return;
251     
252 cs_failed:
253     cs_error(link->handle, last_fn, last_ret);
254 failed:
255     parport_cs_release(link);
256     link->state &= ~DEV_CONFIG_PENDING;
257
258 } /* parport_config */
259
260 /*======================================================================
261
262     After a card is removed, parport_cs_release() will unregister the
263     device, and release the PCMCIA configuration.  If the device is
264     still open, this will be postponed until it is closed.
265     
266 ======================================================================*/
267
268 void parport_cs_release(dev_link_t *link)
269 {
270         parport_info_t *info = link->priv;
271
272         DEBUG(0, "parport_release(0x%p)\n", link);
273
274         if (info->ndev) {
275                 struct parport *p = info->port;
276                 parport_pc_unregister_port(p);
277         }
278         info->ndev = 0;
279
280         pcmcia_disable_device(link->handle);
281 } /* parport_cs_release */
282
283 static int parport_suspend(struct pcmcia_device *dev)
284 {
285         dev_link_t *link = dev_to_instance(dev);
286
287         link->state |= DEV_SUSPEND;
288         if (link->state & DEV_CONFIG)
289                 pcmcia_release_configuration(link->handle);
290
291         return 0;
292 }
293
294 static int parport_resume(struct pcmcia_device *dev)
295 {
296         dev_link_t *link = dev_to_instance(dev);
297
298         link->state &= ~DEV_SUSPEND;
299         if (DEV_OK(link))
300                 pcmcia_request_configuration(link->handle, &link->conf);
301
302         return 0;
303 }
304
305 static struct pcmcia_device_id parport_ids[] = {
306         PCMCIA_DEVICE_FUNC_ID(3),
307         PCMCIA_DEVICE_MANF_CARD(0x0137, 0x0003),
308         PCMCIA_DEVICE_NULL
309 };
310 MODULE_DEVICE_TABLE(pcmcia, parport_ids);
311
312 static struct pcmcia_driver parport_cs_driver = {
313         .owner          = THIS_MODULE,
314         .drv            = {
315                 .name   = "parport_cs",
316         },
317         .probe          = parport_attach,
318         .remove         = parport_detach,
319         .id_table       = parport_ids,
320         .suspend        = parport_suspend,
321         .resume         = parport_resume,
322 };
323
324 static int __init init_parport_cs(void)
325 {
326         return pcmcia_register_driver(&parport_cs_driver);
327 }
328
329 static void __exit exit_parport_cs(void)
330 {
331         pcmcia_unregister_driver(&parport_cs_driver);
332 }
333
334 module_init(init_parport_cs);
335 module_exit(exit_parport_cs);