linux/drivers/ata/pata_marvell.c
<<
>>
Prefs
   1/*
   2 *      Marvell PATA driver.
   3 *
   4 *      For the moment we drive the PATA port in legacy mode. That
   5 *      isn't making full use of the device functionality but it is
   6 *      easy to get working.
   7 *
   8 *      (c) 2006 Red Hat
   9 */
  10
  11#include <linux/kernel.h>
  12#include <linux/module.h>
  13#include <linux/pci.h>
  14#include <linux/init.h>
  15#include <linux/blkdev.h>
  16#include <linux/delay.h>
  17#include <linux/device.h>
  18#include <scsi/scsi_host.h>
  19#include <linux/libata.h>
  20#include <linux/ata.h>
  21
  22#define DRV_NAME        "pata_marvell"
  23#define DRV_VERSION     "0.1.6"
  24
  25/**
  26 *      marvell_pata_active     -       check if PATA is active
  27 *      @pdev: PCI device
  28 *
  29 *      Returns 1 if the PATA port may be active. We know how to check this
  30 *      for the 6145 but not the other devices
  31 */
  32
  33static int marvell_pata_active(struct pci_dev *pdev)
  34{
  35        int i;
  36        u32 devices;
  37        void __iomem *barp;
  38
  39        /* We don't yet know how to do this for other devices */
  40        if (pdev->device != 0x6145)
  41                return 1;
  42
  43        barp = pci_iomap(pdev, 5, 0x10);
  44        if (barp == NULL)
  45                return -ENOMEM;
  46
  47        printk("BAR5:");
  48        for(i = 0; i <= 0x0F; i++)
  49                printk("%02X:%02X ", i, ioread8(barp + i));
  50        printk("\n");
  51
  52        devices = ioread32(barp + 0x0C);
  53        pci_iounmap(pdev, barp);
  54
  55        if (devices & 0x10)
  56                return 1;
  57        return 0;
  58}
  59
  60/**
  61 *      marvell_pre_reset       -       probe begin
  62 *      @link: link
  63 *      @deadline: deadline jiffies for the operation
  64 *
  65 *      Perform the PATA port setup we need.
  66 */
  67
  68static int marvell_pre_reset(struct ata_link *link, unsigned long deadline)
  69{
  70        struct ata_port *ap = link->ap;
  71        struct pci_dev *pdev = to_pci_dev(ap->host->dev);
  72
  73        if (pdev->device == 0x6145 && ap->port_no == 0 &&
  74                !marvell_pata_active(pdev))     /* PATA enable ? */
  75                        return -ENOENT;
  76
  77        return ata_sff_prereset(link, deadline);
  78}
  79
  80static int marvell_cable_detect(struct ata_port *ap)
  81{
  82        /* Cable type */
  83        switch(ap->port_no)
  84        {
  85        case 0:
  86                if (ioread8(ap->ioaddr.bmdma_addr + 1) & 1)
  87                        return ATA_CBL_PATA40;
  88                return ATA_CBL_PATA80;
  89        case 1: /* Legacy SATA port */
  90                return ATA_CBL_SATA;
  91        }
  92
  93        BUG();
  94        return 0;       /* Our BUG macro needs the right markup */
  95}
  96
  97/* No PIO or DMA methods needed for this device */
  98
  99static struct scsi_host_template marvell_sht = {
 100        ATA_BMDMA_SHT(DRV_NAME),
 101};
 102
 103static struct ata_port_operations marvell_ops = {
 104        .inherits               = &ata_bmdma_port_ops,
 105        .cable_detect           = marvell_cable_detect,
 106        .prereset               = marvell_pre_reset,
 107};
 108
 109
 110/**
 111 *      marvell_init_one - Register Marvell ATA PCI device with kernel services
 112 *      @pdev: PCI device to register
 113 *      @ent: Entry in marvell_pci_tbl matching with @pdev
 114 *
 115 *      Called from kernel PCI layer.
 116 *
 117 *      LOCKING:
 118 *      Inherited from PCI layer (may sleep).
 119 *
 120 *      RETURNS:
 121 *      Zero on success, or -ERRNO value.
 122 */
 123
 124static int marvell_init_one (struct pci_dev *pdev, const struct pci_device_id *id)
 125{
 126        static const struct ata_port_info info = {
 127                .flags          = ATA_FLAG_SLAVE_POSS,
 128
 129                .pio_mask       = ATA_PIO4,
 130                .mwdma_mask     = ATA_MWDMA2,
 131                .udma_mask      = ATA_UDMA5,
 132
 133                .port_ops       = &marvell_ops,
 134        };
 135        static const struct ata_port_info info_sata = {
 136                /* Slave possible as its magically mapped not real */
 137                .flags          = ATA_FLAG_SLAVE_POSS,
 138
 139                .pio_mask       = ATA_PIO4,
 140                .mwdma_mask     = ATA_MWDMA2,
 141                .udma_mask      = ATA_UDMA6,
 142
 143                .port_ops       = &marvell_ops,
 144        };
 145        const struct ata_port_info *ppi[] = { &info, &info_sata };
 146
 147        if (pdev->device == 0x6101)
 148                ppi[1] = &ata_dummy_port_info;
 149
 150#if defined(CONFIG_SATA_AHCI) || defined(CONFIG_SATA_AHCI_MODULE)
 151        if (!marvell_pata_active(pdev)) {
 152                printk(KERN_INFO DRV_NAME ": PATA port not active, deferring to AHCI driver.\n");
 153                return -ENODEV;
 154        }
 155#endif
 156        return ata_pci_bmdma_init_one(pdev, ppi, &marvell_sht, NULL, 0);
 157}
 158
 159static const struct pci_device_id marvell_pci_tbl[] = {
 160        { PCI_DEVICE(0x11AB, 0x6101), },
 161        { PCI_DEVICE(0x11AB, 0x6121), },
 162        { PCI_DEVICE(0x11AB, 0x6123), },
 163        { PCI_DEVICE(0x11AB, 0x6145), },
 164        { PCI_DEVICE(0x1B4B, 0x91A0), },
 165        { PCI_DEVICE(0x1B4B, 0x91A4), },
 166
 167        { }     /* terminate list */
 168};
 169
 170static struct pci_driver marvell_pci_driver = {
 171        .name                   = DRV_NAME,
 172        .id_table               = marvell_pci_tbl,
 173        .probe                  = marvell_init_one,
 174        .remove                 = ata_pci_remove_one,
 175#ifdef CONFIG_PM
 176        .suspend                = ata_pci_device_suspend,
 177        .resume                 = ata_pci_device_resume,
 178#endif
 179};
 180
 181module_pci_driver(marvell_pci_driver);
 182
 183MODULE_AUTHOR("Alan Cox");
 184MODULE_DESCRIPTION("SCSI low-level driver for Marvell ATA in legacy mode");
 185MODULE_LICENSE("GPL");
 186MODULE_DEVICE_TABLE(pci, marvell_pci_tbl);
 187MODULE_VERSION(DRV_VERSION);
 188
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.