rt2x00: Don't leak mem in error path of rt2x00lib_request_firmware()
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / parport / parport_cs.c
blob787ebdeae31032b853e6e2fce73750f4bf5e4e91
1 /*======================================================================
3 A driver for PCMCIA parallel port adapters
5 (specifically, for the Quatech SPP-100 EPP card: other cards will
6 probably require driver tweaks)
8 parport_cs.c 1.29 2002/10/11 06:57:41
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/
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.
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.
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.
35 ======================================================================*/
37 #include <linux/kernel.h>
38 #include <linux/module.h>
39 #include <linux/init.h>
40 #include <linux/ptrace.h>
41 #include <linux/slab.h>
42 #include <linux/string.h>
43 #include <linux/timer.h>
44 #include <linux/ioport.h>
45 #include <linux/major.h>
46 #include <linux/interrupt.h>
48 #include <linux/parport.h>
49 #include <linux/parport_pc.h>
51 #include <pcmcia/cistpl.h>
52 #include <pcmcia/ds.h>
53 #include <pcmcia/cisreg.h>
54 #include <pcmcia/ciscode.h>
56 /*====================================================================*/
58 /* Module parameters */
60 MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
61 MODULE_DESCRIPTION("PCMCIA parallel port card driver");
62 MODULE_LICENSE("Dual MPL/GPL");
64 #define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0)
66 INT_MODULE_PARM(epp_mode, 1);
69 /*====================================================================*/
71 #define FORCE_EPP_MODE 0x08
73 typedef struct parport_info_t {
74 struct pcmcia_device *p_dev;
75 int ndev;
76 struct parport *port;
77 } parport_info_t;
79 static void parport_detach(struct pcmcia_device *p_dev);
80 static int parport_config(struct pcmcia_device *link);
81 static void parport_cs_release(struct pcmcia_device *);
83 static int parport_probe(struct pcmcia_device *link)
85 parport_info_t *info;
87 dev_dbg(&link->dev, "parport_attach()\n");
89 /* Create new parport device */
90 info = kzalloc(sizeof(*info), GFP_KERNEL);
91 if (!info) return -ENOMEM;
92 link->priv = info;
93 info->p_dev = link;
95 link->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO;
97 return parport_config(link);
98 } /* parport_attach */
100 static void parport_detach(struct pcmcia_device *link)
102 dev_dbg(&link->dev, "parport_detach\n");
104 parport_cs_release(link);
106 kfree(link->priv);
107 } /* parport_detach */
109 static int parport_config_check(struct pcmcia_device *p_dev, void *priv_data)
111 p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
112 p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;
113 p_dev->resource[1]->flags &= ~IO_DATA_PATH_WIDTH;
114 p_dev->resource[1]->flags |= IO_DATA_PATH_WIDTH_8;
116 return pcmcia_request_io(p_dev);
119 static int parport_config(struct pcmcia_device *link)
121 parport_info_t *info = link->priv;
122 struct parport *p;
123 int ret;
125 dev_dbg(&link->dev, "parport_config\n");
127 if (epp_mode)
128 link->config_index |= FORCE_EPP_MODE;
130 ret = pcmcia_loop_config(link, parport_config_check, NULL);
131 if (ret)
132 goto failed;
134 if (!link->irq)
135 goto failed;
136 ret = pcmcia_enable_device(link);
137 if (ret)
138 goto failed;
140 p = parport_pc_probe_port(link->resource[0]->start,
141 link->resource[1]->start,
142 link->irq, PARPORT_DMA_NONE,
143 &link->dev, IRQF_SHARED);
144 if (p == NULL) {
145 printk(KERN_NOTICE "parport_cs: parport_pc_probe_port() at "
146 "0x%3x, irq %u failed\n",
147 (unsigned int) link->resource[0]->start,
148 link->irq);
149 goto failed;
152 p->modes |= PARPORT_MODE_PCSPP;
153 if (epp_mode)
154 p->modes |= PARPORT_MODE_TRISTATE | PARPORT_MODE_EPP;
155 info->ndev = 1;
156 info->port = p;
158 return 0;
160 failed:
161 parport_cs_release(link);
162 return -ENODEV;
163 } /* parport_config */
165 static void parport_cs_release(struct pcmcia_device *link)
167 parport_info_t *info = link->priv;
169 dev_dbg(&link->dev, "parport_release\n");
171 if (info->ndev) {
172 struct parport *p = info->port;
173 parport_pc_unregister_port(p);
175 info->ndev = 0;
177 pcmcia_disable_device(link);
178 } /* parport_cs_release */
181 static struct pcmcia_device_id parport_ids[] = {
182 PCMCIA_DEVICE_FUNC_ID(3),
183 PCMCIA_MFC_DEVICE_PROD_ID12(1,"Elan","Serial+Parallel Port: SP230",0x3beb8cf2,0xdb9e58bc),
184 PCMCIA_DEVICE_MANF_CARD(0x0137, 0x0003),
185 PCMCIA_DEVICE_NULL
187 MODULE_DEVICE_TABLE(pcmcia, parport_ids);
189 static struct pcmcia_driver parport_cs_driver = {
190 .owner = THIS_MODULE,
191 .name = "parport_cs",
192 .probe = parport_probe,
193 .remove = parport_detach,
194 .id_table = parport_ids,
197 static int __init init_parport_cs(void)
199 return pcmcia_register_driver(&parport_cs_driver);
202 static void __exit exit_parport_cs(void)
204 pcmcia_unregister_driver(&parport_cs_driver);
207 module_init(init_parport_cs);
208 module_exit(exit_parport_cs);