diff options
Diffstat (limited to 'drivers/ide/legacy/ide-4drives.c')
-rw-r--r-- | drivers/ide/legacy/ide-4drives.c | 34 |
1 files changed, 20 insertions, 14 deletions
diff --git a/drivers/ide/legacy/ide-4drives.c b/drivers/ide/legacy/ide-4drives.c index ecd7f3553554..d7bc94f94a39 100644 --- a/drivers/ide/legacy/ide-4drives.c +++ b/drivers/ide/legacy/ide-4drives.c | |||
@@ -12,31 +12,37 @@ MODULE_PARM_DESC(probe, "probe for generic IDE chipset with 4 drives/port"); | |||
12 | static int __init ide_4drives_init(void) | 12 | static int __init ide_4drives_init(void) |
13 | { | 13 | { |
14 | ide_hwif_t *hwif, *mate; | 14 | ide_hwif_t *hwif, *mate; |
15 | u8 idx[4] = { 0, 1, 0xff, 0xff }; | 15 | u8 idx[4] = { 0xff, 0xff, 0xff, 0xff }; |
16 | hw_regs_t hw; | 16 | hw_regs_t hw; |
17 | 17 | ||
18 | if (probe_4drives == 0) | 18 | if (probe_4drives == 0) |
19 | return -ENODEV; | 19 | return -ENODEV; |
20 | 20 | ||
21 | hwif = &ide_hwifs[0]; | ||
22 | mate = &ide_hwifs[1]; | ||
23 | |||
24 | memset(&hw, 0, sizeof(hw)); | 21 | memset(&hw, 0, sizeof(hw)); |
25 | 22 | ||
26 | ide_std_init_ports(&hw, 0x1f0, 0x3f6); | 23 | ide_std_init_ports(&hw, 0x1f0, 0x3f6); |
27 | hw.irq = 14; | 24 | hw.irq = 14; |
28 | hw.chipset = ide_4drives; | 25 | hw.chipset = ide_4drives; |
29 | 26 | ||
30 | ide_init_port_hw(hwif, &hw); | 27 | hwif = ide_find_port(); |
31 | ide_init_port_hw(mate, &hw); | 28 | if (hwif) { |
32 | 29 | ide_init_port_hw(hwif, &hw); | |
33 | mate->drives[0].select.all ^= 0x20; | 30 | idx[0] = hwif->index; |
34 | mate->drives[1].select.all ^= 0x20; | 31 | } |
35 | 32 | ||
36 | hwif->mate = mate; | 33 | mate = ide_find_port(); |
37 | mate->mate = hwif; | 34 | if (mate) { |
38 | 35 | ide_init_port_hw(mate, &hw); | |
39 | hwif->serialized = mate->serialized = 1; | 36 | mate->drives[0].select.all ^= 0x20; |
37 | mate->drives[1].select.all ^= 0x20; | ||
38 | idx[1] = mate->index; | ||
39 | |||
40 | if (hwif) { | ||
41 | hwif->mate = mate; | ||
42 | mate->mate = hwif; | ||
43 | hwif->serialized = mate->serialized = 1; | ||
44 | } | ||
45 | } | ||
40 | 46 | ||
41 | ide_device_add(idx, NULL); | 47 | ide_device_add(idx, NULL); |
42 | 48 | ||