PCI: pcie_portdriver: fix pcie_port_device_remove
[linux-2.6/mini2440.git] / drivers / ata / pata_pdc202xx_old.c
blob799a6a098712bbd3006acc35c8cca0706eea0302
1 /*
2 * pata_pdc202xx_old.c - Promise PDC202xx PATA for new ATA layer
3 * (C) 2005 Red Hat Inc
4 * Alan Cox <alan@lxorguk.ukuu.org.uk>
5 * (C) 2007 Bartlomiej Zolnierkiewicz
7 * Based in part on linux/drivers/ide/pci/pdc202xx_old.c
9 * First cut with LBA48/ATAPI
11 * TODO:
12 * Channel interlock/reset on both required ?
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/pci.h>
18 #include <linux/init.h>
19 #include <linux/blkdev.h>
20 #include <linux/delay.h>
21 #include <scsi/scsi_host.h>
22 #include <linux/libata.h>
24 #define DRV_NAME "pata_pdc202xx_old"
25 #define DRV_VERSION "0.4.3"
27 static int pdc2026x_cable_detect(struct ata_port *ap)
29 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
30 u16 cis;
32 pci_read_config_word(pdev, 0x50, &cis);
33 if (cis & (1 << (10 + ap->port_no)))
34 return ATA_CBL_PATA40;
35 return ATA_CBL_PATA80;
38 /**
39 * pdc202xx_configure_piomode - set chip PIO timing
40 * @ap: ATA interface
41 * @adev: ATA device
42 * @pio: PIO mode
44 * Called to do the PIO mode setup. Our timing registers are shared
45 * so a configure_dmamode call will undo any work we do here and vice
46 * versa
49 static void pdc202xx_configure_piomode(struct ata_port *ap, struct ata_device *adev, int pio)
51 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
52 int port = 0x60 + 8 * ap->port_no + 4 * adev->devno;
53 static u16 pio_timing[5] = {
54 0x0913, 0x050C , 0x0308, 0x0206, 0x0104
56 u8 r_ap, r_bp;
58 pci_read_config_byte(pdev, port, &r_ap);
59 pci_read_config_byte(pdev, port + 1, &r_bp);
60 r_ap &= ~0x3F; /* Preserve ERRDY_EN, SYNC_IN */
61 r_bp &= ~0x1F;
62 r_ap |= (pio_timing[pio] >> 8);
63 r_bp |= (pio_timing[pio] & 0xFF);
65 if (ata_pio_need_iordy(adev))
66 r_ap |= 0x20; /* IORDY enable */
67 if (adev->class == ATA_DEV_ATA)
68 r_ap |= 0x10; /* FIFO enable */
69 pci_write_config_byte(pdev, port, r_ap);
70 pci_write_config_byte(pdev, port + 1, r_bp);
73 /**
74 * pdc202xx_set_piomode - set initial PIO mode data
75 * @ap: ATA interface
76 * @adev: ATA device
78 * Called to do the PIO mode setup. Our timing registers are shared
79 * but we want to set the PIO timing by default.
82 static void pdc202xx_set_piomode(struct ata_port *ap, struct ata_device *adev)
84 pdc202xx_configure_piomode(ap, adev, adev->pio_mode - XFER_PIO_0);
87 /**
88 * pdc202xx_configure_dmamode - set DMA mode in chip
89 * @ap: ATA interface
90 * @adev: ATA device
92 * Load DMA cycle times into the chip ready for a DMA transfer
93 * to occur.
96 static void pdc202xx_set_dmamode(struct ata_port *ap, struct ata_device *adev)
98 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
99 int port = 0x60 + 8 * ap->port_no + 4 * adev->devno;
100 static u8 udma_timing[6][2] = {
101 { 0x60, 0x03 }, /* 33 Mhz Clock */
102 { 0x40, 0x02 },
103 { 0x20, 0x01 },
104 { 0x40, 0x02 }, /* 66 Mhz Clock */
105 { 0x20, 0x01 },
106 { 0x20, 0x01 }
108 static u8 mdma_timing[3][2] = {
109 { 0xe0, 0x0f },
110 { 0x60, 0x04 },
111 { 0x60, 0x03 },
113 u8 r_bp, r_cp;
115 pci_read_config_byte(pdev, port + 1, &r_bp);
116 pci_read_config_byte(pdev, port + 2, &r_cp);
118 r_bp &= ~0xE0;
119 r_cp &= ~0x0F;
121 if (adev->dma_mode >= XFER_UDMA_0) {
122 int speed = adev->dma_mode - XFER_UDMA_0;
123 r_bp |= udma_timing[speed][0];
124 r_cp |= udma_timing[speed][1];
126 } else {
127 int speed = adev->dma_mode - XFER_MW_DMA_0;
128 r_bp |= mdma_timing[speed][0];
129 r_cp |= mdma_timing[speed][1];
131 pci_write_config_byte(pdev, port + 1, r_bp);
132 pci_write_config_byte(pdev, port + 2, r_cp);
137 * pdc2026x_bmdma_start - DMA engine begin
138 * @qc: ATA command
140 * In UDMA3 or higher we have to clock switch for the duration of the
141 * DMA transfer sequence.
143 * Note: The host lock held by the libata layer protects
144 * us from two channels both trying to set DMA bits at once
147 static void pdc2026x_bmdma_start(struct ata_queued_cmd *qc)
149 struct ata_port *ap = qc->ap;
150 struct ata_device *adev = qc->dev;
151 struct ata_taskfile *tf = &qc->tf;
152 int sel66 = ap->port_no ? 0x08: 0x02;
154 void __iomem *master = ap->host->ports[0]->ioaddr.bmdma_addr;
155 void __iomem *clock = master + 0x11;
156 void __iomem *atapi_reg = master + 0x20 + (4 * ap->port_no);
158 u32 len;
160 /* Check we keep host level locking here */
161 if (adev->dma_mode >= XFER_UDMA_2)
162 iowrite8(ioread8(clock) | sel66, clock);
163 else
164 iowrite8(ioread8(clock) & ~sel66, clock);
166 /* The DMA clocks may have been trashed by a reset. FIXME: make conditional
167 and move to qc_issue ? */
168 pdc202xx_set_dmamode(ap, qc->dev);
170 /* Cases the state machine will not complete correctly without help */
171 if ((tf->flags & ATA_TFLAG_LBA48) || tf->protocol == ATAPI_PROT_DMA) {
172 len = qc->nbytes / 2;
174 if (tf->flags & ATA_TFLAG_WRITE)
175 len |= 0x06000000;
176 else
177 len |= 0x05000000;
179 iowrite32(len, atapi_reg);
182 /* Activate DMA */
183 ata_bmdma_start(qc);
187 * pdc2026x_bmdma_end - DMA engine stop
188 * @qc: ATA command
190 * After a DMA completes we need to put the clock back to 33MHz for
191 * PIO timings.
193 * Note: The host lock held by the libata layer protects
194 * us from two channels both trying to set DMA bits at once
197 static void pdc2026x_bmdma_stop(struct ata_queued_cmd *qc)
199 struct ata_port *ap = qc->ap;
200 struct ata_device *adev = qc->dev;
201 struct ata_taskfile *tf = &qc->tf;
203 int sel66 = ap->port_no ? 0x08: 0x02;
204 /* The clock bits are in the same register for both channels */
205 void __iomem *master = ap->host->ports[0]->ioaddr.bmdma_addr;
206 void __iomem *clock = master + 0x11;
207 void __iomem *atapi_reg = master + 0x20 + (4 * ap->port_no);
209 /* Cases the state machine will not complete correctly */
210 if (tf->protocol == ATAPI_PROT_DMA || (tf->flags & ATA_TFLAG_LBA48)) {
211 iowrite32(0, atapi_reg);
212 iowrite8(ioread8(clock) & ~sel66, clock);
214 /* Flip back to 33Mhz for PIO */
215 if (adev->dma_mode >= XFER_UDMA_2)
216 iowrite8(ioread8(clock) & ~sel66, clock);
217 ata_bmdma_stop(qc);
218 pdc202xx_set_piomode(ap, adev);
222 * pdc2026x_dev_config - device setup hook
223 * @adev: newly found device
225 * Perform chip specific early setup. We need to lock the transfer
226 * sizes to 8bit to avoid making the state engine on the 2026x cards
227 * barf.
230 static void pdc2026x_dev_config(struct ata_device *adev)
232 adev->max_sectors = 256;
235 static int pdc2026x_port_start(struct ata_port *ap)
237 void __iomem *bmdma = ap->ioaddr.bmdma_addr;
238 if (bmdma) {
239 /* Enable burst mode */
240 u8 burst = ioread8(bmdma + 0x1f);
241 iowrite8(burst | 0x01, bmdma + 0x1f);
243 return ata_sff_port_start(ap);
247 * pdc2026x_check_atapi_dma - Check whether ATAPI DMA can be supported for this command
248 * @qc: Metadata associated with taskfile to check
250 * Just say no - not supported on older Promise.
252 * LOCKING:
253 * None (inherited from caller).
255 * RETURNS: 0 when ATAPI DMA can be used
256 * 1 otherwise
259 static int pdc2026x_check_atapi_dma(struct ata_queued_cmd *qc)
261 return 1;
264 static struct scsi_host_template pdc202xx_sht = {
265 ATA_BMDMA_SHT(DRV_NAME),
268 static struct ata_port_operations pdc2024x_port_ops = {
269 .inherits = &ata_bmdma_port_ops,
271 .cable_detect = ata_cable_40wire,
272 .set_piomode = pdc202xx_set_piomode,
273 .set_dmamode = pdc202xx_set_dmamode,
276 static struct ata_port_operations pdc2026x_port_ops = {
277 .inherits = &pdc2024x_port_ops,
279 .check_atapi_dma = pdc2026x_check_atapi_dma,
280 .bmdma_start = pdc2026x_bmdma_start,
281 .bmdma_stop = pdc2026x_bmdma_stop,
283 .cable_detect = pdc2026x_cable_detect,
284 .dev_config = pdc2026x_dev_config,
286 .port_start = pdc2026x_port_start,
289 static int pdc202xx_init_one(struct pci_dev *dev, const struct pci_device_id *id)
291 static const struct ata_port_info info[3] = {
293 .flags = ATA_FLAG_SLAVE_POSS,
294 .pio_mask = 0x1f,
295 .mwdma_mask = 0x07,
296 .udma_mask = ATA_UDMA2,
297 .port_ops = &pdc2024x_port_ops
300 .flags = ATA_FLAG_SLAVE_POSS,
301 .pio_mask = 0x1f,
302 .mwdma_mask = 0x07,
303 .udma_mask = ATA_UDMA4,
304 .port_ops = &pdc2026x_port_ops
307 .flags = ATA_FLAG_SLAVE_POSS,
308 .pio_mask = 0x1f,
309 .mwdma_mask = 0x07,
310 .udma_mask = ATA_UDMA5,
311 .port_ops = &pdc2026x_port_ops
315 const struct ata_port_info *ppi[] = { &info[id->driver_data], NULL };
317 if (dev->device == PCI_DEVICE_ID_PROMISE_20265) {
318 struct pci_dev *bridge = dev->bus->self;
319 /* Don't grab anything behind a Promise I2O RAID */
320 if (bridge && bridge->vendor == PCI_VENDOR_ID_INTEL) {
321 if (bridge->device == PCI_DEVICE_ID_INTEL_I960)
322 return -ENODEV;
323 if (bridge->device == PCI_DEVICE_ID_INTEL_I960RM)
324 return -ENODEV;
327 return ata_pci_sff_init_one(dev, ppi, &pdc202xx_sht, NULL);
330 static const struct pci_device_id pdc202xx[] = {
331 { PCI_VDEVICE(PROMISE, PCI_DEVICE_ID_PROMISE_20246), 0 },
332 { PCI_VDEVICE(PROMISE, PCI_DEVICE_ID_PROMISE_20262), 1 },
333 { PCI_VDEVICE(PROMISE, PCI_DEVICE_ID_PROMISE_20263), 1 },
334 { PCI_VDEVICE(PROMISE, PCI_DEVICE_ID_PROMISE_20265), 2 },
335 { PCI_VDEVICE(PROMISE, PCI_DEVICE_ID_PROMISE_20267), 2 },
337 { },
340 static struct pci_driver pdc202xx_pci_driver = {
341 .name = DRV_NAME,
342 .id_table = pdc202xx,
343 .probe = pdc202xx_init_one,
344 .remove = ata_pci_remove_one,
345 #ifdef CONFIG_PM
346 .suspend = ata_pci_device_suspend,
347 .resume = ata_pci_device_resume,
348 #endif
351 static int __init pdc202xx_init(void)
353 return pci_register_driver(&pdc202xx_pci_driver);
356 static void __exit pdc202xx_exit(void)
358 pci_unregister_driver(&pdc202xx_pci_driver);
361 MODULE_AUTHOR("Alan Cox");
362 MODULE_DESCRIPTION("low-level driver for Promise 2024x and 20262-20267");
363 MODULE_LICENSE("GPL");
364 MODULE_DEVICE_TABLE(pci, pdc202xx);
365 MODULE_VERSION(DRV_VERSION);
367 module_init(pdc202xx_init);
368 module_exit(pdc202xx_exit);