[PATCH] ide: kmalloc + memset -> kzalloc conversion
[linux-2.6.git] / drivers / ide / legacy / ide-cs.c
1 /*======================================================================
2
3     A driver for PCMCIA IDE/ATA disk cards
4
5     ide-cs.c 1.3 2002/10/26 05:45:31
6
7     The contents of this file are subject to the Mozilla Public
8     License Version 1.1 (the "License"); you may not use this file
9     except in compliance with the License. You may obtain a copy of
10     the License at http://www.mozilla.org/MPL/
11
12     Software distributed under the License is distributed on an "AS
13     IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
14     implied. See the License for the specific language governing
15     rights and limitations under the License.
16
17     The initial developer of the original code is David A. Hinds
18     <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
19     are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.
20
21     Alternatively, the contents of this file may be used under the
22     terms of the GNU General Public License version 2 (the "GPL"), in
23     which case the provisions of the GPL are applicable instead of the
24     above.  If you wish to allow the use of your version of this file
25     only under the terms of the GPL and not to allow others to use
26     your version of this file under the MPL, indicate your decision
27     by deleting the provisions above and replace them with the notice
28     and other provisions required by the GPL.  If you do not delete
29     the provisions above, a recipient may use your version of this
30     file under either the MPL or the GPL.
31     
32 ======================================================================*/
33
34 #include <linux/module.h>
35 #include <linux/kernel.h>
36 #include <linux/init.h>
37 #include <linux/sched.h>
38 #include <linux/ptrace.h>
39 #include <linux/slab.h>
40 #include <linux/string.h>
41 #include <linux/timer.h>
42 #include <linux/ioport.h>
43 #include <linux/ide.h>
44 #include <linux/hdreg.h>
45 #include <linux/major.h>
46 #include <linux/delay.h>
47 #include <asm/io.h>
48 #include <asm/system.h>
49
50 #include <pcmcia/cs_types.h>
51 #include <pcmcia/cs.h>
52 #include <pcmcia/cistpl.h>
53 #include <pcmcia/ds.h>
54 #include <pcmcia/cisreg.h>
55 #include <pcmcia/ciscode.h>
56
57 /*====================================================================*/
58
59 /* Module parameters */
60
61 MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
62 MODULE_DESCRIPTION("PCMCIA ATA/IDE card driver");
63 MODULE_LICENSE("Dual MPL/GPL");
64
65 #define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0)
66
67 #ifdef PCMCIA_DEBUG
68 INT_MODULE_PARM(pc_debug, PCMCIA_DEBUG);
69 #define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
70 static char *version =
71 "ide-cs.c 1.3 2002/10/26 05:45:31 (David Hinds)";
72 #else
73 #define DEBUG(n, args...)
74 #endif
75
76 /*====================================================================*/
77
78 static const char ide_major[] = {
79     IDE0_MAJOR, IDE1_MAJOR, IDE2_MAJOR, IDE3_MAJOR,
80     IDE4_MAJOR, IDE5_MAJOR
81 };
82
83 typedef struct ide_info_t {
84     dev_link_t  link;
85     int         ndev;
86     dev_node_t  node;
87     int         hd;
88 } ide_info_t;
89
90 static void ide_release(dev_link_t *);
91 static int ide_event(event_t event, int priority,
92                      event_callback_args_t *args);
93
94 static dev_info_t dev_info = "ide-cs";
95
96 static dev_link_t *ide_attach(void);
97 static void ide_detach(dev_link_t *);
98
99 static dev_link_t *dev_list = NULL;
100
101 /*======================================================================
102
103     ide_attach() creates an "instance" of the driver, allocating
104     local data structures for one device.  The device is registered
105     with Card Services.
106
107 ======================================================================*/
108
109 static dev_link_t *ide_attach(void)
110 {
111     ide_info_t *info;
112     dev_link_t *link;
113     client_reg_t client_reg;
114     int ret;
115     
116     DEBUG(0, "ide_attach()\n");
117
118     /* Create new ide device */
119     info = kzalloc(sizeof(*info), GFP_KERNEL);
120     if (!info) return NULL;
121     link = &info->link; link->priv = info;
122
123     link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
124     link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
125     link->io.IOAddrLines = 3;
126     link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
127     link->irq.IRQInfo1 = IRQ_LEVEL_ID;
128     link->conf.Attributes = CONF_ENABLE_IRQ;
129     link->conf.Vcc = 50;
130     link->conf.IntType = INT_MEMORY_AND_IO;
131     
132     /* Register with Card Services */
133     link->next = dev_list;
134     dev_list = link;
135     client_reg.dev_info = &dev_info;
136     client_reg.Version = 0x0210;
137     client_reg.event_callback_args.client_data = link;
138     ret = pcmcia_register_client(&link->handle, &client_reg);
139     if (ret != CS_SUCCESS) {
140         cs_error(link->handle, RegisterClient, ret);
141         ide_detach(link);
142         return NULL;
143     }
144     
145     return link;
146 } /* ide_attach */
147
148 /*======================================================================
149
150     This deletes a driver "instance".  The device is de-registered
151     with Card Services.  If it has been released, all local data
152     structures are freed.  Otherwise, the structures will be freed
153     when the device is released.
154
155 ======================================================================*/
156
157 static void ide_detach(dev_link_t *link)
158 {
159     dev_link_t **linkp;
160     int ret;
161
162     DEBUG(0, "ide_detach(0x%p)\n", link);
163     
164     /* Locate device structure */
165     for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
166         if (*linkp == link) break;
167     if (*linkp == NULL)
168         return;
169
170     if (link->state & DEV_CONFIG)
171         ide_release(link);
172     
173     if (link->handle) {
174         ret = pcmcia_deregister_client(link->handle);
175         if (ret != CS_SUCCESS)
176             cs_error(link->handle, DeregisterClient, ret);
177     }
178     
179     /* Unlink, free device structure */
180     *linkp = link->next;
181     kfree(link->priv);
182     
183 } /* ide_detach */
184
185 static int idecs_register(unsigned long io, unsigned long ctl, unsigned long irq)
186 {
187     hw_regs_t hw;
188     memset(&hw, 0, sizeof(hw));
189     ide_init_hwif_ports(&hw, io, ctl, NULL);
190     hw.irq = irq;
191     hw.chipset = ide_pci;
192     return ide_register_hw_with_fixup(&hw, NULL, ide_undecoded_slave);
193 }
194
195 /*======================================================================
196
197     ide_config() is scheduled to run after a CARD_INSERTION event
198     is received, to configure the PCMCIA socket, and to make the
199     ide device available to the system.
200
201 ======================================================================*/
202
203 #define CS_CHECK(fn, ret) \
204 do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
205
206 static void ide_config(dev_link_t *link)
207 {
208     client_handle_t handle = link->handle;
209     ide_info_t *info = link->priv;
210     tuple_t tuple;
211     struct {
212         u_short         buf[128];
213         cisparse_t      parse;
214         config_info_t   conf;
215         cistpl_cftable_entry_t dflt;
216     } *stk = NULL;
217     cistpl_cftable_entry_t *cfg;
218     int i, pass, last_ret = 0, last_fn = 0, hd, is_kme = 0;
219     unsigned long io_base, ctl_base;
220
221     DEBUG(0, "ide_config(0x%p)\n", link);
222
223     stk = kzalloc(sizeof(*stk), GFP_KERNEL);
224     if (!stk) goto err_mem;
225     cfg = &stk->parse.cftable_entry;
226
227     tuple.TupleData = (cisdata_t *)&stk->buf;
228     tuple.TupleOffset = 0;
229     tuple.TupleDataMax = 255;
230     tuple.Attributes = 0;
231     tuple.DesiredTuple = CISTPL_CONFIG;
232     CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
233     CS_CHECK(GetTupleData, pcmcia_get_tuple_data(handle, &tuple));
234     CS_CHECK(ParseTuple, pcmcia_parse_tuple(handle, &tuple, &stk->parse));
235     link->conf.ConfigBase = stk->parse.config.base;
236     link->conf.Present = stk->parse.config.rmask[0];
237
238     tuple.DesiredTuple = CISTPL_MANFID;
239     if (!pcmcia_get_first_tuple(handle, &tuple) &&
240         !pcmcia_get_tuple_data(handle, &tuple) &&
241         !pcmcia_parse_tuple(handle, &tuple, &stk->parse))
242         is_kme = ((stk->parse.manfid.manf == MANFID_KME) &&
243                   ((stk->parse.manfid.card == PRODID_KME_KXLC005_A) ||
244                    (stk->parse.manfid.card == PRODID_KME_KXLC005_B)));
245
246     /* Configure card */
247     link->state |= DEV_CONFIG;
248
249     /* Not sure if this is right... look up the current Vcc */
250     CS_CHECK(GetConfigurationInfo, pcmcia_get_configuration_info(handle, &stk->conf));
251     link->conf.Vcc = stk->conf.Vcc;
252
253     pass = io_base = ctl_base = 0;
254     tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
255     tuple.Attributes = 0;
256     CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
257     while (1) {
258         if (pcmcia_get_tuple_data(handle, &tuple) != 0) goto next_entry;
259         if (pcmcia_parse_tuple(handle, &tuple, &stk->parse) != 0) goto next_entry;
260
261         /* Check for matching Vcc, unless we're desperate */
262         if (!pass) {
263             if (cfg->vcc.present & (1 << CISTPL_POWER_VNOM)) {
264                 if (stk->conf.Vcc != cfg->vcc.param[CISTPL_POWER_VNOM] / 10000)
265                     goto next_entry;
266             } else if (stk->dflt.vcc.present & (1 << CISTPL_POWER_VNOM)) {
267                 if (stk->conf.Vcc != stk->dflt.vcc.param[CISTPL_POWER_VNOM] / 10000)
268                     goto next_entry;
269             }
270         }
271
272         if (cfg->vpp1.present & (1 << CISTPL_POWER_VNOM))
273             link->conf.Vpp1 = link->conf.Vpp2 =
274                 cfg->vpp1.param[CISTPL_POWER_VNOM] / 10000;
275         else if (stk->dflt.vpp1.present & (1 << CISTPL_POWER_VNOM))
276             link->conf.Vpp1 = link->conf.Vpp2 =
277                 stk->dflt.vpp1.param[CISTPL_POWER_VNOM] / 10000;
278
279         if ((cfg->io.nwin > 0) || (stk->dflt.io.nwin > 0)) {
280             cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &stk->dflt.io;
281             link->conf.ConfigIndex = cfg->index;
282             link->io.BasePort1 = io->win[0].base;
283             link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
284             if (!(io->flags & CISTPL_IO_16BIT))
285                 link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
286             if (io->nwin == 2) {
287                 link->io.NumPorts1 = 8;
288                 link->io.BasePort2 = io->win[1].base;
289                 link->io.NumPorts2 = (is_kme) ? 2 : 1;
290                 if (pcmcia_request_io(link->handle, &link->io) != 0)
291                         goto next_entry;
292                 io_base = link->io.BasePort1;
293                 ctl_base = link->io.BasePort2;
294             } else if ((io->nwin == 1) && (io->win[0].len >= 16)) {
295                 link->io.NumPorts1 = io->win[0].len;
296                 link->io.NumPorts2 = 0;
297                 if (pcmcia_request_io(link->handle, &link->io) != 0)
298                         goto next_entry;
299                 io_base = link->io.BasePort1;
300                 ctl_base = link->io.BasePort1 + 0x0e;
301             } else goto next_entry;
302             /* If we've got this far, we're done */
303             break;
304         }
305
306     next_entry:
307         if (cfg->flags & CISTPL_CFTABLE_DEFAULT)
308             memcpy(&stk->dflt, cfg, sizeof(stk->dflt));
309         if (pass) {
310             CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(handle, &tuple));
311         } else if (pcmcia_get_next_tuple(handle, &tuple) != 0) {
312             CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
313             memset(&stk->dflt, 0, sizeof(stk->dflt));
314             pass++;
315         }
316     }
317
318     CS_CHECK(RequestIRQ, pcmcia_request_irq(handle, &link->irq));
319     CS_CHECK(RequestConfiguration, pcmcia_request_configuration(handle, &link->conf));
320
321     /* disable drive interrupts during IDE probe */
322     outb(0x02, ctl_base);
323
324     /* special setup for KXLC005 card */
325     if (is_kme)
326         outb(0x81, ctl_base+1);
327
328     /* retry registration in case device is still spinning up */
329     for (hd = -1, i = 0; i < 10; i++) {
330         hd = idecs_register(io_base, ctl_base, link->irq.AssignedIRQ);
331         if (hd >= 0) break;
332         if (link->io.NumPorts1 == 0x20) {
333             outb(0x02, ctl_base + 0x10);
334             hd = idecs_register(io_base + 0x10, ctl_base + 0x10,
335                                 link->irq.AssignedIRQ);
336             if (hd >= 0) {
337                 io_base += 0x10;
338                 ctl_base += 0x10;
339                 break;
340             }
341         }
342         msleep(100);
343     }
344
345     if (hd < 0) {
346         printk(KERN_NOTICE "ide-cs: ide_register() at 0x%3lx & 0x%3lx"
347                ", irq %u failed\n", io_base, ctl_base,
348                link->irq.AssignedIRQ);
349         goto failed;
350     }
351
352     info->ndev = 1;
353     sprintf(info->node.dev_name, "hd%c", 'a' + (hd * 2));
354     info->node.major = ide_major[hd];
355     info->node.minor = 0;
356     info->hd = hd;
357     link->dev = &info->node;
358     printk(KERN_INFO "ide-cs: %s: Vcc = %d.%d, Vpp = %d.%d\n",
359            info->node.dev_name, link->conf.Vcc / 10, link->conf.Vcc % 10,
360            link->conf.Vpp1 / 10, link->conf.Vpp1 % 10);
361
362     link->state &= ~DEV_CONFIG_PENDING;
363     kfree(stk);
364     return;
365
366 err_mem:
367     printk(KERN_NOTICE "ide-cs: ide_config failed memory allocation\n");
368     goto failed;
369
370 cs_failed:
371     cs_error(link->handle, last_fn, last_ret);
372 failed:
373     kfree(stk);
374     ide_release(link);
375     link->state &= ~DEV_CONFIG_PENDING;
376 } /* ide_config */
377
378 /*======================================================================
379
380     After a card is removed, ide_release() will unregister the net
381     device, and release the PCMCIA configuration.  If the device is
382     still open, this will be postponed until it is closed.
383     
384 ======================================================================*/
385
386 void ide_release(dev_link_t *link)
387 {
388     ide_info_t *info = link->priv;
389     
390     DEBUG(0, "ide_release(0x%p)\n", link);
391
392     if (info->ndev) {
393         /* FIXME: if this fails we need to queue the cleanup somehow
394            -- need to investigate the required PCMCIA magic */
395         ide_unregister(info->hd);
396     }
397     info->ndev = 0;
398     link->dev = NULL;
399     
400     pcmcia_release_configuration(link->handle);
401     pcmcia_release_io(link->handle, &link->io);
402     pcmcia_release_irq(link->handle, &link->irq);
403     
404     link->state &= ~DEV_CONFIG;
405
406 } /* ide_release */
407
408 /*======================================================================
409
410     The card status event handler.  Mostly, this schedules other
411     stuff to run after an event is received.  A CARD_REMOVAL event
412     also sets some flags to discourage the ide drivers from
413     talking to the ports.
414     
415 ======================================================================*/
416
417 int ide_event(event_t event, int priority,
418               event_callback_args_t *args)
419 {
420     dev_link_t *link = args->client_data;
421
422     DEBUG(1, "ide_event(0x%06x)\n", event);
423     
424     switch (event) {
425     case CS_EVENT_CARD_REMOVAL:
426         link->state &= ~DEV_PRESENT;
427         if (link->state & DEV_CONFIG)
428                 ide_release(link);
429         break;
430     case CS_EVENT_CARD_INSERTION:
431         link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
432         ide_config(link);
433         break;
434     case CS_EVENT_PM_SUSPEND:
435         link->state |= DEV_SUSPEND;
436         /* Fall through... */
437     case CS_EVENT_RESET_PHYSICAL:
438         if (link->state & DEV_CONFIG)
439             pcmcia_release_configuration(link->handle);
440         break;
441     case CS_EVENT_PM_RESUME:
442         link->state &= ~DEV_SUSPEND;
443         /* Fall through... */
444     case CS_EVENT_CARD_RESET:
445         if (DEV_OK(link))
446             pcmcia_request_configuration(link->handle, &link->conf);
447         break;
448     }
449     return 0;
450 } /* ide_event */
451
452 static struct pcmcia_device_id ide_ids[] = {
453         PCMCIA_DEVICE_FUNC_ID(4),
454         PCMCIA_DEVICE_MANF_CARD(0x0032, 0x0704),
455         PCMCIA_DEVICE_MANF_CARD(0x0045, 0x0401),
456         PCMCIA_DEVICE_MANF_CARD(0x0098, 0x0000),        /* Toshiba */
457         PCMCIA_DEVICE_MANF_CARD(0x00a4, 0x002d),
458         PCMCIA_DEVICE_MANF_CARD(0x00ce, 0x0000),        /* Samsung */
459         PCMCIA_DEVICE_MANF_CARD(0x2080, 0x0001),
460         PCMCIA_DEVICE_MANF_CARD(0x4e01, 0x0200),        /* Lexar */
461         PCMCIA_DEVICE_PROD_ID123("Caravelle", "PSC-IDE ", "PSC000", 0x8c36137c, 0xd0693ab8, 0x2768a9f0),
462         PCMCIA_DEVICE_PROD_ID123("CDROM", "IDE", "MCD-601p", 0x1b9179ca, 0xede88951, 0x0d902f74),
463         PCMCIA_DEVICE_PROD_ID123("PCMCIA", "IDE CARD", "F1", 0x281f1c5d, 0x1907960c, 0xf7fde8b9),
464         PCMCIA_DEVICE_PROD_ID12("ARGOSY", "CD-ROM", 0x78f308dc, 0x66536591),
465         PCMCIA_DEVICE_PROD_ID12("ARGOSY", "PnPIDE", 0x78f308dc, 0x0c694728),
466         PCMCIA_DEVICE_PROD_ID12("CNF CD-M", "CD-ROM", 0x7d93b852, 0x66536591),
467         PCMCIA_DEVICE_PROD_ID12("Creative Technology Ltd.", "PCMCIA CD-ROM Interface Card", 0xff8c8a45, 0xfe8020c4),
468         PCMCIA_DEVICE_PROD_ID12("Digital Equipment Corporation.", "Digital Mobile Media CD-ROM", 0x17692a66, 0xef1dcbde),
469         PCMCIA_DEVICE_PROD_ID12("EXP", "CD+GAME", 0x6f58c983, 0x63c13aaf),
470         PCMCIA_DEVICE_PROD_ID12("EXP   ", "CD-ROM", 0x0a5c52fd, 0x66536591),
471         PCMCIA_DEVICE_PROD_ID12("EXP   ", "PnPIDE", 0x0a5c52fd, 0x0c694728),
472         PCMCIA_DEVICE_PROD_ID12("FREECOM", "PCCARD-IDE", 0x5714cbf7, 0x48e0ab8e),
473         PCMCIA_DEVICE_PROD_ID12("IBM", "IBM17JSSFP20", 0xb569a6e5, 0xf2508753),
474         PCMCIA_DEVICE_PROD_ID12("IO DATA", "CBIDE2      ", 0x547e66dc, 0x8671043b),
475         PCMCIA_DEVICE_PROD_ID12("IO DATA", "PCIDE", 0x547e66dc, 0x5c5ab149),
476         PCMCIA_DEVICE_PROD_ID12("IO DATA", "PCIDEII", 0x547e66dc, 0xb3662674),
477         PCMCIA_DEVICE_PROD_ID12("LOOKMEET", "CBIDE2      ", 0xe37be2b5, 0x8671043b),
478         PCMCIA_DEVICE_PROD_ID2("NinjaATA-", 0xebe0bd79),
479         PCMCIA_DEVICE_PROD_ID12("PCMCIA", "CD-ROM", 0x281f1c5d, 0x66536591),
480         PCMCIA_DEVICE_PROD_ID12("PCMCIA", "PnPIDE", 0x281f1c5d, 0x0c694728),
481         PCMCIA_DEVICE_PROD_ID12("SHUTTLE TECHNOLOGY LTD.", "PCCARD-IDE/ATAPI Adapter", 0x4a3f0ba0, 0x322560e1),
482         PCMCIA_DEVICE_PROD_ID12("TOSHIBA", "MK2001MPL", 0xb4585a1a, 0x3489e003),
483         PCMCIA_DEVICE_PROD_ID12("WIT", "IDE16", 0x244e5994, 0x3e232852),
484         PCMCIA_DEVICE_PROD_ID1("STI Flash", 0xe4a13209),
485         PCMCIA_DEVICE_PROD_ID12("STI", "Flash 5.0", 0xbf2df18d, 0x8cb57a0e),
486         PCMCIA_MFC_DEVICE_PROD_ID12(1, "SanDisk", "ConnectPlus", 0x7a954bd9, 0x74be00c6),
487         PCMCIA_DEVICE_NULL,
488 };
489 MODULE_DEVICE_TABLE(pcmcia, ide_ids);
490
491 static struct pcmcia_driver ide_cs_driver = {
492         .owner          = THIS_MODULE,
493         .drv            = {
494                 .name   = "ide-cs",
495         },
496         .attach         = ide_attach,
497         .event          = ide_event,
498         .detach         = ide_detach,
499         .id_table       = ide_ids,
500 };
501
502 static int __init init_ide_cs(void)
503 {
504         return pcmcia_register_driver(&ide_cs_driver);
505 }
506
507 static void __exit exit_ide_cs(void)
508 {
509         pcmcia_unregister_driver(&ide_cs_driver);
510         BUG_ON(dev_list != NULL);
511 }
512
513 late_initcall(init_ide_cs);
514 module_exit(exit_ide_cs);