1 files changed, 52 insertions, 193 deletions

diff --git a/drivers/ata/pata_hpt37x.c b/drivers/ata/pata_hpt37x.c
index 9a10878b2ad8..42163998de9a 100644
--- a/drivers/ata/pata_hpt37x.c
+++ b/drivers/ata/pata_hpt37x.c
@@ -283,7 +283,7 @@ static unsigned long hpt370_filter(struct ata_device *adev, unsigned long mask)
                 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
                         mask &= ~(0xE0 << ATA_SHIFT_UDMA);
         }
-        return ata_pci_default_filter(adev, mask);
+        return ata_bmdma_mode_filter(adev, mask);
 }
 
 /**
@@ -299,7 +299,7 @@ static unsigned long hpt370a_filter(struct ata_device *adev, unsigned long mask)
                 if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
                         mask &= ~(0xE0 << ATA_SHIFT_UDMA);
         }
-        return ata_pci_default_filter(adev, mask);
+        return ata_bmdma_mode_filter(adev, mask);
 }
 
 /**
@@ -338,22 +338,10 @@ static int hpt37x_pre_reset(struct ata_link *link, unsigned long deadline)
         pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
         udelay(100);
 
-        return ata_std_prereset(link, deadline);
+        return ata_sff_prereset(link, deadline);
 }
 
-/**
- *      hpt37x_error_handler    -       reset the hpt374
- *      @ap: ATA port to reset
- *
- *      Perform probe for HPT37x, except for HPT374 channel 2
- */
-
-static void hpt37x_error_handler(struct ata_port *ap)
-{
-        ata_bmdma_drive_eh(ap, hpt37x_pre_reset, ata_std_softreset, NULL, ata_std_postreset);
-}
-
-static int hpt374_pre_reset(struct ata_link *link, unsigned long deadline)
+static int hpt374_fn1_pre_reset(struct ata_link *link, unsigned long deadline)
 {
         static const struct pci_bits hpt37x_enable_bits[] = {
                 { 0x50, 1, 0x04, 0x04 },
@@ -386,26 +374,7 @@ static int hpt374_pre_reset(struct ata_link *link, unsigned long deadline)
         pci_write_config_byte(pdev, 0x50 + 4 * ap->port_no, 0x37);
         udelay(100);
 
-        return ata_std_prereset(link, deadline);
-}
-
-/**
- *      hpt374_error_handler    -       reset the hpt374
- *      @classes:
- *
- *      The 374 cable detect is a little different due to the extra
- *      channels. The function 0 channels work like usual but function 1
- *      is special
- */
-
-static void hpt374_error_handler(struct ata_port *ap)
-{
-        struct pci_dev *pdev = to_pci_dev(ap->host->dev);
-
-        if (!(PCI_FUNC(pdev->devfn) & 1))
-                hpt37x_error_handler(ap);
-        else
-                ata_bmdma_drive_eh(ap, hpt374_pre_reset, ata_std_softreset, NULL, ata_std_postreset);
+        return ata_sff_prereset(link, deadline);
 }
 
 /**
@@ -619,21 +588,7 @@ static void hpt37x_bmdma_stop(struct ata_queued_cmd *qc)
 
 
 static struct scsi_host_template hpt37x_sht = {
-        .module                 = THIS_MODULE,
-        .name                   = DRV_NAME,
-        .ioctl                  = ata_scsi_ioctl,
-        .queuecommand           = ata_scsi_queuecmd,
-        .can_queue              = ATA_DEF_QUEUE,
-        .this_id                = ATA_SHT_THIS_ID,
-        .sg_tablesize           = LIBATA_MAX_PRD,
-        .cmd_per_lun            = ATA_SHT_CMD_PER_LUN,
-        .emulated               = ATA_SHT_EMULATED,
-        .use_clustering         = ATA_SHT_USE_CLUSTERING,
-        .proc_name              = DRV_NAME,
-        .dma_boundary           = ATA_DMA_BOUNDARY,
-        .slave_configure        = ata_scsi_slave_config,
-        .slave_destroy          = ata_scsi_slave_destroy,
-        .bios_param             = ata_std_bios_param,
+        ATA_BMDMA_SHT(DRV_NAME),
 };
 
 /*
@@ -641,36 +596,15 @@ static struct scsi_host_template hpt37x_sht = {
  */
 
 static struct ata_port_operations hpt370_port_ops = {
-        .set_piomode    = hpt370_set_piomode,
-        .set_dmamode    = hpt370_set_dmamode,
-        .mode_filter    = hpt370_filter,
-
-        .tf_load        = ata_tf_load,
-        .tf_read        = ata_tf_read,
-        .check_status   = ata_check_status,
-        .exec_command   = ata_exec_command,
-        .dev_select     = ata_std_dev_select,
+        .inherits       = &ata_bmdma_port_ops,
 
-        .freeze         = ata_bmdma_freeze,
-        .thaw           = ata_bmdma_thaw,
-        .error_handler  = hpt37x_error_handler,
-        .post_internal_cmd = ata_bmdma_post_internal_cmd,
-
-        .bmdma_setup    = ata_bmdma_setup,
         .bmdma_start    = hpt370_bmdma_start,
         .bmdma_stop     = hpt370_bmdma_stop,
-        .bmdma_status   = ata_bmdma_status,
-
-        .qc_prep        = ata_qc_prep,
-        .qc_issue       = ata_qc_issue_prot,
-
-        .data_xfer      = ata_data_xfer,
-
-        .irq_handler    = ata_interrupt,
-        .irq_clear      = ata_bmdma_irq_clear,
-        .irq_on         = ata_irq_on,
 
-        .port_start     = ata_sff_port_start,
+        .mode_filter    = hpt370_filter,
+        .set_piomode    = hpt370_set_piomode,
+        .set_dmamode    = hpt370_set_dmamode,
+        .prereset       = hpt37x_pre_reset,
 };
 
 /*
@@ -678,36 +612,8 @@ static struct ata_port_operations hpt370_port_ops = {
  */
 
 static struct ata_port_operations hpt370a_port_ops = {
-        .set_piomode    = hpt370_set_piomode,
-        .set_dmamode    = hpt370_set_dmamode,
+        .inherits       = &hpt370_port_ops,
         .mode_filter    = hpt370a_filter,
-
-        .tf_load        = ata_tf_load,
-        .tf_read        = ata_tf_read,
-        .check_status   = ata_check_status,
-        .exec_command   = ata_exec_command,
-        .dev_select     = ata_std_dev_select,
-
-        .freeze         = ata_bmdma_freeze,
-        .thaw           = ata_bmdma_thaw,
-        .error_handler  = hpt37x_error_handler,
-        .post_internal_cmd = ata_bmdma_post_internal_cmd,
-
-        .bmdma_setup    = ata_bmdma_setup,
-        .bmdma_start    = hpt370_bmdma_start,
-        .bmdma_stop     = hpt370_bmdma_stop,
-        .bmdma_status   = ata_bmdma_status,
-
-        .qc_prep        = ata_qc_prep,
-        .qc_issue       = ata_qc_issue_prot,
-
-        .data_xfer      = ata_data_xfer,
-
-        .irq_handler    = ata_interrupt,
-        .irq_clear      = ata_bmdma_irq_clear,
-        .irq_on         = ata_irq_on,
-
-        .port_start     = ata_sff_port_start,
 };
 
 /*
@@ -716,74 +622,23 @@ static struct ata_port_operations hpt370a_port_ops = {
  */
 
 static struct ata_port_operations hpt372_port_ops = {
-        .set_piomode    = hpt372_set_piomode,
-        .set_dmamode    = hpt372_set_dmamode,
-        .mode_filter    = ata_pci_default_filter,
-
-        .tf_load        = ata_tf_load,
-        .tf_read        = ata_tf_read,
-        .check_status   = ata_check_status,
-        .exec_command   = ata_exec_command,
-        .dev_select     = ata_std_dev_select,
+        .inherits       = &ata_bmdma_port_ops,
 
-        .freeze         = ata_bmdma_freeze,
-        .thaw           = ata_bmdma_thaw,
-        .error_handler  = hpt37x_error_handler,
-        .post_internal_cmd = ata_bmdma_post_internal_cmd,
-
-        .bmdma_setup    = ata_bmdma_setup,
-        .bmdma_start    = ata_bmdma_start,
         .bmdma_stop     = hpt37x_bmdma_stop,
-        .bmdma_status   = ata_bmdma_status,
-
-        .qc_prep        = ata_qc_prep,
-        .qc_issue       = ata_qc_issue_prot,
-
-        .data_xfer      = ata_data_xfer,
-
-        .irq_handler    = ata_interrupt,
-        .irq_clear      = ata_bmdma_irq_clear,
-        .irq_on         = ata_irq_on,
 
-        .port_start     = ata_sff_port_start,
+        .set_piomode    = hpt372_set_piomode,
+        .set_dmamode    = hpt372_set_dmamode,
+        .prereset       = hpt37x_pre_reset,
 };
 
 /*
  *      Configuration for HPT374. Mode setting works like 372 and friends
- *      but we have a different cable detection procedure.
+ *      but we have a different cable detection procedure for function 1.
  */
 
-static struct ata_port_operations hpt374_port_ops = {
-        .set_piomode    = hpt372_set_piomode,
-        .set_dmamode    = hpt372_set_dmamode,
-        .mode_filter    = ata_pci_default_filter,
-
-        .tf_load        = ata_tf_load,
-        .tf_read        = ata_tf_read,
-        .check_status   = ata_check_status,
-        .exec_command   = ata_exec_command,
-        .dev_select     = ata_std_dev_select,
-
-        .freeze         = ata_bmdma_freeze,
-        .thaw           = ata_bmdma_thaw,
-        .error_handler  = hpt374_error_handler,
-        .post_internal_cmd = ata_bmdma_post_internal_cmd,
-
-        .bmdma_setup    = ata_bmdma_setup,
-        .bmdma_start    = ata_bmdma_start,
-        .bmdma_stop     = hpt37x_bmdma_stop,
-        .bmdma_status   = ata_bmdma_status,
-
-        .qc_prep        = ata_qc_prep,
-        .qc_issue       = ata_qc_issue_prot,
-
-        .data_xfer      = ata_data_xfer,
-
-        .irq_handler    = ata_interrupt,
-        .irq_clear      = ata_bmdma_irq_clear,
-        .irq_on         = ata_irq_on,
-
-        .port_start     = ata_sff_port_start,
+static struct ata_port_operations hpt374_fn1_port_ops = {
+        .inherits       = &hpt372_port_ops,
+        .prereset       = hpt374_fn1_pre_reset,
 };
 
 /**
@@ -897,7 +752,6 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
 {
         /* HPT370 - UDMA100 */
         static const struct ata_port_info info_hpt370 = {
-                .sht = &hpt37x_sht,
                 .flags = ATA_FLAG_SLAVE_POSS,
                 .pio_mask = 0x1f,
                 .mwdma_mask = 0x07,
@@ -906,7 +760,6 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
         };
         /* HPT370A - UDMA100 */
         static const struct ata_port_info info_hpt370a = {
-                .sht = &hpt37x_sht,
                 .flags = ATA_FLAG_SLAVE_POSS,
                 .pio_mask = 0x1f,
                 .mwdma_mask = 0x07,
@@ -915,7 +768,6 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
         };
         /* HPT370 - UDMA100 */
         static const struct ata_port_info info_hpt370_33 = {
-                .sht = &hpt37x_sht,
                 .flags = ATA_FLAG_SLAVE_POSS,
                 .pio_mask = 0x1f,
                 .mwdma_mask = 0x07,
@@ -924,7 +776,6 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
         };
         /* HPT370A - UDMA100 */
         static const struct ata_port_info info_hpt370a_33 = {
-                .sht = &hpt37x_sht,
                 .flags = ATA_FLAG_SLAVE_POSS,
                 .pio_mask = 0x1f,
                 .mwdma_mask = 0x07,
@@ -933,28 +784,31 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
         };
         /* HPT371, 372 and friends - UDMA133 */
         static const struct ata_port_info info_hpt372 = {
-                .sht = &hpt37x_sht,
                 .flags = ATA_FLAG_SLAVE_POSS,
                 .pio_mask = 0x1f,
                 .mwdma_mask = 0x07,
                 .udma_mask = ATA_UDMA6,
                 .port_ops = &hpt372_port_ops
         };
-        /* HPT374 - UDMA100 */
-        static const struct ata_port_info info_hpt374 = {
-                .sht = &hpt37x_sht,
+        /* HPT374 - UDMA100, function 1 uses different prereset method */
+        static const struct ata_port_info info_hpt374_fn0 = {
                 .flags = ATA_FLAG_SLAVE_POSS,
                 .pio_mask = 0x1f,
                 .mwdma_mask = 0x07,
                 .udma_mask = ATA_UDMA5,
-                .port_ops = &hpt374_port_ops
+                .port_ops = &hpt372_port_ops
+        };
+        static const struct ata_port_info info_hpt374_fn1 = {
+                .flags = ATA_FLAG_SLAVE_POSS,
+                .pio_mask = 0x1f,
+                .mwdma_mask = 0x07,
+                .udma_mask = ATA_UDMA5,
+                .port_ops = &hpt374_fn1_port_ops
         };
 
         static const int MHz[4] = { 33, 40, 50, 66 };
-        const struct ata_port_info *port;
         void *private_data = NULL;
-        struct ata_port_info port_info;
-        const struct ata_port_info *ppi[] = { &port_info, NULL };
+        const struct ata_port_info *ppi[] = { NULL, NULL };
 
         u8 irqmask;
         u32 class_rev;
@@ -966,6 +820,11 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
 
         const struct hpt_chip *chip_table;
         int clock_slot;
+        int rc;
+
+        rc = pcim_enable_device(dev);
+        if (rc)
+                return rc;
 
         pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev);
         class_rev &= 0xFF;
@@ -981,17 +840,17 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
 
                 switch(class_rev) {
                         case 3:
-                                port = &info_hpt370;
+                                ppi[0] = &info_hpt370;
                                 chip_table = &hpt370;
                                 prefer_dpll = 0;
                                 break;
                         case 4:
-                                port = &info_hpt370a;
+                                ppi[0] = &info_hpt370a;
                                 chip_table = &hpt370a;
                                 prefer_dpll = 0;
                                 break;
                         case 5:
-                                port = &info_hpt372;
+                                ppi[0] = &info_hpt372;
                                 chip_table = &hpt372;
                                 break;
                         default:
@@ -1004,21 +863,21 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
                                 /* 372N if rev >= 2*/
                                 if (class_rev >= 2)
                                         return -ENODEV;
-                                port = &info_hpt372;
+                                ppi[0] = &info_hpt372;
                                 chip_table = &hpt372a;
                                 break;
                         case PCI_DEVICE_ID_TTI_HPT302:
                                 /* 302N if rev > 1 */
                                 if (class_rev > 1)
                                         return -ENODEV;
-                                port = &info_hpt372;
+                                ppi[0] = &info_hpt372;
                                 /* Check this */
                                 chip_table = &hpt302;
                                 break;
                         case PCI_DEVICE_ID_TTI_HPT371:
                                 if (class_rev > 1)
                                         return -ENODEV;
-                                port = &info_hpt372;
+                                ppi[0] = &info_hpt372;
                                 chip_table = &hpt371;
                                 /* Single channel device, master is not present
                                    but the BIOS (or us for non x86) must mark it
@@ -1029,7 +888,10 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
                                 break;
                         case PCI_DEVICE_ID_TTI_HPT374:
                                 chip_table = &hpt374;
-                                port = &info_hpt374;
+                                if (!(PCI_FUNC(dev->devfn) & 1))
+                                        *ppi = &info_hpt374_fn0;
+                                else
+                                        *ppi = &info_hpt374_fn1;
                                 break;
                         default:
                                 printk(KERN_ERR "pata_hpt37x: PCI table is bogus please report (%d).\n", dev->device);
@@ -1108,7 +970,7 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
                 int dpll, adjust;
 
                 /* Compute DPLL */
-                dpll = (port->udma_mask & 0xC0) ? 3 : 2;
+                dpll = (ppi[0]->udma_mask & 0xC0) ? 3 : 2;
 
                 f_low = (MHz[clock_slot] * 48) / MHz[dpll];
                 f_high = f_low + 2;
@@ -1148,19 +1010,16 @@ static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
                  *      about lack of UDMA133 support on lower clocks
                  */
 
-                if (clock_slot < 2 && port == &info_hpt370)
-                        port = &info_hpt370_33;
-                if (clock_slot < 2 && port == &info_hpt370a)
-                        port = &info_hpt370a_33;
+                if (clock_slot < 2 && ppi[0] == &info_hpt370)
+                        ppi[0] = &info_hpt370_33;
+                if (clock_slot < 2 && ppi[0] == &info_hpt370a)
+                        ppi[0] = &info_hpt370a_33;
                 printk(KERN_INFO "pata_hpt37x: %s using %dMHz bus clock.\n",
                        chip_table->name, MHz[clock_slot]);
         }
 
         /* Now kick off ATA set up */
-        port_info = *port;
-        port_info.private_data = private_data;
-
-        return ata_pci_init_one(dev, ppi);
+        return ata_pci_sff_init_one(dev, ppi, &hpt37x_sht, private_data);
 }
 
 static const struct pci_device_id hpt37x[] = {