123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180 |
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/pci.h>
- #include <linux/blkdev.h>
- #include <linux/delay.h>
- #include <linux/device.h>
- #include <scsi/scsi_host.h>
- #include <linux/libata.h>
- #include <linux/dmi.h>
- #define DRV_NAME "pata_sch"
- #define DRV_VERSION "0.2"
- enum {
- D0TIM = 0x80,
- D1TIM = 0x84,
- PM = 0x07,
- MDM = (0x03 << 8),
- UDM = (0x07 << 16),
- PPE = (1 << 30),
- USD = (1 << 31),
- };
- static int sch_init_one(struct pci_dev *pdev,
- const struct pci_device_id *ent);
- static void sch_set_piomode(struct ata_port *ap, struct ata_device *adev);
- static void sch_set_dmamode(struct ata_port *ap, struct ata_device *adev);
- static const struct pci_device_id sch_pci_tbl[] = {
-
- { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_SCH_IDE), 0 },
- { }
- };
- static struct pci_driver sch_pci_driver = {
- .name = DRV_NAME,
- .id_table = sch_pci_tbl,
- .probe = sch_init_one,
- .remove = ata_pci_remove_one,
- #ifdef CONFIG_PM_SLEEP
- .suspend = ata_pci_device_suspend,
- .resume = ata_pci_device_resume,
- #endif
- };
- static struct scsi_host_template sch_sht = {
- ATA_BMDMA_SHT(DRV_NAME),
- };
- static struct ata_port_operations sch_pata_ops = {
- .inherits = &ata_bmdma_port_ops,
- .cable_detect = ata_cable_unknown,
- .set_piomode = sch_set_piomode,
- .set_dmamode = sch_set_dmamode,
- };
- static struct ata_port_info sch_port_info = {
- .flags = ATA_FLAG_SLAVE_POSS,
- .pio_mask = ATA_PIO4,
- .mwdma_mask = ATA_MWDMA2,
- .udma_mask = ATA_UDMA5,
- .port_ops = &sch_pata_ops,
- };
- MODULE_AUTHOR("Alek Du <alek.du@intel.com>");
- MODULE_DESCRIPTION("SCSI low-level driver for Intel SCH PATA controllers");
- MODULE_LICENSE("GPL");
- MODULE_DEVICE_TABLE(pci, sch_pci_tbl);
- MODULE_VERSION(DRV_VERSION);
- static void sch_set_piomode(struct ata_port *ap, struct ata_device *adev)
- {
- unsigned int pio = adev->pio_mode - XFER_PIO_0;
- struct pci_dev *dev = to_pci_dev(ap->host->dev);
- unsigned int port = adev->devno ? D1TIM : D0TIM;
- unsigned int data;
- pci_read_config_dword(dev, port, &data);
-
-
- data &= ~(PM | PPE);
- data |= pio;
-
- if (adev->class == ATA_DEV_ATA)
- data |= PPE;
- pci_write_config_dword(dev, port, data);
- }
- static void sch_set_dmamode(struct ata_port *ap, struct ata_device *adev)
- {
- unsigned int dma_mode = adev->dma_mode;
- struct pci_dev *dev = to_pci_dev(ap->host->dev);
- unsigned int port = adev->devno ? D1TIM : D0TIM;
- unsigned int data;
- pci_read_config_dword(dev, port, &data);
-
- if (dma_mode >= XFER_UDMA_0) {
-
- data |= USD;
- data &= ~UDM;
- data |= (dma_mode - XFER_UDMA_0) << 16;
- } else {
- data &= ~(USD | MDM);
- data |= (dma_mode - XFER_MW_DMA_0) << 8;
- }
- pci_write_config_dword(dev, port, data);
- }
- static int sch_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
- {
- const struct ata_port_info *ppi[] = { &sch_port_info, NULL };
- ata_print_version_once(&pdev->dev, DRV_VERSION);
- return ata_pci_bmdma_init_one(pdev, ppi, &sch_sht, NULL, 0);
- }
- module_pci_driver(sch_pci_driver);
|