9 files changed, 128 insertions, 13 deletions

diff --git a/drivers/ide/legacy/Makefile b/drivers/ide/legacy/Makefile
index 7043ec7d1e0..6939329f89e 100644
--- a/drivers/ide/legacy/Makefile
+++ b/drivers/ide/legacy/Makefile
@@ -6,6 +6,7 @@ obj-$(CONFIG_BLK_DEV_UMC8672)		+= umc8672.o
 obj-$(CONFIG_BLK_DEV_DTC2278)           += dtc2278.o
 obj-$(CONFIG_BLK_DEV_HT6560B)           += ht6560b.o
 obj-$(CONFIG_BLK_DEV_QD65XX)            += qd65xx.o
+obj-$(CONFIG_BLK_DEV_4DRIVES)           += ide-4drives.o
 
 obj-$(CONFIG_BLK_DEV_GAYLE)             += gayle.o
 obj-$(CONFIG_BLK_DEV_FALCON_IDE)        += falconide.o
diff --git a/drivers/ide/legacy/ali14xx.c b/drivers/ide/legacy/ali14xx.c
index d4d1a6bea59..bc8b1f8de61 100644
--- a/drivers/ide/legacy/ali14xx.c
+++ b/drivers/ide/legacy/ali14xx.c
@@ -200,6 +200,7 @@ static const struct ide_port_info ali14xx_port_info = {
 static int __init ali14xx_probe(void)
 {
         static u8 idx[4] = { 0, 1, 0xff, 0xff };
+        hw_regs_t hw[2];
 
         printk(KERN_DEBUG "ali14xx: base=0x%03x, regOn=0x%02x.\n",
                           basePort, regOn);
@@ -210,6 +211,17 @@ static int __init ali14xx_probe(void)
                 return 1;
         }
 
+        memset(&hw, 0, sizeof(hw));
+
+        ide_std_init_ports(&hw[0], 0x1f0, 0x3f6);
+        hw[0].irq = 14;
+
+        ide_std_init_ports(&hw[1], 0x170, 0x376);
+        hw[1].irq = 15;
+
+        ide_init_port_hw(&ide_hwifs[0], &hw[0]);
+        ide_init_port_hw(&ide_hwifs[1], &hw[1]);
+
         ide_hwifs[0].set_pio_mode = &ali14xx_set_pio_mode;
         ide_hwifs[1].set_pio_mode = &ali14xx_set_pio_mode;
 
diff --git a/drivers/ide/legacy/dtc2278.c b/drivers/ide/legacy/dtc2278.c
index 73396f70f2b..5f69cd2ea6f 100644
--- a/drivers/ide/legacy/dtc2278.c
+++ b/drivers/ide/legacy/dtc2278.c
@@ -103,6 +103,7 @@ static int __init dtc2278_probe(void)
         unsigned long flags;
         ide_hwif_t *hwif, *mate;
         static u8 idx[4] = { 0, 1, 0xff, 0xff };
+        hw_regs_t hw[2];
 
         hwif = &ide_hwifs[0];
         mate = &ide_hwifs[1];
@@ -128,6 +129,17 @@ static int __init dtc2278_probe(void)
 #endif
         local_irq_restore(flags);
 
+        memset(&hw, 0, sizeof(hw));
+
+        ide_std_init_ports(&hw[0], 0x1f0, 0x3f6);
+        hw[0].irq = 14;
+
+        ide_std_init_ports(&hw[1], 0x170, 0x376);
+        hw[1].irq = 15;
+
+        ide_init_port_hw(hwif, &hw[0]);
+        ide_init_port_hw(mate, &hw[1]);
+
         hwif->set_pio_mode = &dtc2278_set_pio_mode;
 
         ide_device_add(idx, &dtc2278_port_info);
diff --git a/drivers/ide/legacy/ht6560b.c b/drivers/ide/legacy/ht6560b.c
index 78ca68e60f9..88fe9070c9c 100644
--- a/drivers/ide/legacy/ht6560b.c
+++ b/drivers/ide/legacy/ht6560b.c
@@ -82,7 +82,7 @@
  * out how they setup those cycle time interfacing values, as they at Holtek
  * call them. IDESETUP.COM that is supplied with the drivers figures out
  * optimal values and fetches those values to drivers. I found out that
- * they use IDE_SELECT_REG to fetch timings to the ide board right after
+ * they use Select register to fetch timings to the ide board right after
  * interface switching. After that it was quite easy to add code to
  * ht6560b.c.
  *
@@ -127,6 +127,7 @@
  */
 static void ht6560b_selectproc (ide_drive_t *drive)
 {
+        ide_hwif_t *hwif = drive->hwif;
         unsigned long flags;
         static u8 current_select = 0;
         static u8 current_timing = 0;
@@ -155,8 +156,8 @@ static void ht6560b_selectproc (ide_drive_t *drive)
                 /*
                  * Set timing for this drive:
                  */
-                outb(timing, IDE_SELECT_REG);
-                (void)inb(IDE_STATUS_REG);
+                outb(timing, hwif->io_ports[IDE_SELECT_OFFSET]);
+                (void)inb(hwif->io_ports[IDE_STATUS_OFFSET]);
 #ifdef DEBUG
                 printk("ht6560b: %s: select=%#x timing=%#x\n",
                         drive->name, select, timing);
@@ -193,9 +194,9 @@ static int __init try_to_init_ht6560b(void)
          * Ht6560b autodetected
          */
         outb(HT_CONFIG_DEFAULT, HT_CONFIG_PORT);
-        outb(HT_TIMING_DEFAULT, 0x1f6);  /* IDE_SELECT_REG */
-        (void) inb(0x1f7);               /* IDE_STATUS_REG */
-        
+        outb(HT_TIMING_DEFAULT, 0x1f6); /* Select register */
+        (void)inb(0x1f7);               /* Status register */
+
         printk("ht6560b " HT6560B_VERSION
                ": chipset detected and initialized"
 #ifdef DEBUG
@@ -339,6 +340,7 @@ static int __init ht6560b_init(void)
 {
         ide_hwif_t *hwif, *mate;
         static u8 idx[4] = { 0, 1, 0xff, 0xff };
+        hw_regs_t hw[2];
 
         if (probe_ht6560b == 0)
                 return -ENODEV;
@@ -357,6 +359,17 @@ static int __init ht6560b_init(void)
                 goto release_region;
         }
 
+        memset(&hw, 0, sizeof(hw));
+
+        ide_std_init_ports(&hw[0], 0x1f0, 0x3f6);
+        hw[0].irq = 14;
+
+        ide_std_init_ports(&hw[1], 0x170, 0x376);
+        hw[1].irq = 15;
+
+        ide_init_port_hw(hwif, &hw[0]);
+        ide_init_port_hw(mate, &hw[1]);
+
         hwif->selectproc = &ht6560b_selectproc;
         hwif->set_pio_mode = &ht6560b_set_pio_mode;
 
diff --git a/drivers/ide/legacy/ide-4drives.c b/drivers/ide/legacy/ide-4drives.c
new file mode 100644
index 00000000000..ecd7f355355
--- /dev/null
+++ b/drivers/ide/legacy/ide-4drives.c
@@ -0,0 +1,50 @@
+
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/ide.h>
+
+int probe_4drives = 0;
+
+module_param_named(probe, probe_4drives, bool, 0);
+MODULE_PARM_DESC(probe, "probe for generic IDE chipset with 4 drives/port");
+
+static int __init ide_4drives_init(void)
+{
+        ide_hwif_t *hwif, *mate;
+        u8 idx[4] = { 0, 1, 0xff, 0xff };
+        hw_regs_t hw;
+
+        if (probe_4drives == 0)
+                return -ENODEV;
+
+        hwif = &ide_hwifs[0];
+        mate = &ide_hwifs[1];
+
+        memset(&hw, 0, sizeof(hw));
+
+        ide_std_init_ports(&hw, 0x1f0, 0x3f6);
+        hw.irq = 14;
+        hw.chipset = ide_4drives;
+
+        ide_init_port_hw(hwif, &hw);
+        ide_init_port_hw(mate, &hw);
+
+        mate->drives[0].select.all ^= 0x20;
+        mate->drives[1].select.all ^= 0x20;
+
+        hwif->mate = mate;
+        mate->mate = hwif;
+
+        hwif->serialized = mate->serialized = 1;
+
+        ide_device_add(idx, NULL);
+
+        return 0;
+}
+
+module_init(ide_4drives_init);
+
+MODULE_AUTHOR("Bartlomiej Zolnierkiewicz");
+MODULE_DESCRIPTION("generic IDE chipset with 4 drives/port support");
+MODULE_LICENSE("GPL");
diff --git a/drivers/ide/legacy/ide-cs.c b/drivers/ide/legacy/ide-cs.c
index 15ccf6944ae..9a23b94f293 100644
--- a/drivers/ide/legacy/ide-cs.c
+++ b/drivers/ide/legacy/ide-cs.c
@@ -156,15 +156,15 @@ static int idecs_register(unsigned long io, unsigned long ctl, unsigned long irq
     hw.chipset = ide_pci;
     hw.dev = &handle->dev;
 
-    hwif = ide_deprecated_find_port(hw.io_ports[IDE_DATA_OFFSET]);
+    hwif = ide_find_port(hw.io_ports[IDE_DATA_OFFSET]);
     if (hwif == NULL)
         return -1;
 
     i = hwif->index;
 
     if (hwif->present)
-        ide_unregister(i, 0, 0);
-    else if (!hwif->hold)
+        ide_unregister(i);
+    else
         ide_init_port_data(hwif, i);
 
     ide_init_port_hw(hwif, &hw);
@@ -360,7 +360,7 @@ void ide_release(struct pcmcia_device *link)
     if (info->ndev) {
         /* FIXME: if this fails we need to queue the cleanup somehow
            -- need to investigate the required PCMCIA magic */
-        ide_unregister(info->hd, 0, 0);
+        ide_unregister(info->hd);
     }
     info->ndev = 0;
 
diff --git a/drivers/ide/legacy/ide_platform.c b/drivers/ide/legacy/ide_platform.c
index 688fcae1748..249651e2da4 100644
--- a/drivers/ide/legacy/ide_platform.c
+++ b/drivers/ide/legacy/ide_platform.c
@@ -122,7 +122,7 @@ static int __devexit plat_ide_remove(struct platform_device *pdev)
 {
         ide_hwif_t *hwif = pdev->dev.driver_data;
 
-        ide_unregister(hwif->index, 0, 0);
+        ide_unregister(hwif->index);
 
         return 0;
 }
diff --git a/drivers/ide/legacy/qd65xx.c b/drivers/ide/legacy/qd65xx.c
index 2f4f47ad602..7016bdf4fcc 100644
--- a/drivers/ide/legacy/qd65xx.c
+++ b/drivers/ide/legacy/qd65xx.c
@@ -352,9 +352,9 @@ static const struct ide_port_info qd65xx_port_info __initdata = {
 static int __init qd_probe(int base)
 {
         ide_hwif_t *hwif;
+        u8 config, unit;
         u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
-        u8 config;
-        u8 unit;
+        hw_regs_t hw[2];
 
         config = inb(QD_CONFIG_PORT);
 
@@ -363,6 +363,14 @@ static int __init qd_probe(int base)
 
         unit = ! (config & QD_CONFIG_IDE_BASEPORT);
 
+        memset(&hw, 0, sizeof(hw));
+
+        ide_std_init_ports(&hw[0], 0x1f0, 0x3f6);
+        hw[0].irq = 14;
+
+        ide_std_init_ports(&hw[1], 0x170, 0x376);
+        hw[1].irq = 15;
+
         if ((config & 0xf0) == QD_CONFIG_QD6500) {
 
                 if (qd_testreg(base)) return 1;         /* bad register */
@@ -379,6 +387,8 @@ static int __init qd_probe(int base)
                         return 1;
                 }
 
+                ide_init_port_hw(hwif, &hw[unit]);
+
                 qd_setup(hwif, base, config);
 
                 hwif->port_init_devs = qd6500_port_init_devs;
@@ -416,6 +426,8 @@ static int __init qd_probe(int base)
                         printk(KERN_INFO "%s: qd6580: single IDE board\n",
                                          hwif->name);
 
+                        ide_init_port_hw(hwif, &hw[unit]);
+
                         qd_setup(hwif, base, config | (control << 8));
 
                         hwif->port_init_devs = qd6580_port_init_devs;
@@ -435,6 +447,9 @@ static int __init qd_probe(int base)
                         printk(KERN_INFO "%s&%s: qd6580: dual IDE board\n",
                                         hwif->name, mate->name);
 
+                        ide_init_port_hw(hwif, &hw[0]);
+                        ide_init_port_hw(mate, &hw[1]);
+
                         qd_setup(hwif, base, config | (control << 8));
 
                         hwif->port_init_devs = qd6580_port_init_devs;
diff --git a/drivers/ide/legacy/umc8672.c b/drivers/ide/legacy/umc8672.c
index 5696ba02600..bc1944811b9 100644
--- a/drivers/ide/legacy/umc8672.c
+++ b/drivers/ide/legacy/umc8672.c
@@ -130,6 +130,7 @@ static int __init umc8672_probe(void)
 {
         unsigned long flags;
         static u8 idx[4] = { 0, 1, 0xff, 0xff };
+        hw_regs_t hw[2];
 
         if (!request_region(0x108, 2, "umc8672")) {
                 printk(KERN_ERR "umc8672: ports 0x108-0x109 already in use.\n");
@@ -148,6 +149,17 @@ static int __init umc8672_probe(void)
         umc_set_speeds (current_speeds);
         local_irq_restore(flags);
 
+        memset(&hw, 0, sizeof(hw));
+
+        ide_std_init_ports(&hw[0], 0x1f0, 0x3f6);
+        hw[0].irq = 14;
+
+        ide_std_init_ports(&hw[1], 0x170, 0x376);
+        hw[1].irq = 15;
+
+        ide_init_port_hw(&ide_hwifs[0], &hw[0]);
+        ide_init_port_hw(&ide_hwifs[1], &hw[1]);
+
         ide_hwifs[0].set_pio_mode = &umc_set_pio_mode;
         ide_hwifs[1].set_pio_mode = &umc_set_pio_mode;