Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | * Copyright (C) 1995-2000 Linus Torvalds & author (see below) |
| 3 | */ |
| 4 | |
| 5 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 6 | * HT-6560B EIDE-controller support |
| 7 | * To activate controller support use kernel parameter "ide0=ht6560b". |
| 8 | * Use hdparm utility to enable PIO mode support. |
| 9 | * |
| 10 | * Author: Mikko Ala-Fossi <maf@iki.fi> |
Jan Evert van Grootheest | eb34b2d | 2008-07-24 22:53:35 +0200 | [diff] [blame] | 11 | * Jan Evert van Grootheest <j.e.van.grootheest@caiway.nl> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 | * |
| 13 | * Try: http://www.maf.iki.fi/~maf/ht6560b/ |
| 14 | */ |
| 15 | |
Bartlomiej Zolnierkiewicz | 2e4ed29 | 2008-04-26 17:36:35 +0200 | [diff] [blame] | 16 | #define DRV_NAME "ht6560b" |
Jan Evert van Grootheest | 0e7d8d48 | 2008-02-19 01:41:26 +0100 | [diff] [blame] | 17 | #define HT6560B_VERSION "v0.08" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 18 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 19 | #include <linux/module.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | #include <linux/types.h> |
| 21 | #include <linux/kernel.h> |
| 22 | #include <linux/delay.h> |
| 23 | #include <linux/timer.h> |
| 24 | #include <linux/mm.h> |
| 25 | #include <linux/ioport.h> |
| 26 | #include <linux/blkdev.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 27 | #include <linux/ide.h> |
| 28 | #include <linux/init.h> |
| 29 | |
| 30 | #include <asm/io.h> |
| 31 | |
| 32 | /* #define DEBUG */ /* remove comments for DEBUG messages */ |
| 33 | |
| 34 | /* |
| 35 | * The special i/o-port that HT-6560B uses to configuration: |
| 36 | * bit0 (0x01): "1" selects secondary interface |
| 37 | * bit2 (0x04): "1" enables FIFO function |
| 38 | * bit5 (0x20): "1" enables prefetched data read function (???) |
| 39 | * |
| 40 | * The special i/o-port that HT-6560A uses to configuration: |
| 41 | * bit0 (0x01): "1" selects secondary interface |
| 42 | * bit1 (0x02): "1" enables prefetched data read function |
| 43 | * bit2 (0x04): "0" enables multi-master system (?) |
| 44 | * bit3 (0x08): "1" 3 cycle time, "0" 2 cycle time (?) |
| 45 | */ |
| 46 | #define HT_CONFIG_PORT 0x3e6 |
| 47 | #define HT_CONFIG(drivea) (u8)(((drivea)->drive_data & 0xff00) >> 8) |
| 48 | /* |
| 49 | * FIFO + PREFETCH (both a/b-model) |
| 50 | */ |
| 51 | #define HT_CONFIG_DEFAULT 0x1c /* no prefetch */ |
| 52 | /* #define HT_CONFIG_DEFAULT 0x3c */ /* with prefetch */ |
| 53 | #define HT_SECONDARY_IF 0x01 |
| 54 | #define HT_PREFETCH_MODE 0x20 |
| 55 | |
| 56 | /* |
| 57 | * ht6560b Timing values: |
| 58 | * |
| 59 | * I reviewed some assembler source listings of htide drivers and found |
| 60 | * out how they setup those cycle time interfacing values, as they at Holtek |
| 61 | * call them. IDESETUP.COM that is supplied with the drivers figures out |
| 62 | * optimal values and fetches those values to drivers. I found out that |
Bartlomiej Zolnierkiewicz | 23579a2 | 2008-04-18 00:46:26 +0200 | [diff] [blame] | 63 | * they use Select register to fetch timings to the ide board right after |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 | * interface switching. After that it was quite easy to add code to |
| 65 | * ht6560b.c. |
| 66 | * |
| 67 | * IDESETUP.COM gave me values 0x24, 0x45, 0xaa, 0xff that worked fine |
| 68 | * for hda and hdc. But hdb needed higher values to work, so I guess |
| 69 | * that sometimes it is necessary to give higher value than IDESETUP |
| 70 | * gives. [see cmd640.c for an extreme example of this. -ml] |
| 71 | * |
| 72 | * Perhaps I should explain something about these timing values: |
| 73 | * The higher nibble of value is the Recovery Time (rt) and the lower nibble |
| 74 | * of the value is the Active Time (at). Minimum value 2 is the fastest and |
| 75 | * the maximum value 15 is the slowest. Default values should be 15 for both. |
| 76 | * So 0x24 means 2 for rt and 4 for at. Each of the drives should have |
| 77 | * both values, and IDESETUP gives automatically rt=15 st=15 for CDROMs or |
| 78 | * similar. If value is too small there will be all sorts of failures. |
| 79 | * |
| 80 | * Timing byte consists of |
| 81 | * High nibble: Recovery Cycle Time (rt) |
| 82 | * The valid values range from 2 to 15. The default is 15. |
| 83 | * |
| 84 | * Low nibble: Active Cycle Time (at) |
| 85 | * The valid values range from 2 to 15. The default is 15. |
| 86 | * |
| 87 | * You can obtain optimized timing values by running Holtek IDESETUP.COM |
| 88 | * for DOS. DOS drivers get their timing values from command line, where |
| 89 | * the first value is the Recovery Time and the second value is the |
| 90 | * Active Time for each drive. Smaller value gives higher speed. |
| 91 | * In case of failures you should probably fall back to a higher value. |
| 92 | */ |
| 93 | #define HT_TIMING(drivea) (u8)((drivea)->drive_data & 0x00ff) |
| 94 | #define HT_TIMING_DEFAULT 0xff |
| 95 | |
| 96 | /* |
| 97 | * This routine handles interface switching for the peculiar hardware design |
| 98 | * on the F.G.I./Holtek HT-6560B VLB IDE interface. |
| 99 | * The HT-6560B can only enable one IDE port at a time, and requires a |
| 100 | * silly sequence (below) whenever we switch between primary and secondary. |
| 101 | */ |
| 102 | |
| 103 | /* |
| 104 | * This routine is invoked from ide.c to prepare for access to a given drive. |
| 105 | */ |
| 106 | static void ht6560b_selectproc (ide_drive_t *drive) |
| 107 | { |
Bartlomiej Zolnierkiewicz | 23579a2 | 2008-04-18 00:46:26 +0200 | [diff] [blame] | 108 | ide_hwif_t *hwif = drive->hwif; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 109 | unsigned long flags; |
| 110 | static u8 current_select = 0; |
| 111 | static u8 current_timing = 0; |
| 112 | u8 select, timing; |
| 113 | |
| 114 | local_irq_save(flags); |
Jan Evert van Grootheest | 0e7d8d48 | 2008-02-19 01:41:26 +0100 | [diff] [blame] | 115 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 116 | select = HT_CONFIG(drive); |
| 117 | timing = HT_TIMING(drive); |
Jan Evert van Grootheest | 0e7d8d48 | 2008-02-19 01:41:26 +0100 | [diff] [blame] | 118 | |
| 119 | /* |
| 120 | * Need to enforce prefetch sometimes because otherwise |
| 121 | * it'll hang (hard). |
| 122 | */ |
Bartlomiej Zolnierkiewicz | 97100fc | 2008-10-13 21:39:36 +0200 | [diff] [blame] | 123 | if (drive->media != ide_disk || |
| 124 | (drive->dev_flags & IDE_DFLAG_PRESENT) == 0) |
Jan Evert van Grootheest | 0e7d8d48 | 2008-02-19 01:41:26 +0100 | [diff] [blame] | 125 | select |= HT_PREFETCH_MODE; |
| 126 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 127 | if (select != current_select || timing != current_timing) { |
| 128 | current_select = select; |
| 129 | current_timing = timing; |
Bartlomiej Zolnierkiewicz | 0ecdca2 | 2007-02-17 02:40:25 +0100 | [diff] [blame] | 130 | (void)inb(HT_CONFIG_PORT); |
| 131 | (void)inb(HT_CONFIG_PORT); |
| 132 | (void)inb(HT_CONFIG_PORT); |
| 133 | (void)inb(HT_CONFIG_PORT); |
| 134 | outb(select, HT_CONFIG_PORT); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 135 | /* |
| 136 | * Set timing for this drive: |
| 137 | */ |
Bartlomiej Zolnierkiewicz | 4c3032d | 2008-04-27 15:38:32 +0200 | [diff] [blame] | 138 | outb(timing, hwif->io_ports.device_addr); |
| 139 | (void)inb(hwif->io_ports.status_addr); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 140 | #ifdef DEBUG |
| 141 | printk("ht6560b: %s: select=%#x timing=%#x\n", |
| 142 | drive->name, select, timing); |
| 143 | #endif |
| 144 | } |
| 145 | local_irq_restore(flags); |
| 146 | } |
| 147 | |
| 148 | /* |
| 149 | * Autodetection and initialization of ht6560b |
| 150 | */ |
| 151 | static int __init try_to_init_ht6560b(void) |
| 152 | { |
| 153 | u8 orig_value; |
| 154 | int i; |
| 155 | |
| 156 | /* Autodetect ht6560b */ |
| 157 | if ((orig_value = inb(HT_CONFIG_PORT)) == 0xff) |
| 158 | return 0; |
| 159 | |
| 160 | for (i=3;i>0;i--) { |
| 161 | outb(0x00, HT_CONFIG_PORT); |
| 162 | if (!( (~inb(HT_CONFIG_PORT)) & 0x3f )) { |
| 163 | outb(orig_value, HT_CONFIG_PORT); |
| 164 | return 0; |
| 165 | } |
| 166 | } |
| 167 | outb(0x00, HT_CONFIG_PORT); |
| 168 | if ((~inb(HT_CONFIG_PORT))& 0x3f) { |
| 169 | outb(orig_value, HT_CONFIG_PORT); |
| 170 | return 0; |
| 171 | } |
| 172 | /* |
| 173 | * Ht6560b autodetected |
| 174 | */ |
| 175 | outb(HT_CONFIG_DEFAULT, HT_CONFIG_PORT); |
Bartlomiej Zolnierkiewicz | 23579a2 | 2008-04-18 00:46:26 +0200 | [diff] [blame] | 176 | outb(HT_TIMING_DEFAULT, 0x1f6); /* Select register */ |
| 177 | (void)inb(0x1f7); /* Status register */ |
| 178 | |
Jan Evert van Grootheest | 0e7d8d48 | 2008-02-19 01:41:26 +0100 | [diff] [blame] | 179 | printk("ht6560b " HT6560B_VERSION |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 180 | ": chipset detected and initialized" |
| 181 | #ifdef DEBUG |
| 182 | " with debug enabled" |
| 183 | #endif |
Jan Evert van Grootheest | 0e7d8d48 | 2008-02-19 01:41:26 +0100 | [diff] [blame] | 184 | "\n" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 185 | ); |
| 186 | return 1; |
| 187 | } |
| 188 | |
Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 189 | static u8 ht_pio2timings(ide_drive_t *drive, const u8 pio) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 190 | { |
| 191 | int active_time, recovery_time; |
| 192 | int active_cycles, recovery_cycles; |
Bartlomiej Zolnierkiewicz | 30e5ee4 | 2008-07-15 21:21:46 +0200 | [diff] [blame] | 193 | int bus_speed = ide_vlb_clk ? ide_vlb_clk : 50; |
Bartlomiej Zolnierkiewicz | ebae41a | 2008-04-27 15:38:29 +0200 | [diff] [blame] | 194 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 195 | if (pio) { |
Bartlomiej Zolnierkiewicz | 7dd0008 | 2007-07-20 01:11:56 +0200 | [diff] [blame] | 196 | unsigned int cycle_time; |
Bartlomiej Zolnierkiewicz | b32b76f | 2008-07-16 20:33:37 +0200 | [diff] [blame] | 197 | struct ide_timing *t = ide_timing_find_mode(XFER_PIO_0 + pio); |
Bartlomiej Zolnierkiewicz | 7dd0008 | 2007-07-20 01:11:56 +0200 | [diff] [blame] | 198 | |
Bartlomiej Zolnierkiewicz | 7dd0008 | 2007-07-20 01:11:56 +0200 | [diff] [blame] | 199 | cycle_time = ide_pio_cycle_time(drive, pio); |
| 200 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 201 | /* |
| 202 | * Just like opti621.c we try to calculate the |
| 203 | * actual cycle time for recovery and activity |
| 204 | * according system bus speed. |
| 205 | */ |
Bartlomiej Zolnierkiewicz | b32b76f | 2008-07-16 20:33:37 +0200 | [diff] [blame] | 206 | active_time = t->active; |
| 207 | recovery_time = cycle_time - active_time - t->setup; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 208 | /* |
| 209 | * Cycle times should be Vesa bus cycles |
| 210 | */ |
| 211 | active_cycles = (active_time * bus_speed + 999) / 1000; |
| 212 | recovery_cycles = (recovery_time * bus_speed + 999) / 1000; |
| 213 | /* |
| 214 | * Upper and lower limits |
| 215 | */ |
| 216 | if (active_cycles < 2) active_cycles = 2; |
| 217 | if (recovery_cycles < 2) recovery_cycles = 2; |
| 218 | if (active_cycles > 15) active_cycles = 15; |
| 219 | if (recovery_cycles > 15) recovery_cycles = 0; /* 0==16 */ |
| 220 | |
| 221 | #ifdef DEBUG |
| 222 | printk("ht6560b: drive %s setting pio=%d recovery=%d (%dns) active=%d (%dns)\n", drive->name, pio, recovery_cycles, recovery_time, active_cycles, active_time); |
| 223 | #endif |
| 224 | |
| 225 | return (u8)((recovery_cycles << 4) | active_cycles); |
| 226 | } else { |
| 227 | |
| 228 | #ifdef DEBUG |
| 229 | printk("ht6560b: drive %s setting pio=0\n", drive->name); |
| 230 | #endif |
| 231 | |
| 232 | return HT_TIMING_DEFAULT; /* default setting */ |
| 233 | } |
| 234 | } |
| 235 | |
Bartlomiej Zolnierkiewicz | 69e88d2 | 2007-10-20 00:32:35 +0200 | [diff] [blame] | 236 | static DEFINE_SPINLOCK(ht6560b_lock); |
| 237 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 | /* |
| 239 | * Enable/Disable so called prefetch mode |
| 240 | */ |
| 241 | static void ht_set_prefetch(ide_drive_t *drive, u8 state) |
| 242 | { |
| 243 | unsigned long flags; |
| 244 | int t = HT_PREFETCH_MODE << 8; |
Bartlomiej Zolnierkiewicz | 69e88d2 | 2007-10-20 00:32:35 +0200 | [diff] [blame] | 245 | |
| 246 | spin_lock_irqsave(&ht6560b_lock, flags); |
| 247 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 248 | /* |
| 249 | * Prefetch mode and unmask irq seems to conflict |
| 250 | */ |
| 251 | if (state) { |
| 252 | drive->drive_data |= t; /* enable prefetch mode */ |
Bartlomiej Zolnierkiewicz | 97100fc | 2008-10-13 21:39:36 +0200 | [diff] [blame] | 253 | drive->dev_flags |= IDE_DFLAG_NO_UNMASK; |
| 254 | drive->dev_flags &= ~IDE_DFLAG_UNMASK; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 255 | } else { |
| 256 | drive->drive_data &= ~t; /* disable prefetch mode */ |
Bartlomiej Zolnierkiewicz | 97100fc | 2008-10-13 21:39:36 +0200 | [diff] [blame] | 257 | drive->dev_flags &= ~IDE_DFLAG_NO_UNMASK; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 258 | } |
Bartlomiej Zolnierkiewicz | 69e88d2 | 2007-10-20 00:32:35 +0200 | [diff] [blame] | 259 | |
| 260 | spin_unlock_irqrestore(&ht6560b_lock, flags); |
| 261 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 262 | #ifdef DEBUG |
| 263 | printk("ht6560b: drive %s prefetch mode %sabled\n", drive->name, (state ? "en" : "dis")); |
| 264 | #endif |
| 265 | } |
| 266 | |
Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 267 | static void ht6560b_set_pio_mode(ide_drive_t *drive, const u8 pio) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 268 | { |
| 269 | unsigned long flags; |
| 270 | u8 timing; |
| 271 | |
| 272 | switch (pio) { |
| 273 | case 8: /* set prefetch off */ |
| 274 | case 9: /* set prefetch on */ |
| 275 | ht_set_prefetch(drive, pio & 1); |
| 276 | return; |
| 277 | } |
Bartlomiej Zolnierkiewicz | 69e88d2 | 2007-10-20 00:32:35 +0200 | [diff] [blame] | 278 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 279 | timing = ht_pio2timings(drive, pio); |
Bartlomiej Zolnierkiewicz | 69e88d2 | 2007-10-20 00:32:35 +0200 | [diff] [blame] | 280 | |
| 281 | spin_lock_irqsave(&ht6560b_lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 282 | drive->drive_data &= 0xff00; |
| 283 | drive->drive_data |= timing; |
Bartlomiej Zolnierkiewicz | 69e88d2 | 2007-10-20 00:32:35 +0200 | [diff] [blame] | 284 | spin_unlock_irqrestore(&ht6560b_lock, flags); |
| 285 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 286 | #ifdef DEBUG |
| 287 | printk("ht6560b: drive %s tuned to pio mode %#x timing=%#x\n", drive->name, pio, timing); |
| 288 | #endif |
| 289 | } |
| 290 | |
Bartlomiej Zolnierkiewicz | e6d95bd | 2008-07-16 20:33:42 +0200 | [diff] [blame] | 291 | static void __init ht6560b_init_dev(ide_drive_t *drive) |
Bartlomiej Zolnierkiewicz | 1f2cf8b | 2008-02-02 19:56:40 +0100 | [diff] [blame] | 292 | { |
Bartlomiej Zolnierkiewicz | e6d95bd | 2008-07-16 20:33:42 +0200 | [diff] [blame] | 293 | ide_hwif_t *hwif = drive->hwif; |
Bartlomiej Zolnierkiewicz | 1f2cf8b | 2008-02-02 19:56:40 +0100 | [diff] [blame] | 294 | /* Setting default configurations for drives. */ |
| 295 | int t = (HT_CONFIG_DEFAULT << 8) | HT_TIMING_DEFAULT; |
| 296 | |
| 297 | if (hwif->channel) |
| 298 | t |= (HT_SECONDARY_IF << 8); |
| 299 | |
Bartlomiej Zolnierkiewicz | e6d95bd | 2008-07-16 20:33:42 +0200 | [diff] [blame] | 300 | drive->drive_data = t; |
Bartlomiej Zolnierkiewicz | 1f2cf8b | 2008-02-02 19:56:40 +0100 | [diff] [blame] | 301 | } |
| 302 | |
Bartlomiej Zolnierkiewicz | ef87f8d | 2008-04-27 15:38:24 +0200 | [diff] [blame] | 303 | static int probe_ht6560b; |
Bartlomiej Zolnierkiewicz | 8491388 | 2007-03-03 17:48:55 +0100 | [diff] [blame] | 304 | |
| 305 | module_param_named(probe, probe_ht6560b, bool, 0); |
| 306 | MODULE_PARM_DESC(probe, "probe for HT6560B chipset"); |
| 307 | |
Bartlomiej Zolnierkiewicz | ac95bee | 2008-04-26 22:25:14 +0200 | [diff] [blame] | 308 | static const struct ide_port_ops ht6560b_port_ops = { |
Bartlomiej Zolnierkiewicz | e6d95bd | 2008-07-16 20:33:42 +0200 | [diff] [blame] | 309 | .init_dev = ht6560b_init_dev, |
Bartlomiej Zolnierkiewicz | ac95bee | 2008-04-26 22:25:14 +0200 | [diff] [blame] | 310 | .set_pio_mode = ht6560b_set_pio_mode, |
| 311 | .selectproc = ht6560b_selectproc, |
| 312 | }; |
| 313 | |
Bartlomiej Zolnierkiewicz | c413b9b | 2008-02-02 19:56:31 +0100 | [diff] [blame] | 314 | static const struct ide_port_info ht6560b_port_info __initdata = { |
Bartlomiej Zolnierkiewicz | d92f1a2 | 2008-04-26 22:25:18 +0200 | [diff] [blame] | 315 | .name = DRV_NAME, |
Bartlomiej Zolnierkiewicz | c413b9b | 2008-02-02 19:56:31 +0100 | [diff] [blame] | 316 | .chipset = ide_ht6560b, |
Bartlomiej Zolnierkiewicz | ac95bee | 2008-04-26 22:25:14 +0200 | [diff] [blame] | 317 | .port_ops = &ht6560b_port_ops, |
Bartlomiej Zolnierkiewicz | c413b9b | 2008-02-02 19:56:31 +0100 | [diff] [blame] | 318 | .host_flags = IDE_HFLAG_SERIALIZE | /* is this needed? */ |
| 319 | IDE_HFLAG_NO_DMA | |
Bartlomiej Zolnierkiewicz | c413b9b | 2008-02-02 19:56:31 +0100 | [diff] [blame] | 320 | IDE_HFLAG_ABUSE_PREFETCH, |
Jan Evert van Grootheest | 1a1990f | 2008-02-19 01:41:26 +0100 | [diff] [blame] | 321 | .pio_mask = ATA_PIO4, |
Bartlomiej Zolnierkiewicz | c413b9b | 2008-02-02 19:56:31 +0100 | [diff] [blame] | 322 | }; |
| 323 | |
Bartlomiej Zolnierkiewicz | ade2daf | 2008-01-26 20:13:07 +0100 | [diff] [blame] | 324 | static int __init ht6560b_init(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 325 | { |
Bartlomiej Zolnierkiewicz | 8491388 | 2007-03-03 17:48:55 +0100 | [diff] [blame] | 326 | if (probe_ht6560b == 0) |
| 327 | return -ENODEV; |
| 328 | |
Bartlomiej Zolnierkiewicz | 2e4ed29 | 2008-04-26 17:36:35 +0200 | [diff] [blame] | 329 | if (!request_region(HT_CONFIG_PORT, 1, DRV_NAME)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 330 | printk(KERN_NOTICE "%s: HT_CONFIG_PORT not found\n", |
Harvey Harrison | eb63963 | 2008-04-26 22:25:20 +0200 | [diff] [blame] | 331 | __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 332 | return -ENODEV; |
| 333 | } |
| 334 | |
| 335 | if (!try_to_init_ht6560b()) { |
Harvey Harrison | eb63963 | 2008-04-26 22:25:20 +0200 | [diff] [blame] | 336 | printk(KERN_NOTICE "%s: HBA not found\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 337 | goto release_region; |
| 338 | } |
| 339 | |
Bartlomiej Zolnierkiewicz | 0bfeee7 | 2008-04-26 22:25:16 +0200 | [diff] [blame] | 340 | return ide_legacy_device_add(&ht6560b_port_info, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 341 | |
| 342 | release_region: |
| 343 | release_region(HT_CONFIG_PORT, 1); |
| 344 | return -ENODEV; |
| 345 | } |
| 346 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 347 | module_init(ht6560b_init); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 348 | |
| 349 | MODULE_AUTHOR("See Local File"); |
| 350 | MODULE_DESCRIPTION("HT-6560B EIDE-controller support"); |
| 351 | MODULE_LICENSE("GPL"); |