pata_hpt366: add enablebits checking
PATCH 1/1 pata_hpt366: add enablebits checking
Based on Sergei's older work on IDE hpt366 host driver.
Signed-off-by Bartlomiej Zolnierkiewicz <[email protected]>
--- drivers/ata/pata_hpt366.c | 32 ++++++++++++++++++++++++++++++++ 1 file changed, 32 insertions(+)
drivers/ata/pata_hpt366.c +32 -0
@@ -204,6 +204,37 @@ static int hpt36x_cable_detect(struct atreturn ATA_CBL_PATA80 ; } +/** +* hpt36x_prereset - perform reset handling +* @link: ATA link to reset +* @deadline: deadline jiffies for the operation +* +* Perform the initial reset handling for the HPT36x. +*/ + +static int hpt36x_prereset (struct ata_link *link,unsigned long deadline) +{ +static const struct pci_bits hpt36x_enable_bits[] = { + {0x50 ,1 ,0x10 ,0x10 }, + {0x50 ,1 ,0x20 ,0x20 } + }; + +struct ata_port *ap = link->ap; +struct pci_dev *pdev =to_pci_dev (ap->host->dev); + +/* +* HPT36x chips have one channel per function and have +* both channel enable bits located differently and visible +* to both functions -- really stupid design decision... :-( +* Bit 4 is for the primary channel, bit 5 for the secondary. +*/ +if (!pci_test_config_bits (pdev, + &hpt36x_enable_bits[PCI_FUNC (pdev->devfn) &1 ])) +return -ENOENT ; + +return ata_sff_prereset (link, deadline); +} +static void hpt366_set_mode (struct ata_port *ap,struct ata_device *adev,u8 mode) {
@@ -284,6 +315,7 @@ static struct scsi_host_template hpt36x_static struct ata_port_operations hpt366_port_ops = { .inherits = &ata_bmdma32_port_ops, + .prereset = hpt36x_prereset, .cable_detect = hpt36x_cable_detect, .mode_filter = hpt366_filter, .set_piomode = hpt366_set_piomode,