PCI: Fix oops in pci_vpd_truncate
[linux-2.6/mini2440.git] / drivers / ide / falconide.c
blobafa2af9a362beb9464f69b5d79397481f9b2fbd9
1 /*
2 * Atari Falcon IDE Driver
4 * Created 12 Jul 1997 by Geert Uytterhoeven
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 */
11 #include <linux/module.h>
12 #include <linux/types.h>
13 #include <linux/mm.h>
14 #include <linux/interrupt.h>
15 #include <linux/blkdev.h>
16 #include <linux/ide.h>
17 #include <linux/init.h>
19 #include <asm/setup.h>
20 #include <asm/atarihw.h>
21 #include <asm/atariints.h>
22 #include <asm/atari_stdma.h>
24 #define DRV_NAME "falconide"
27 * Base of the IDE interface
30 #define ATA_HD_BASE 0xfff00000
33 * Offsets from the above base
36 #define ATA_HD_CONTROL 0x39
39 * falconide_intr_lock is used to obtain access to the IDE interrupt,
40 * which is shared between several drivers.
43 static int falconide_intr_lock;
45 static void falconide_release_lock(void)
47 if (falconide_intr_lock == 0) {
48 printk(KERN_ERR "%s: bug\n", __func__);
49 return;
51 falconide_intr_lock = 0;
52 stdma_release();
55 static void falconide_get_lock(irq_handler_t handler, void *data)
57 if (falconide_intr_lock == 0) {
58 if (in_interrupt() > 0)
59 panic("Falcon IDE hasn't ST-DMA lock in interrupt");
60 stdma_lock(handler, data);
61 falconide_intr_lock = 1;
65 static void falconide_input_data(ide_drive_t *drive, struct ide_cmd *cmd,
66 void *buf, unsigned int len)
68 unsigned long data_addr = drive->hwif->io_ports.data_addr;
70 if (drive->media == ide_disk && cmd && (cmd->tf_flags & IDE_TFLAG_FS))
71 return insw(data_addr, buf, (len + 1) / 2);
73 raw_insw_swapw((u16 *)data_addr, buf, (len + 1) / 2);
76 static void falconide_output_data(ide_drive_t *drive, struct ide_cmd *cmd,
77 void *buf, unsigned int len)
79 unsigned long data_addr = drive->hwif->io_ports.data_addr;
81 if (drive->media == ide_disk && cmd && (cmd->tf_flags & IDE_TFLAG_FS))
82 return outsw(data_addr, buf, (len + 1) / 2);
84 raw_outsw_swapw((u16 *)data_addr, buf, (len + 1) / 2);
87 /* Atari has a byte-swapped IDE interface */
88 static const struct ide_tp_ops falconide_tp_ops = {
89 .exec_command = ide_exec_command,
90 .read_status = ide_read_status,
91 .read_altstatus = ide_read_altstatus,
92 .write_devctl = ide_write_devctl,
94 .dev_select = ide_dev_select,
95 .tf_load = ide_tf_load,
96 .tf_read = ide_tf_read,
98 .input_data = falconide_input_data,
99 .output_data = falconide_output_data,
102 static const struct ide_port_info falconide_port_info = {
103 .get_lock = falconide_get_lock,
104 .release_lock = falconide_release_lock,
105 .tp_ops = &falconide_tp_ops,
106 .host_flags = IDE_HFLAG_MMIO | IDE_HFLAG_SERIALIZE |
107 IDE_HFLAG_NO_DMA,
108 .irq_flags = IRQF_SHARED,
111 static void __init falconide_setup_ports(hw_regs_t *hw)
113 int i;
115 memset(hw, 0, sizeof(*hw));
117 hw->io_ports.data_addr = ATA_HD_BASE;
119 for (i = 1; i < 8; i++)
120 hw->io_ports_array[i] = ATA_HD_BASE + 1 + i * 4;
122 hw->io_ports.ctl_addr = ATA_HD_BASE + ATA_HD_CONTROL;
124 hw->irq = IRQ_MFP_IDE;
125 hw->ack_intr = NULL;
127 hw->chipset = ide_generic;
131 * Probe for a Falcon IDE interface
134 static int __init falconide_init(void)
136 struct ide_host *host;
137 hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };
138 int rc;
140 if (!MACH_IS_ATARI || !ATARIHW_PRESENT(IDE))
141 return -ENODEV;
143 printk(KERN_INFO "ide: Falcon IDE controller\n");
145 if (!request_mem_region(ATA_HD_BASE, 0x40, DRV_NAME)) {
146 printk(KERN_ERR "%s: resources busy\n", DRV_NAME);
147 return -EBUSY;
150 falconide_setup_ports(&hw);
152 host = ide_host_alloc(&falconide_port_info, hws);
153 if (host == NULL) {
154 rc = -ENOMEM;
155 goto err;
158 falconide_get_lock(NULL, NULL);
159 rc = ide_host_register(host, &falconide_port_info, hws);
160 falconide_release_lock();
162 if (rc)
163 goto err_free;
165 return 0;
166 err_free:
167 ide_host_free(host);
168 err:
169 release_mem_region(ATA_HD_BASE, 0x40);
170 return rc;
173 module_init(falconide_init);
175 MODULE_LICENSE("GPL");