[PATCH] pcmcia: add return value to _config() functions
[linux-2.6.git] / 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         struct pcmcia_device    *p_dev;
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 int parport_config(struct pcmcia_device *link);
92 static void parport_cs_release(struct pcmcia_device *);
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_probe(struct pcmcia_device *link)
103 {
104     parport_info_t *info;
105
106     DEBUG(0, "parport_attach()\n");
107
108     /* Create new parport device */
109     info = kmalloc(sizeof(*info), GFP_KERNEL);
110     if (!info) return -ENOMEM;
111     memset(info, 0, sizeof(*info));
112     link->priv = info;
113     info->p_dev = link;
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.IntType = INT_MEMORY_AND_IO;
121
122     link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
123     return parport_config(link);
124 } /* parport_attach */
125
126 /*======================================================================
127
128     This deletes a driver "instance".  The device is de-registered
129     with Card Services.  If it has been released, all local data
130     structures are freed.  Otherwise, the structures will be freed
131     when the device is released.
132
133 ======================================================================*/
134
135 static void parport_detach(struct pcmcia_device *link)
136 {
137     DEBUG(0, "parport_detach(0x%p)\n", link);
138
139     if (link->state & DEV_CONFIG)
140         parport_cs_release(link);
141
142     kfree(link->priv);
143 } /* parport_detach */
144
145 /*======================================================================
146
147     parport_config() is scheduled to run after a CARD_INSERTION event
148     is received, to configure the PCMCIA socket, and to make the
149     parport device available to the system.
150
151 ======================================================================*/
152
153 #define CS_CHECK(fn, ret) \
154 do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
155
156 static int parport_config(struct pcmcia_device *link)
157 {
158     parport_info_t *info = link->priv;
159     tuple_t tuple;
160     u_short buf[128];
161     cisparse_t parse;
162     cistpl_cftable_entry_t *cfg = &parse.cftable_entry;
163     cistpl_cftable_entry_t dflt = { 0 };
164     struct parport *p;
165     int last_ret, last_fn;
166     
167     DEBUG(0, "parport_config(0x%p)\n", link);
168     
169     tuple.TupleData = (cisdata_t *)buf;
170     tuple.TupleOffset = 0; tuple.TupleDataMax = 255;
171     tuple.Attributes = 0;
172     tuple.DesiredTuple = CISTPL_CONFIG;
173     CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
174     CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
175     CS_CHECK(ParseTuple, pcmcia_parse_tuple(link, &tuple, &parse));
176     link->conf.ConfigBase = parse.config.base;
177     link->conf.Present = parse.config.rmask[0];
178     
179     /* Configure card */
180     link->state |= DEV_CONFIG;
181
182     tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
183     tuple.Attributes = 0;
184     CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
185     while (1) {
186         if (pcmcia_get_tuple_data(link, &tuple) != 0 ||
187                 pcmcia_parse_tuple(link, &tuple, &parse) != 0)
188             goto next_entry;
189
190         if ((cfg->io.nwin > 0) || (dflt.io.nwin > 0)) {
191             cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
192             link->conf.ConfigIndex = cfg->index;
193             if (epp_mode)
194                 link->conf.ConfigIndex |= FORCE_EPP_MODE;
195             link->io.BasePort1 = io->win[0].base;
196             link->io.NumPorts1 = io->win[0].len;
197             link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
198             if (io->nwin == 2) {
199                 link->io.BasePort2 = io->win[1].base;
200                 link->io.NumPorts2 = io->win[1].len;
201             }
202             if (pcmcia_request_io(link, &link->io) != 0)
203                 goto next_entry;
204             /* If we've got this far, we're done */
205             break;
206         }
207         
208     next_entry:
209         if (cfg->flags & CISTPL_CFTABLE_DEFAULT) dflt = *cfg;
210         CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(link, &tuple));
211     }
212     
213     CS_CHECK(RequestIRQ, pcmcia_request_irq(link, &link->irq));
214     CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));
215
216     p = parport_pc_probe_port(link->io.BasePort1, link->io.BasePort2,
217                               link->irq.AssignedIRQ, PARPORT_DMA_NONE,
218                               NULL);
219     if (p == NULL) {
220         printk(KERN_NOTICE "parport_cs: parport_pc_probe_port() at "
221                "0x%3x, irq %u failed\n", link->io.BasePort1,
222                link->irq.AssignedIRQ);
223         goto failed;
224     }
225
226     p->modes |= PARPORT_MODE_PCSPP;
227     if (epp_mode)
228         p->modes |= PARPORT_MODE_TRISTATE | PARPORT_MODE_EPP;
229     info->ndev = 1;
230     info->node.major = LP_MAJOR;
231     info->node.minor = p->number;
232     info->port = p;
233     strcpy(info->node.dev_name, p->name);
234     link->dev_node = &info->node;
235
236     link->state &= ~DEV_CONFIG_PENDING;
237     return 0;
238
239 cs_failed:
240     cs_error(link, last_fn, last_ret);
241 failed:
242     parport_cs_release(link);
243     link->state &= ~DEV_CONFIG_PENDING;
244     return -ENODEV;
245 } /* parport_config */
246
247 /*======================================================================
248
249     After a card is removed, parport_cs_release() will unregister the
250     device, and release the PCMCIA configuration.  If the device is
251     still open, this will be postponed until it is closed.
252     
253 ======================================================================*/
254
255 void parport_cs_release(struct pcmcia_device *link)
256 {
257         parport_info_t *info = link->priv;
258
259         DEBUG(0, "parport_release(0x%p)\n", link);
260
261         if (info->ndev) {
262                 struct parport *p = info->port;
263                 parport_pc_unregister_port(p);
264         }
265         info->ndev = 0;
266
267         pcmcia_disable_device(link);
268 } /* parport_cs_release */
269
270
271 static struct pcmcia_device_id parport_ids[] = {
272         PCMCIA_DEVICE_FUNC_ID(3),
273         PCMCIA_DEVICE_MANF_CARD(0x0137, 0x0003),
274         PCMCIA_DEVICE_NULL
275 };
276 MODULE_DEVICE_TABLE(pcmcia, parport_ids);
277
278 static struct pcmcia_driver parport_cs_driver = {
279         .owner          = THIS_MODULE,
280         .drv            = {
281                 .name   = "parport_cs",
282         },
283         .probe          = parport_probe,
284         .remove         = parport_detach,
285         .id_table       = parport_ids,
286 };
287
288 static int __init init_parport_cs(void)
289 {
290         return pcmcia_register_driver(&parport_cs_driver);
291 }
292
293 static void __exit exit_parport_cs(void)
294 {
295         pcmcia_unregister_driver(&parport_cs_driver);
296 }
297
298 module_init(init_parport_cs);
299 module_exit(exit_parport_cs);