Driver Core: do not oops when driver_unregister() is called for unregistered drivers
[linux-2.6] / drivers / ide / gayle.c
1 /*
2  *  Amiga Gayle IDE Driver
3  *
4  *     Created 9 Jul 1997 by Geert Uytterhoeven
5  *
6  *  This file is subject to the terms and conditions of the GNU General Public
7  *  License.  See the file COPYING in the main directory of this archive for
8  *  more details.
9  */
10
11 #include <linux/types.h>
12 #include <linux/mm.h>
13 #include <linux/interrupt.h>
14 #include <linux/blkdev.h>
15 #include <linux/ide.h>
16 #include <linux/init.h>
17 #include <linux/zorro.h>
18 #include <linux/module.h>
19
20 #include <asm/setup.h>
21 #include <asm/amigahw.h>
22 #include <asm/amigaints.h>
23 #include <asm/amigayle.h>
24
25
26     /*
27      *  Bases of the IDE interfaces
28      */
29
30 #define GAYLE_BASE_4000 0xdd2020        /* A4000/A4000T */
31 #define GAYLE_BASE_1200 0xda0000        /* A1200/A600 and E-Matrix 530 */
32
33 #define GAYLE_IDEREG_SIZE       0x2000
34
35     /*
36      *  Offsets from one of the above bases
37      */
38
39 #define GAYLE_CONTROL   0x101a
40
41     /*
42      *  These are at different offsets from the base
43      */
44
45 #define GAYLE_IRQ_4000  0xdd3020        /* MSB = 1, Harddisk is source of */
46 #define GAYLE_IRQ_1200  0xda9000        /* interrupt */
47
48
49     /*
50      *  Offset of the secondary port for IDE doublers
51      *  Note that GAYLE_CONTROL is NOT available then!
52      */
53
54 #define GAYLE_NEXT_PORT 0x1000
55
56 #define GAYLE_NUM_HWIFS         2
57 #define GAYLE_NUM_PROBE_HWIFS   (ide_doubler ? GAYLE_NUM_HWIFS : \
58                                                GAYLE_NUM_HWIFS-1)
59 #define GAYLE_HAS_CONTROL_REG   (!ide_doubler)
60
61 static int ide_doubler;
62 module_param_named(doubler, ide_doubler, bool, 0);
63 MODULE_PARM_DESC(doubler, "enable support for IDE doublers");
64
65     /*
66      *  Check and acknowledge the interrupt status
67      */
68
69 static int gayle_ack_intr_a4000(ide_hwif_t *hwif)
70 {
71     unsigned char ch;
72
73     ch = z_readb(hwif->io_ports.irq_addr);
74     if (!(ch & GAYLE_IRQ_IDE))
75         return 0;
76     return 1;
77 }
78
79 static int gayle_ack_intr_a1200(ide_hwif_t *hwif)
80 {
81     unsigned char ch;
82
83     ch = z_readb(hwif->io_ports.irq_addr);
84     if (!(ch & GAYLE_IRQ_IDE))
85         return 0;
86     (void)z_readb(hwif->io_ports.status_addr);
87     z_writeb(0x7c, hwif->io_ports.irq_addr);
88     return 1;
89 }
90
91 static void __init gayle_setup_ports(hw_regs_t *hw, unsigned long base,
92                                      unsigned long ctl, unsigned long irq_port,
93                                      ide_ack_intr_t *ack_intr)
94 {
95         int i;
96
97         memset(hw, 0, sizeof(*hw));
98
99         hw->io_ports.data_addr = base;
100
101         for (i = 1; i < 8; i++)
102                 hw->io_ports_array[i] = base + 2 + i * 4;
103
104         hw->io_ports.ctl_addr = ctl;
105         hw->io_ports.irq_addr = irq_port;
106
107         hw->irq = IRQ_AMIGA_PORTS;
108         hw->ack_intr = ack_intr;
109
110         hw->chipset = ide_generic;
111 }
112
113 static const struct ide_port_info gayle_port_info = {
114         .host_flags             = IDE_HFLAG_MMIO | IDE_HFLAG_SERIALIZE |
115                                   IDE_HFLAG_NO_DMA,
116         .irq_flags              = IRQF_SHARED,
117 };
118
119     /*
120      *  Probe for a Gayle IDE interface (and optionally for an IDE doubler)
121      */
122
123 static int __init gayle_init(void)
124 {
125     unsigned long phys_base, res_start, res_n;
126     unsigned long base, ctrlport, irqport;
127     ide_ack_intr_t *ack_intr;
128     int a4000, i, rc;
129     hw_regs_t hw[GAYLE_NUM_HWIFS], *hws[] = { NULL, NULL, NULL, NULL };
130
131     if (!MACH_IS_AMIGA)
132         return -ENODEV;
133
134     if ((a4000 = AMIGAHW_PRESENT(A4000_IDE)) || AMIGAHW_PRESENT(A1200_IDE))
135         goto found;
136
137 #ifdef CONFIG_ZORRO
138     if (zorro_find_device(ZORRO_PROD_MTEC_VIPER_MK_V_E_MATRIX_530_SCSI_IDE,
139                           NULL))
140         goto found;
141 #endif
142     return -ENODEV;
143
144 found:
145         printk(KERN_INFO "ide: Gayle IDE controller (A%d style%s)\n",
146                          a4000 ? 4000 : 1200,
147                          ide_doubler ? ", IDE doubler" : "");
148
149         if (a4000) {
150             phys_base = GAYLE_BASE_4000;
151             irqport = (unsigned long)ZTWO_VADDR(GAYLE_IRQ_4000);
152             ack_intr = gayle_ack_intr_a4000;
153         } else {
154             phys_base = GAYLE_BASE_1200;
155             irqport = (unsigned long)ZTWO_VADDR(GAYLE_IRQ_1200);
156             ack_intr = gayle_ack_intr_a1200;
157         }
158
159         res_start = ((unsigned long)phys_base) & ~(GAYLE_NEXT_PORT-1);
160         res_n = GAYLE_IDEREG_SIZE;
161
162         if (!request_mem_region(res_start, res_n, "IDE"))
163                 return -EBUSY;
164
165     for (i = 0; i < GAYLE_NUM_PROBE_HWIFS; i++) {
166         base = (unsigned long)ZTWO_VADDR(phys_base + i * GAYLE_NEXT_PORT);
167         ctrlport = GAYLE_HAS_CONTROL_REG ? (base + GAYLE_CONTROL) : 0;
168
169         gayle_setup_ports(&hw[i], base, ctrlport, irqport, ack_intr);
170
171         hws[i] = &hw[i];
172     }
173
174     rc = ide_host_add(&gayle_port_info, hws, NULL);
175     if (rc)
176         release_mem_region(res_start, res_n);
177
178     return rc;
179 }
180
181 module_init(gayle_init);
182
183 MODULE_LICENSE("GPL");