diff options
-rw-r--r-- | drivers/ide/legacy/q40ide.c | 47 |
1 files changed, 14 insertions, 33 deletions
diff --git a/drivers/ide/legacy/q40ide.c b/drivers/ide/legacy/q40ide.c index a3573d40b4b7..f9210458aea0 100644 --- a/drivers/ide/legacy/q40ide.c +++ b/drivers/ide/legacy/q40ide.c | |||
@@ -36,23 +36,6 @@ static const unsigned long pcide_bases[Q40IDE_NUM_HWIFS] = { | |||
36 | PCIDE_BASE6 */ | 36 | PCIDE_BASE6 */ |
37 | }; | 37 | }; |
38 | 38 | ||
39 | |||
40 | /* | ||
41 | * Offsets from one of the above bases | ||
42 | */ | ||
43 | |||
44 | /* used to do addr translation here but it is easier to do in setup ports */ | ||
45 | /*#define IDE_OFF_B(x) ((unsigned long)Q40_ISA_IO_B((IDE_##x##_OFFSET)))*/ | ||
46 | |||
47 | #define IDE_OFF_B(x) ((unsigned long)((IDE_##x##_OFFSET))) | ||
48 | #define IDE_OFF_W(x) ((unsigned long)((IDE_##x##_OFFSET))) | ||
49 | |||
50 | static const int pcide_offsets[IDE_NR_PORTS] = { | ||
51 | IDE_OFF_W(DATA), IDE_OFF_B(ERROR), IDE_OFF_B(NSECTOR), IDE_OFF_B(SECTOR), | ||
52 | IDE_OFF_B(LCYL), IDE_OFF_B(HCYL), 6 /*IDE_OFF_B(CURRENT)*/, IDE_OFF_B(STATUS), | ||
53 | 518/*IDE_OFF(CMD)*/ | ||
54 | }; | ||
55 | |||
56 | static int q40ide_default_irq(unsigned long base) | 39 | static int q40ide_default_irq(unsigned long base) |
57 | { | 40 | { |
58 | switch (base) { | 41 | switch (base) { |
@@ -68,23 +51,22 @@ static int q40ide_default_irq(unsigned long base) | |||
68 | /* | 51 | /* |
69 | * Addresses are pretranslated for Q40 ISA access. | 52 | * Addresses are pretranslated for Q40 ISA access. |
70 | */ | 53 | */ |
71 | void q40_ide_setup_ports ( hw_regs_t *hw, | 54 | static void q40_ide_setup_ports(hw_regs_t *hw, unsigned long base, |
72 | unsigned long base, int *offsets, | ||
73 | unsigned long ctrl, unsigned long intr, | ||
74 | ide_ack_intr_t *ack_intr, | 55 | ide_ack_intr_t *ack_intr, |
75 | int irq) | 56 | int irq) |
76 | { | 57 | { |
77 | int i; | ||
78 | |||
79 | memset(hw, 0, sizeof(hw_regs_t)); | 58 | memset(hw, 0, sizeof(hw_regs_t)); |
80 | for (i = 0; i < IDE_NR_PORTS; i++) { | 59 | /* BIG FAT WARNING: |
81 | /* BIG FAT WARNING: | 60 | assumption: only DATA port is ever used in 16 bit mode */ |
82 | assumption: only DATA port is ever used in 16 bit mode */ | 61 | hw->io_ports.data_addr = Q40_ISA_IO_W(base); |
83 | if (i == 0) | 62 | hw->io_ports.error_addr = Q40_ISA_IO_B(base + 1); |
84 | hw->io_ports_array[i] = Q40_ISA_IO_W(base + offsets[i]); | 63 | hw->io_ports.nsect_addr = Q40_ISA_IO_B(base + 2); |
85 | else | 64 | hw->io_ports.lbal_addr = Q40_ISA_IO_B(base + 3); |
86 | hw->io_ports_array[i] = Q40_ISA_IO_B(base + offsets[i]); | 65 | hw->io_ports.lbam_addr = Q40_ISA_IO_B(base + 4); |
87 | } | 66 | hw->io_ports.lbah_addr = Q40_ISA_IO_B(base + 5); |
67 | hw->io_ports.device_addr = Q40_ISA_IO_B(base + 6); | ||
68 | hw->io_ports.status_addr = Q40_ISA_IO_B(base + 7); | ||
69 | hw->io_ports.ctl_addr = Q40_ISA_IO_B(base + 0x206); | ||
88 | 70 | ||
89 | hw->irq = irq; | 71 | hw->irq = irq; |
90 | hw->ack_intr = ack_intr; | 72 | hw->ack_intr = ack_intr; |
@@ -131,9 +113,8 @@ static int __init q40ide_init(void) | |||
131 | release_region(pcide_bases[i], 8); | 113 | release_region(pcide_bases[i], 8); |
132 | continue; | 114 | continue; |
133 | } | 115 | } |
134 | q40_ide_setup_ports(&hw,(unsigned long) pcide_bases[i], (int *)pcide_offsets, | 116 | q40_ide_setup_ports(&hw, pcide_bases[i], |
135 | pcide_bases[i]+0x206, | 117 | NULL, |
136 | 0, NULL, | ||
137 | // m68kide_iops, | 118 | // m68kide_iops, |
138 | q40ide_default_irq(pcide_bases[i])); | 119 | q40ide_default_irq(pcide_bases[i])); |
139 | 120 | ||