pata_piccolo.c 3.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125
  1. /*
  2. * pata_piccolo.c - Toshiba Piccolo PATA/SATA controller driver.
  3. *
  4. * This is basically an update to ata_generic.c to add Toshiba Piccolo support
  5. * then split out to keep ata_generic "clean".
  6. *
  7. * Copyright 2005 Red Hat Inc, all rights reserved.
  8. *
  9. * Elements from ide/pci/generic.c
  10. * Copyright (C) 2001-2002 Andre Hedrick <andre@linux-ide.org>
  11. * Portions (C) Copyright 2002 Red Hat Inc <alan@redhat.com>
  12. *
  13. * May be copied or modified under the terms of the GNU General Public License
  14. *
  15. * The timing data tables/programming info are courtesy of the NetBSD driver
  16. */
  17. #include <linux/kernel.h>
  18. #include <linux/module.h>
  19. #include <linux/pci.h>
  20. #include <linux/blkdev.h>
  21. #include <linux/delay.h>
  22. #include <scsi/scsi_host.h>
  23. #include <linux/libata.h>
  24. #define DRV_NAME "pata_piccolo"
  25. #define DRV_VERSION "0.0.1"
  26. static void tosh_set_piomode(struct ata_port *ap, struct ata_device *adev)
  27. {
  28. static const u16 pio[6] = { /* For reg 0x50 low word & E088 */
  29. 0x0566, 0x0433, 0x0311, 0x0201, 0x0200, 0x0100
  30. };
  31. struct pci_dev *pdev = to_pci_dev(ap->host->dev);
  32. u16 conf;
  33. pci_read_config_word(pdev, 0x50, &conf);
  34. conf &= 0xE088;
  35. conf |= pio[adev->pio_mode - XFER_PIO_0];
  36. pci_write_config_word(pdev, 0x50, conf);
  37. }
  38. static void tosh_set_dmamode(struct ata_port *ap, struct ata_device *adev)
  39. {
  40. struct pci_dev *pdev = to_pci_dev(ap->host->dev);
  41. u32 conf;
  42. pci_read_config_dword(pdev, 0x5C, &conf);
  43. conf &= 0x78FFE088; /* Keep the other bits */
  44. if (adev->dma_mode >= XFER_UDMA_0) {
  45. int udma = adev->dma_mode - XFER_UDMA_0;
  46. conf |= 0x80000000;
  47. conf |= (udma + 2) << 28;
  48. conf |= (2 - udma) * 0x111; /* spread into three nibbles */
  49. } else {
  50. static const u32 mwdma[4] = {
  51. 0x0655, 0x0200, 0x0200, 0x0100
  52. };
  53. conf |= mwdma[adev->dma_mode - XFER_MW_DMA_0];
  54. }
  55. pci_write_config_dword(pdev, 0x5C, conf);
  56. }
  57. static struct scsi_host_template tosh_sht = {
  58. ATA_BMDMA_SHT(DRV_NAME),
  59. };
  60. static struct ata_port_operations tosh_port_ops = {
  61. .inherits = &ata_bmdma_port_ops,
  62. .cable_detect = ata_cable_unknown,
  63. .set_piomode = tosh_set_piomode,
  64. .set_dmamode = tosh_set_dmamode
  65. };
  66. /**
  67. * ata_tosh_init - attach generic IDE
  68. * @dev: PCI device found
  69. * @id: match entry
  70. *
  71. * Called each time a matching IDE interface is found. We check if the
  72. * interface is one we wish to claim and if so we perform any chip
  73. * specific hacks then let the ATA layer do the heavy lifting.
  74. */
  75. static int ata_tosh_init_one(struct pci_dev *dev, const struct pci_device_id *id)
  76. {
  77. static const struct ata_port_info info = {
  78. .flags = ATA_FLAG_SLAVE_POSS,
  79. .pio_mask = ATA_PIO5,
  80. .mwdma_mask = ATA_MWDMA2,
  81. .udma_mask = ATA_UDMA2,
  82. .port_ops = &tosh_port_ops
  83. };
  84. const struct ata_port_info *ppi[] = { &info, &ata_dummy_port_info };
  85. /* Just one port for the moment */
  86. return ata_pci_bmdma_init_one(dev, ppi, &tosh_sht, NULL, 0);
  87. }
  88. static struct pci_device_id ata_tosh[] = {
  89. { PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA,PCI_DEVICE_ID_TOSHIBA_PICCOLO_1), },
  90. { PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA,PCI_DEVICE_ID_TOSHIBA_PICCOLO_2), },
  91. { PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA,PCI_DEVICE_ID_TOSHIBA_PICCOLO_3), },
  92. { PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA,PCI_DEVICE_ID_TOSHIBA_PICCOLO_5), },
  93. { 0, },
  94. };
  95. static struct pci_driver ata_tosh_pci_driver = {
  96. .name = DRV_NAME,
  97. .id_table = ata_tosh,
  98. .probe = ata_tosh_init_one,
  99. .remove = ata_pci_remove_one,
  100. #ifdef CONFIG_PM_SLEEP
  101. .suspend = ata_pci_device_suspend,
  102. .resume = ata_pci_device_resume,
  103. #endif
  104. };
  105. module_pci_driver(ata_tosh_pci_driver);
  106. MODULE_AUTHOR("Alan Cox");
  107. MODULE_DESCRIPTION("Low level driver for Toshiba Piccolo ATA");
  108. MODULE_LICENSE("GPL");
  109. MODULE_DEVICE_TABLE(pci, ata_tosh);
  110. MODULE_VERSION(DRV_VERSION);