reiserfs: Fix spurious unlock in reiserfs_fill_super() error handling
[linux/fpc-iii.git] / drivers / ata / pata_cs5530.c
blobad75d02b6dacf36b8924addddd7b33f595787a1e
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * pata-cs5530.c - CS5530 PATA for new ATA layer
4 * (C) 2005 Red Hat Inc
6 * based upon cs5530.c by Mark Lord.
8 * Loosely based on the piix & svwks drivers.
10 * Documentation:
11 * Available from AMD web site.
14 #include <linux/kernel.h>
15 #include <linux/module.h>
16 #include <linux/pci.h>
17 #include <linux/blkdev.h>
18 #include <linux/delay.h>
19 #include <scsi/scsi_host.h>
20 #include <linux/libata.h>
21 #include <linux/dmi.h>
23 #define DRV_NAME "pata_cs5530"
24 #define DRV_VERSION "0.7.4"
26 static void __iomem *cs5530_port_base(struct ata_port *ap)
28 unsigned long bmdma = (unsigned long)ap->ioaddr.bmdma_addr;
30 return (void __iomem *)((bmdma & ~0x0F) + 0x20 + 0x10 * ap->port_no);
33 /**
34 * cs5530_set_piomode - PIO setup
35 * @ap: ATA interface
36 * @adev: device on the interface
38 * Set our PIO requirements. This is fairly simple on the CS5530
39 * chips.
42 static void cs5530_set_piomode(struct ata_port *ap, struct ata_device *adev)
44 static const unsigned int cs5530_pio_timings[2][5] = {
45 {0x00009172, 0x00012171, 0x00020080, 0x00032010, 0x00040010},
46 {0xd1329172, 0x71212171, 0x30200080, 0x20102010, 0x00100010}
48 void __iomem *base = cs5530_port_base(ap);
49 u32 tuning;
50 int format;
52 /* Find out which table to use */
53 tuning = ioread32(base + 0x04);
54 format = (tuning & 0x80000000UL) ? 1 : 0;
56 /* Now load the right timing register */
57 if (adev->devno)
58 base += 0x08;
60 iowrite32(cs5530_pio_timings[format][adev->pio_mode - XFER_PIO_0], base);
63 /**
64 * cs5530_set_dmamode - DMA timing setup
65 * @ap: ATA interface
66 * @adev: Device being configured
68 * We cannot mix MWDMA and UDMA without reloading timings each switch
69 * master to slave. We track the last DMA setup in order to minimise
70 * reloads.
73 static void cs5530_set_dmamode(struct ata_port *ap, struct ata_device *adev)
75 void __iomem *base = cs5530_port_base(ap);
76 u32 tuning, timing = 0;
77 u8 reg;
79 /* Find out which table to use */
80 tuning = ioread32(base + 0x04);
82 switch(adev->dma_mode) {
83 case XFER_UDMA_0:
84 timing = 0x00921250;break;
85 case XFER_UDMA_1:
86 timing = 0x00911140;break;
87 case XFER_UDMA_2:
88 timing = 0x00911030;break;
89 case XFER_MW_DMA_0:
90 timing = 0x00077771;break;
91 case XFER_MW_DMA_1:
92 timing = 0x00012121;break;
93 case XFER_MW_DMA_2:
94 timing = 0x00002020;break;
95 default:
96 BUG();
98 /* Merge in the PIO format bit */
99 timing |= (tuning & 0x80000000UL);
100 if (adev->devno == 0) /* Master */
101 iowrite32(timing, base + 0x04);
102 else {
103 if (timing & 0x00100000)
104 tuning |= 0x00100000; /* UDMA for both */
105 else
106 tuning &= ~0x00100000; /* MWDMA for both */
107 iowrite32(tuning, base + 0x04);
108 iowrite32(timing, base + 0x0C);
111 /* Set the DMA capable bit in the BMDMA area */
112 reg = ioread8(ap->ioaddr.bmdma_addr + ATA_DMA_STATUS);
113 reg |= (1 << (5 + adev->devno));
114 iowrite8(reg, ap->ioaddr.bmdma_addr + ATA_DMA_STATUS);
116 /* Remember the last DMA setup we did */
118 ap->private_data = adev;
122 * cs5530_qc_issue - command issue
123 * @qc: command pending
125 * Called when the libata layer is about to issue a command. We wrap
126 * this interface so that we can load the correct ATA timings if
127 * necessary. Specifically we have a problem that there is only
128 * one MWDMA/UDMA bit.
131 static unsigned int cs5530_qc_issue(struct ata_queued_cmd *qc)
133 struct ata_port *ap = qc->ap;
134 struct ata_device *adev = qc->dev;
135 struct ata_device *prev = ap->private_data;
137 /* See if the DMA settings could be wrong */
138 if (ata_dma_enabled(adev) && adev != prev && prev != NULL) {
139 /* Maybe, but do the channels match MWDMA/UDMA ? */
140 if ((ata_using_udma(adev) && !ata_using_udma(prev)) ||
141 (ata_using_udma(prev) && !ata_using_udma(adev)))
142 /* Switch the mode bits */
143 cs5530_set_dmamode(ap, adev);
146 return ata_bmdma_qc_issue(qc);
149 static struct scsi_host_template cs5530_sht = {
150 ATA_BMDMA_SHT(DRV_NAME),
151 .sg_tablesize = LIBATA_DUMB_MAX_PRD,
154 static struct ata_port_operations cs5530_port_ops = {
155 .inherits = &ata_bmdma_port_ops,
157 .qc_prep = ata_bmdma_dumb_qc_prep,
158 .qc_issue = cs5530_qc_issue,
160 .cable_detect = ata_cable_40wire,
161 .set_piomode = cs5530_set_piomode,
162 .set_dmamode = cs5530_set_dmamode,
165 static const struct dmi_system_id palmax_dmi_table[] = {
167 .ident = "Palmax PD1100",
168 .matches = {
169 DMI_MATCH(DMI_SYS_VENDOR, "Cyrix"),
170 DMI_MATCH(DMI_PRODUCT_NAME, "Caddis"),
176 static int cs5530_is_palmax(void)
178 if (dmi_check_system(palmax_dmi_table)) {
179 printk(KERN_INFO "Palmax PD1100: Disabling DMA on docking port.\n");
180 return 1;
182 return 0;
187 * cs5530_init_chip - Chipset init
189 * Perform the chip initialisation work that is shared between both
190 * setup and resume paths
193 static int cs5530_init_chip(void)
195 struct pci_dev *master_0 = NULL, *cs5530_0 = NULL, *dev = NULL;
197 while ((dev = pci_get_device(PCI_VENDOR_ID_CYRIX, PCI_ANY_ID, dev)) != NULL) {
198 switch (dev->device) {
199 case PCI_DEVICE_ID_CYRIX_PCI_MASTER:
200 master_0 = pci_dev_get(dev);
201 break;
202 case PCI_DEVICE_ID_CYRIX_5530_LEGACY:
203 cs5530_0 = pci_dev_get(dev);
204 break;
207 if (!master_0) {
208 printk(KERN_ERR DRV_NAME ": unable to locate PCI MASTER function\n");
209 goto fail_put;
211 if (!cs5530_0) {
212 printk(KERN_ERR DRV_NAME ": unable to locate CS5530 LEGACY function\n");
213 goto fail_put;
216 pci_set_master(cs5530_0);
217 pci_try_set_mwi(cs5530_0);
220 * Set PCI CacheLineSize to 16-bytes:
221 * --> Write 0x04 into 8-bit PCI CACHELINESIZE reg of function 0 of the cs5530
223 * Note: This value is constant because the 5530 is only a Geode companion
226 pci_write_config_byte(cs5530_0, PCI_CACHE_LINE_SIZE, 0x04);
229 * Disable trapping of UDMA register accesses (Win98 hack):
230 * --> Write 0x5006 into 16-bit reg at offset 0xd0 of function 0 of the cs5530
233 pci_write_config_word(cs5530_0, 0xd0, 0x5006);
236 * Bit-1 at 0x40 enables MemoryWriteAndInvalidate on internal X-bus:
237 * The other settings are what is necessary to get the register
238 * into a sane state for IDE DMA operation.
241 pci_write_config_byte(master_0, 0x40, 0x1e);
244 * Set max PCI burst size (16-bytes seems to work best):
245 * 16bytes: set bit-1 at 0x41 (reg value of 0x16)
246 * all others: clear bit-1 at 0x41, and do:
247 * 128bytes: OR 0x00 at 0x41
248 * 256bytes: OR 0x04 at 0x41
249 * 512bytes: OR 0x08 at 0x41
250 * 1024bytes: OR 0x0c at 0x41
253 pci_write_config_byte(master_0, 0x41, 0x14);
256 * These settings are necessary to get the chip
257 * into a sane state for IDE DMA operation.
260 pci_write_config_byte(master_0, 0x42, 0x00);
261 pci_write_config_byte(master_0, 0x43, 0xc1);
263 pci_dev_put(master_0);
264 pci_dev_put(cs5530_0);
265 return 0;
266 fail_put:
267 pci_dev_put(master_0);
268 pci_dev_put(cs5530_0);
269 return -ENODEV;
273 * cs5530_init_one - Initialise a CS5530
274 * @dev: PCI device
275 * @id: Entry in match table
277 * Install a driver for the newly found CS5530 companion chip. Most of
278 * this is just housekeeping. We have to set the chip up correctly and
279 * turn off various bits of emulation magic.
282 static int cs5530_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
284 static const struct ata_port_info info = {
285 .flags = ATA_FLAG_SLAVE_POSS,
286 .pio_mask = ATA_PIO4,
287 .mwdma_mask = ATA_MWDMA2,
288 .udma_mask = ATA_UDMA2,
289 .port_ops = &cs5530_port_ops
291 /* The docking connector doesn't do UDMA, and it seems not MWDMA */
292 static const struct ata_port_info info_palmax_secondary = {
293 .flags = ATA_FLAG_SLAVE_POSS,
294 .pio_mask = ATA_PIO4,
295 .port_ops = &cs5530_port_ops
297 const struct ata_port_info *ppi[] = { &info, NULL };
298 int rc;
300 rc = pcim_enable_device(pdev);
301 if (rc)
302 return rc;
304 /* Chip initialisation */
305 if (cs5530_init_chip())
306 return -ENODEV;
308 if (cs5530_is_palmax())
309 ppi[1] = &info_palmax_secondary;
311 /* Now kick off ATA set up */
312 return ata_pci_bmdma_init_one(pdev, ppi, &cs5530_sht, NULL, 0);
315 #ifdef CONFIG_PM_SLEEP
316 static int cs5530_reinit_one(struct pci_dev *pdev)
318 struct ata_host *host = pci_get_drvdata(pdev);
319 int rc;
321 rc = ata_pci_device_do_resume(pdev);
322 if (rc)
323 return rc;
325 /* If we fail on resume we are doomed */
326 if (cs5530_init_chip())
327 return -EIO;
329 ata_host_resume(host);
330 return 0;
332 #endif /* CONFIG_PM_SLEEP */
334 static const struct pci_device_id cs5530[] = {
335 { PCI_VDEVICE(CYRIX, PCI_DEVICE_ID_CYRIX_5530_IDE), },
337 { },
340 static struct pci_driver cs5530_pci_driver = {
341 .name = DRV_NAME,
342 .id_table = cs5530,
343 .probe = cs5530_init_one,
344 .remove = ata_pci_remove_one,
345 #ifdef CONFIG_PM_SLEEP
346 .suspend = ata_pci_device_suspend,
347 .resume = cs5530_reinit_one,
348 #endif
351 module_pci_driver(cs5530_pci_driver);
353 MODULE_AUTHOR("Alan Cox");
354 MODULE_DESCRIPTION("low-level driver for the Cyrix/NS/AMD 5530");
355 MODULE_LICENSE("GPL");
356 MODULE_DEVICE_TABLE(pci, cs5530);
357 MODULE_VERSION(DRV_VERSION);