falconide/q40ide: add ->atapi_*put_bytes and ->ata_*put_data methods (take 2)
[pandora-kernel.git] / drivers / ide / legacy / falconide.c
1 /*
2  *  Atari Falcon IDE Driver
3  *
4  *     Created 12 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/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/hdreg.h>
17 #include <linux/ide.h>
18 #include <linux/init.h>
19
20 #include <asm/setup.h>
21 #include <asm/atarihw.h>
22 #include <asm/atariints.h>
23 #include <asm/atari_stdma.h>
24
25 #define DRV_NAME "falconide"
26
27     /*
28      *  Base of the IDE interface
29      */
30
31 #define ATA_HD_BASE     0xfff00000
32
33     /*
34      *  Offsets from the above base
35      */
36
37 #define ATA_HD_CONTROL  0x39
38
39     /*
40      *  falconide_intr_lock is used to obtain access to the IDE interrupt,
41      *  which is shared between several drivers.
42      */
43
44 int falconide_intr_lock;
45 EXPORT_SYMBOL(falconide_intr_lock);
46
47 static void falconide_atapi_input_bytes(ide_drive_t *drive, void *buf,
48                                         unsigned int len)
49 {
50         insw_swapw(drive->hwif->io_ports.data_addr, buf, (len + 1) / 2);
51 }
52
53 static void falconide_atapi_output_bytes(ide_drive_t *drive, void *buf,
54                                          unsigned int len)
55 {
56         outsw_swapw(drive->hwif->io_ports.data_addr, buf, (len + 1) / 2);
57 }
58
59 static void falconide_ata_input_data(ide_drive_t *drive, struct request *rq,
60                                      void *buf, unsigned int wcount)
61 {
62         if (drive->media == ide_disk && rq && rq->cmd_type == REQ_TYPE_FS)
63                 return insw(drive->hwif->io_ports.data_addr, buf, wcount * 2);
64
65         falconide_atapi_input_bytes(drive, buf, wcount * 4);
66 }
67
68 static void falconide_ata_output_data(ide_drive_t *drive, struct request *rq,
69                                       void *buf, unsigned int wcount)
70 {
71         if (drive->media == ide_disk && rq && rq->cmd_type == REQ_TYPE_FS)
72                 return outsw(drive->hwif->io_ports.data_addr, buf, wcount * 2);
73
74         falconide_atapi_output_bytes(drive, buf, wcount * 4);
75 }
76
77 static void __init falconide_setup_ports(hw_regs_t *hw)
78 {
79         int i;
80
81         memset(hw, 0, sizeof(*hw));
82
83         hw->io_ports.data_addr = ATA_HD_BASE;
84
85         for (i = 1; i < 8; i++)
86                 hw->io_ports_array[i] = ATA_HD_BASE + 1 + i * 4;
87
88         hw->io_ports.ctl_addr = ATA_HD_BASE + ATA_HD_CONTROL;
89
90         hw->irq = IRQ_MFP_IDE;
91         hw->ack_intr = NULL;
92 }
93
94     /*
95      *  Probe for a Falcon IDE interface
96      */
97
98 static int __init falconide_init(void)
99 {
100         hw_regs_t hw;
101         ide_hwif_t *hwif;
102
103         if (!MACH_IS_ATARI || !ATARIHW_PRESENT(IDE))
104                 return 0;
105
106         printk(KERN_INFO "ide: Falcon IDE controller\n");
107
108         if (!request_mem_region(ATA_HD_BASE, 0x40, DRV_NAME)) {
109                 printk(KERN_ERR "%s: resources busy\n", DRV_NAME);
110                 return -EBUSY;
111         }
112
113         falconide_setup_ports(&hw);
114
115         hwif = ide_find_port();
116         if (hwif) {
117                 u8 index = hwif->index;
118                 u8 idx[4] = { index, 0xff, 0xff, 0xff };
119
120                 ide_init_port_data(hwif, index);
121                 ide_init_port_hw(hwif, &hw);
122
123                 /* Atari has a byte-swapped IDE interface */
124                 hwif->atapi_input_bytes  = falconide_atapi_input_bytes;
125                 hwif->atapi_output_bytes = falconide_atapi_output_bytes;
126                 hwif->ata_input_data     = falconide_ata_input_data;
127                 hwif->ata_output_data    = falconide_ata_output_data;
128
129                 ide_get_lock(NULL, NULL);
130                 ide_device_add(idx, NULL);
131                 ide_release_lock();
132         }
133
134         return 0;
135 }
136
137 module_init(falconide_init);
138
139 MODULE_LICENSE("GPL");