blob: 112d2fe1bcdbc8b3acb45d613901afa06798d556 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Bartlomiej Zolnierkiewicz59bca8c2008-02-01 23:09:33 +01002 * Copyright (C) 1998-2000 Andre Hedrick <andre@linux-ide.org>
3 * Copyright (C) 1995-1998 Mark Lord
Bartlomiej Zolnierkiewiczad7c52d2009-06-10 14:37:21 +02004 * Copyright (C) 2007-2009 Bartlomiej Zolnierkiewicz
Bartlomiej Zolnierkiewicz58f189f2008-02-01 23:09:33 +01005 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 * May be copied or modified under the terms of the GNU General Public License
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 */
8
Linus Torvalds1da177e2005-04-16 15:20:36 -07009#include <linux/types.h>
10#include <linux/kernel.h>
Paul Gortmaker38789fd2011-07-17 15:33:58 -040011#include <linux/export.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070012#include <linux/pci.h>
13#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070014#include <linux/interrupt.h>
15#include <linux/ide.h>
16#include <linux/dma-mapping.h>
17
18#include <asm/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070019
Linus Torvalds1da177e2005-04-16 15:20:36 -070020/**
21 * ide_setup_pci_baseregs - place a PCI IDE controller native
22 * @dev: PCI device of interface to switch native
23 * @name: Name of interface
24 *
25 * We attempt to place the PCI interface into PCI native mode. If
26 * we succeed the BARs are ok and the controller is in PCI mode.
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +020027 * Returns 0 on success or an errno code.
Linus Torvalds1da177e2005-04-16 15:20:36 -070028 *
29 * FIXME: if we program the interface and then fail to set the BARS
30 * we don't switch it back to legacy mode. Do we actually care ??
31 */
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +020032
33static int ide_setup_pci_baseregs(struct pci_dev *dev, const char *name)
Linus Torvalds1da177e2005-04-16 15:20:36 -070034{
35 u8 progif = 0;
36
37 /*
38 * Place both IDE interfaces into PCI "native" mode:
39 */
40 if (pci_read_config_byte(dev, PCI_CLASS_PROG, &progif) ||
41 (progif & 5) != 5) {
42 if ((progif & 0xa) != 0xa) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +020043 printk(KERN_INFO "%s %s: device not capable of full "
44 "native PCI mode\n", name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -070045 return -EOPNOTSUPP;
46 }
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +020047 printk(KERN_INFO "%s %s: placing both ports into native PCI "
48 "mode\n", name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -070049 (void) pci_write_config_byte(dev, PCI_CLASS_PROG, progif|5);
50 if (pci_read_config_byte(dev, PCI_CLASS_PROG, &progif) ||
51 (progif & 5) != 5) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +020052 printk(KERN_ERR "%s %s: rewrite of PROGIF failed, "
53 "wanted 0x%04x, got 0x%04x\n",
54 name, pci_name(dev), progif | 5, progif);
Linus Torvalds1da177e2005-04-16 15:20:36 -070055 return -EOPNOTSUPP;
56 }
57 }
58 return 0;
59}
60
61#ifdef CONFIG_BLK_DEV_IDEDMA_PCI
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +020062static int ide_pci_clear_simplex(unsigned long dma_base, const char *name)
Bartlomiej Zolnierkiewicz8ac2b42a2008-02-01 23:09:30 +010063{
64 u8 dma_stat = inb(dma_base + 2);
65
66 outb(dma_stat & 0x60, dma_base + 2);
67 dma_stat = inb(dma_base + 2);
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +020068
69 return (dma_stat & 0x80) ? 1 : 0;
Bartlomiej Zolnierkiewicz8ac2b42a2008-02-01 23:09:30 +010070}
71
Linus Torvalds1da177e2005-04-16 15:20:36 -070072/**
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +020073 * ide_pci_dma_base - setup BMIBA
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +020074 * @hwif: IDE interface
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +020075 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -070076 *
Bartlomiej Zolnierkiewiczc58e79d2007-10-16 22:29:56 +020077 * Fetch the DMA Bus-Master-I/O-Base-Address (BMIBA) from PCI space.
Linus Torvalds1da177e2005-04-16 15:20:36 -070078 */
79
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +020080unsigned long ide_pci_dma_base(ide_hwif_t *hwif, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -070081{
Bartlomiej Zolnierkiewicz36501652008-02-01 23:09:31 +010082 struct pci_dev *dev = to_pci_dev(hwif->dev);
83 unsigned long dma_base = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070084
Bartlomiej Zolnierkiewicz13572142008-07-15 21:21:49 +020085 if (hwif->host_flags & IDE_HFLAG_MMIO)
Linus Torvalds1da177e2005-04-16 15:20:36 -070086 return hwif->dma_base;
87
88 if (hwif->mate && hwif->mate->dma_base) {
89 dma_base = hwif->mate->dma_base - (hwif->channel ? 0 : 8);
90 } else {
Bartlomiej Zolnierkiewicz9ffcf362007-10-19 00:30:07 +020091 u8 baridx = (d->host_flags & IDE_HFLAG_CS5520) ? 2 : 4;
92
93 dma_base = pci_resource_start(dev, baridx);
94
Bartlomiej Zolnierkiewiczaea5d372008-01-26 20:12:59 +010095 if (dma_base == 0) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +020096 printk(KERN_ERR "%s %s: DMA base is invalid\n",
97 d->name, pci_name(dev));
Bartlomiej Zolnierkiewiczaea5d372008-01-26 20:12:59 +010098 return 0;
99 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100 }
101
Bartlomiej Zolnierkiewiczaea5d372008-01-26 20:12:59 +0100102 if (hwif->channel)
103 dma_base += 8;
104
Bartlomiej Zolnierkiewiczebb00fb2008-07-23 19:55:51 +0200105 return dma_base;
106}
107EXPORT_SYMBOL_GPL(ide_pci_dma_base);
108
109int ide_pci_check_simplex(ide_hwif_t *hwif, const struct ide_port_info *d)
110{
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200111 struct pci_dev *dev = to_pci_dev(hwif->dev);
Bartlomiej Zolnierkiewiczebb00fb2008-07-23 19:55:51 +0200112 u8 dma_stat;
113
114 if (d->host_flags & (IDE_HFLAG_MMIO | IDE_HFLAG_CS5520))
Bartlomiej Zolnierkiewicz8ac2b42a2008-02-01 23:09:30 +0100115 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116
Bartlomiej Zolnierkiewicz8ac2b42a2008-02-01 23:09:30 +0100117 if (d->host_flags & IDE_HFLAG_CLEAR_SIMPLEX) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200118 if (ide_pci_clear_simplex(hwif->dma_base, d->name))
119 printk(KERN_INFO "%s %s: simplex device: DMA forced\n",
120 d->name, pci_name(dev));
Bartlomiej Zolnierkiewicz8ac2b42a2008-02-01 23:09:30 +0100121 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122 }
Bartlomiej Zolnierkiewicz8ac2b42a2008-02-01 23:09:30 +0100123
124 /*
125 * If the device claims "simplex" DMA, this means that only one of
126 * the two interfaces can be trusted with DMA at any point in time
127 * (so we should enable DMA only on one of the two interfaces).
128 *
129 * FIXME: At this point we haven't probed the drives so we can't make
130 * the appropriate decision. Really we should defer this problem until
131 * we tune the drive then try to grab DMA ownership if we want to be
132 * the DMA end. This has to be become dynamic to handle hot-plug.
133 */
Sergei Shtylyov592b5312009-01-06 17:21:02 +0100134 dma_stat = hwif->dma_ops->dma_sff_read_status(hwif);
Bartlomiej Zolnierkiewicz8ac2b42a2008-02-01 23:09:30 +0100135 if ((dma_stat & 0x80) && hwif->mate && hwif->mate->dma_base) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200136 printk(KERN_INFO "%s %s: simplex device: DMA disabled\n",
137 d->name, pci_name(dev));
Bartlomiej Zolnierkiewiczebb00fb2008-07-23 19:55:51 +0200138 return -1;
Bartlomiej Zolnierkiewicz8ac2b42a2008-02-01 23:09:30 +0100139 }
140out:
Bartlomiej Zolnierkiewiczebb00fb2008-07-23 19:55:51 +0200141 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142}
Bartlomiej Zolnierkiewiczebb00fb2008-07-23 19:55:51 +0200143EXPORT_SYMBOL_GPL(ide_pci_check_simplex);
Bartlomiej Zolnierkiewiczd54452f2008-04-26 22:25:21 +0200144
145/*
146 * Set up BM-DMA capability (PnP BIOS should have done this)
147 */
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200148int ide_pci_set_master(struct pci_dev *dev, const char *name)
Bartlomiej Zolnierkiewiczd54452f2008-04-26 22:25:21 +0200149{
150 u16 pcicmd;
151
152 pci_read_config_word(dev, PCI_COMMAND, &pcicmd);
153
154 if ((pcicmd & PCI_COMMAND_MASTER) == 0) {
155 pci_set_master(dev);
156
157 if (pci_read_config_word(dev, PCI_COMMAND, &pcicmd) ||
158 (pcicmd & PCI_COMMAND_MASTER) == 0) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200159 printk(KERN_ERR "%s %s: error updating PCICMD\n",
160 name, pci_name(dev));
Bartlomiej Zolnierkiewiczd54452f2008-04-26 22:25:21 +0200161 return -EIO;
162 }
163 }
164
165 return 0;
166}
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200167EXPORT_SYMBOL_GPL(ide_pci_set_master);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700168#endif /* CONFIG_BLK_DEV_IDEDMA_PCI */
169
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200170void ide_setup_pci_noise(struct pci_dev *dev, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171{
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200172 printk(KERN_INFO "%s %s: IDE controller (0x%04x:0x%04x rev 0x%02x)\n",
173 d->name, pci_name(dev),
174 dev->vendor, dev->device, dev->revision);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176EXPORT_SYMBOL_GPL(ide_setup_pci_noise);
177
178
179/**
180 * ide_pci_enable - do PCI enables
181 * @dev: PCI device
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200182 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183 *
184 * Enable the IDE PCI device. We attempt to enable the device in full
Benjamin Herrenschmidt09483912007-12-20 15:28:09 +1100185 * but if that fails then we only need IO space. The PCI code should
186 * have setup the proper resources for us already for controllers in
187 * legacy mode.
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +0200188 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189 * Returns zero on success or an error code
190 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200191
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200192static int ide_pci_enable(struct pci_dev *dev, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700193{
Bartlomiej Zolnierkiewicz0d1bad22008-04-26 22:25:19 +0200194 int ret, bars;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700195
196 if (pci_enable_device(dev)) {
Benjamin Herrenschmidt09483912007-12-20 15:28:09 +1100197 ret = pci_enable_device_io(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 if (ret < 0) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200199 printk(KERN_WARNING "%s %s: couldn't enable device\n",
200 d->name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201 goto out;
202 }
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200203 printk(KERN_WARNING "%s %s: BIOS configuration fixed\n",
204 d->name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700205 }
206
207 /*
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200208 * assume all devices can do 32-bit DMA for now, we can add
209 * a DMA mask field to the struct ide_port_info if we need it
210 * (or let lower level driver set the DMA mask)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211 */
Quentin Lambertd681f1162015-04-13 10:26:53 +0200212 ret = dma_set_mask(&dev->dev, DMA_BIT_MASK(32));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700213 if (ret < 0) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200214 printk(KERN_ERR "%s %s: can't set DMA mask\n",
215 d->name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700216 goto out;
217 }
218
Bartlomiej Zolnierkiewicz0d1bad22008-04-26 22:25:19 +0200219 if (d->host_flags & IDE_HFLAG_SINGLE)
220 bars = (1 << 2) - 1;
221 else
222 bars = (1 << 4) - 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223
Bartlomiej Zolnierkiewicz0d1bad22008-04-26 22:25:19 +0200224 if ((d->host_flags & IDE_HFLAG_NO_DMA) == 0) {
225 if (d->host_flags & IDE_HFLAG_CS5520)
226 bars |= (1 << 2);
227 else
228 bars |= (1 << 4);
229 }
230
231 ret = pci_request_selected_regions(dev, bars, d->name);
232 if (ret < 0)
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200233 printk(KERN_ERR "%s %s: can't reserve resources\n",
234 d->name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235out:
236 return ret;
237}
238
239/**
240 * ide_pci_configure - configure an unconfigured device
241 * @dev: PCI device
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200242 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243 *
244 * Enable and configure the PCI device we have been passed.
245 * Returns zero on success or an error code.
246 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200247
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200248static int ide_pci_configure(struct pci_dev *dev, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700249{
250 u16 pcicmd = 0;
251 /*
252 * PnP BIOS was *supposed* to have setup this device, but we
253 * can do it ourselves, so long as the BIOS has assigned an IRQ
254 * (or possibly the device is using a "legacy header" for IRQs).
255 * Maybe the user deliberately *disabled* the device,
256 * but we'll eventually ignore it again if no drives respond.
257 */
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +0200258 if (ide_setup_pci_baseregs(dev, d->name) ||
259 pci_write_config_word(dev, PCI_COMMAND, pcicmd | PCI_COMMAND_IO)) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200260 printk(KERN_INFO "%s %s: device disabled (BIOS)\n",
261 d->name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262 return -ENODEV;
263 }
264 if (pci_read_config_word(dev, PCI_COMMAND, &pcicmd)) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200265 printk(KERN_ERR "%s %s: error accessing PCI regs\n",
266 d->name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267 return -EIO;
268 }
269 if (!(pcicmd & PCI_COMMAND_IO)) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200270 printk(KERN_ERR "%s %s: unable to enable IDE controller\n",
271 d->name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272 return -ENXIO;
273 }
274 return 0;
275}
276
277/**
278 * ide_pci_check_iomem - check a register is I/O
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200279 * @dev: PCI device
280 * @d: IDE port info
281 * @bar: BAR number
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282 *
Sergei Shtylyov1baccff2008-04-26 17:36:31 +0200283 * Checks if a BAR is configured and points to MMIO space. If so,
284 * return an error code. Otherwise return 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200286
Sergei Shtylyov1baccff2008-04-26 17:36:31 +0200287static int ide_pci_check_iomem(struct pci_dev *dev, const struct ide_port_info *d,
288 int bar)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700289{
290 ulong flags = pci_resource_flags(dev, bar);
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +0200291
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 /* Unconfigured ? */
293 if (!flags || pci_resource_len(dev, bar) == 0)
294 return 0;
295
Sergei Shtylyov1baccff2008-04-26 17:36:31 +0200296 /* I/O space */
297 if (flags & IORESOURCE_IO)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 return 0;
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +0200299
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300 /* Bad */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301 return -EINVAL;
302}
303
304/**
Bartlomiej Zolnierkiewicz9f36d312009-05-17 19:12:25 +0200305 * ide_hw_configure - configure a struct ide_hw instance
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306 * @dev: PCI device holding interface
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200307 * @d: IDE port info
Bartlomiej Zolnierkiewicz1ebf7492008-02-02 19:56:30 +0100308 * @port: port number
Bartlomiej Zolnierkiewicz9f36d312009-05-17 19:12:25 +0200309 * @hw: struct ide_hw instance corresponding to this port
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310 *
311 * Perform the initial set up for the hardware interface structure. This
312 * is done per interface port rather than per PCI device. There may be
313 * more than one port per device.
314 *
Bartlomiej Zolnierkiewicz48c3c102008-07-23 19:55:57 +0200315 * Returns zero on success or an error code.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200317
Bartlomiej Zolnierkiewicz48c3c102008-07-23 19:55:57 +0200318static int ide_hw_configure(struct pci_dev *dev, const struct ide_port_info *d,
Bartlomiej Zolnierkiewicz9f36d312009-05-17 19:12:25 +0200319 unsigned int port, struct ide_hw *hw)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320{
321 unsigned long ctl = 0, base = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322
Bartlomiej Zolnierkiewicza5d8c5c2007-07-20 01:11:55 +0200323 if ((d->host_flags & IDE_HFLAG_ISA_PORTS) == 0) {
Sergei Shtylyov1baccff2008-04-26 17:36:31 +0200324 if (ide_pci_check_iomem(dev, d, 2 * port) ||
325 ide_pci_check_iomem(dev, d, 2 * port + 1)) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200326 printk(KERN_ERR "%s %s: I/O baseregs (BIOS) are "
327 "reported as MEM for port %d!\n",
328 d->name, pci_name(dev), port);
Bartlomiej Zolnierkiewicz48c3c102008-07-23 19:55:57 +0200329 return -EINVAL;
Sergei Shtylyov1baccff2008-04-26 17:36:31 +0200330 }
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +0200331
Linus Torvalds1da177e2005-04-16 15:20:36 -0700332 ctl = pci_resource_start(dev, 2*port+1);
333 base = pci_resource_start(dev, 2*port);
Bartlomiej Zolnierkiewiczc1da6782008-07-16 20:33:41 +0200334 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700335 /* Use default values */
336 ctl = port ? 0x374 : 0x3f4;
337 base = port ? 0x170 : 0x1f0;
338 }
Bartlomiej Zolnierkiewiczbad7c822008-04-26 17:36:31 +0200339
Bartlomiej Zolnierkiewiczc1da6782008-07-16 20:33:41 +0200340 if (!base || !ctl) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200341 printk(KERN_ERR "%s %s: bad PCI BARs for port %d, skipping\n",
342 d->name, pci_name(dev), port);
Bartlomiej Zolnierkiewicz48c3c102008-07-23 19:55:57 +0200343 return -EINVAL;
Bartlomiej Zolnierkiewiczc1da6782008-07-16 20:33:41 +0200344 }
345
Bartlomiej Zolnierkiewiczc97c6ac2008-07-23 19:55:50 +0200346 memset(hw, 0, sizeof(*hw));
Bartlomiej Zolnierkiewiczc97c6ac2008-07-23 19:55:50 +0200347 hw->dev = &dev->dev;
Bartlomiej Zolnierkiewiczc97c6ac2008-07-23 19:55:50 +0200348 ide_std_init_ports(hw, base, ctl | 2);
349
Bartlomiej Zolnierkiewicz48c3c102008-07-23 19:55:57 +0200350 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351}
352
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100353#ifdef CONFIG_BLK_DEV_IDEDMA_PCI
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354/**
355 * ide_hwif_setup_dma - configure DMA interface
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200356 * @hwif: IDE interface
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100357 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358 *
359 * Set up the DMA base for the interface. Enable the master bits as
360 * necessary and attempt to bring the device DMA into a ready to use
361 * state
362 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200363
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200364int ide_hwif_setup_dma(ide_hwif_t *hwif, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365{
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100366 struct pci_dev *dev = to_pci_dev(hwif->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367
Bartlomiej Zolnierkiewicz47b68782007-10-19 00:30:06 +0200368 if ((d->host_flags & IDE_HFLAG_NO_AUTODMA) == 0 ||
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369 ((dev->class >> 8) == PCI_CLASS_STORAGE_IDE &&
370 (dev->class & 0x80))) {
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200371 unsigned long base = ide_pci_dma_base(hwif, d);
Bartlomiej Zolnierkiewicz23658f82008-04-26 22:25:21 +0200372
Bartlomiej Zolnierkiewiczebb00fb2008-07-23 19:55:51 +0200373 if (base == 0)
374 return -1;
375
376 hwif->dma_base = base;
377
Sergei Shtylyov592b5312009-01-06 17:21:02 +0100378 if (hwif->dma_ops == NULL)
379 hwif->dma_ops = &sff_dma_ops;
380
Bartlomiej Zolnierkiewiczebb00fb2008-07-23 19:55:51 +0200381 if (ide_pci_check_simplex(hwif, d) < 0)
382 return -1;
383
384 if (ide_pci_set_master(dev, d->name) < 0)
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200385 return -1;
Bartlomiej Zolnierkiewiczd54452f2008-04-26 22:25:21 +0200386
Bartlomiej Zolnierkiewicz13572142008-07-15 21:21:49 +0200387 if (hwif->host_flags & IDE_HFLAG_MMIO)
Bartlomiej Zolnierkiewicz63158d52008-04-26 22:25:21 +0200388 printk(KERN_INFO " %s: MMIO-DMA\n", hwif->name);
389 else
390 printk(KERN_INFO " %s: BM-DMA at 0x%04lx-0x%04lx\n",
391 hwif->name, base, base + 7);
392
393 hwif->extra_base = base + (hwif->channel ? 8 : 16);
394
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200395 if (ide_allocate_dma_engine(hwif))
396 return -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397 }
Bartlomiej Zolnierkiewiczd54452f2008-04-26 22:25:21 +0200398
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200399 return 0;
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200400}
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100401#endif /* CONFIG_BLK_DEV_IDEDMA_PCI */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700402
403/**
404 * ide_setup_pci_controller - set up IDE PCI
405 * @dev: PCI device
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200406 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407 * @noisy: verbose flag
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408 *
409 * Set up the PCI and controller side of the IDE interface. This brings
410 * up the PCI side of the device, checks that the device is enabled
411 * and enables it if need be
412 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200413
Bartlomiej Zolnierkiewicza95925a2008-07-24 22:53:11 +0200414static int ide_setup_pci_controller(struct pci_dev *dev,
415 const struct ide_port_info *d, int noisy)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416{
417 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418 u16 pcicmd;
419
420 if (noisy)
421 ide_setup_pci_noise(dev, d);
422
423 ret = ide_pci_enable(dev, d);
424 if (ret < 0)
425 goto out;
426
427 ret = pci_read_config_word(dev, PCI_COMMAND, &pcicmd);
428 if (ret < 0) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200429 printk(KERN_ERR "%s %s: error accessing PCI regs\n",
430 d->name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700431 goto out;
432 }
433 if (!(pcicmd & PCI_COMMAND_IO)) { /* is device disabled? */
434 ret = ide_pci_configure(dev, d);
435 if (ret < 0)
436 goto out;
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200437 printk(KERN_INFO "%s %s: device enabled (Linux)\n",
438 d->name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700439 }
440
Linus Torvalds1da177e2005-04-16 15:20:36 -0700441out:
442 return ret;
443}
444
445/**
446 * ide_pci_setup_ports - configure ports/devices on PCI IDE
447 * @dev: PCI device
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200448 * @d: IDE port info
Bartlomiej Zolnierkiewicz9f36d312009-05-17 19:12:25 +0200449 * @hw: struct ide_hw instances corresponding to this PCI IDE device
450 * @hws: struct ide_hw pointers table to update
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 *
452 * Scan the interfaces attached to this device and do any
453 * necessary per port setup. Attach the devices and ask the
454 * generic DMA layer to do its work for us.
455 *
456 * Normally called automaticall from do_ide_pci_setup_device,
457 * but is also used directly as a helper function by some controllers
458 * where the chipset setup is not the default PCI IDE one.
459 */
Bartlomiej Zolnierkiewicz8447d9d2007-10-20 00:32:31 +0200460
Bartlomiej Zolnierkiewiczc97c6ac2008-07-23 19:55:50 +0200461void ide_pci_setup_ports(struct pci_dev *dev, const struct ide_port_info *d,
Bartlomiej Zolnierkiewicz9f36d312009-05-17 19:12:25 +0200462 struct ide_hw *hw, struct ide_hw **hws)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463{
Bartlomiej Zolnierkiewicza5d8c5c2007-07-20 01:11:55 +0200464 int channels = (d->host_flags & IDE_HFLAG_SINGLE) ? 1 : 2, port;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700465 u8 tmp;
466
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467 /*
468 * Set up the IDE ports
469 */
Bartlomiej Zolnierkiewiczcf6e8542007-10-20 00:32:29 +0200470
Bartlomiej Zolnierkiewicza5d8c5c2007-07-20 01:11:55 +0200471 for (port = 0; port < channels; ++port) {
Bartlomiej Zolnierkiewiczc0ae5022009-01-06 17:20:52 +0100472 const struct ide_pci_enablebit *e = &d->enablebits[port];
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200473
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474 if (e->reg && (pci_read_config_byte(dev, e->reg, &tmp) ||
Bartlomiej Zolnierkiewiczcf6e8542007-10-20 00:32:29 +0200475 (tmp & e->mask) != e->val)) {
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200476 printk(KERN_INFO "%s %s: IDE port disabled\n",
477 d->name, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478 continue; /* port not enabled */
Bartlomiej Zolnierkiewiczcf6e8542007-10-20 00:32:29 +0200479 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700480
Bartlomiej Zolnierkiewicz86ccf372009-03-24 23:22:53 +0100481 if (ide_hw_configure(dev, d, port, hw + port))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700482 continue;
483
Bartlomiej Zolnierkiewiczc97c6ac2008-07-23 19:55:50 +0200484 *(hws + port) = hw + port;
Bartlomiej Zolnierkiewicz1ebf7492008-02-02 19:56:30 +0100485 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700486}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487EXPORT_SYMBOL_GPL(ide_pci_setup_ports);
488
489/*
490 * ide_setup_pci_device() looks at the primary/secondary interfaces
491 * on a PCI IDE device and, if they are enabled, prepares the IDE driver
492 * for use with them. This generic code works for most PCI chipsets.
493 *
494 * One thing that is not standardized is the location of the
495 * primary/secondary interface "enable/disable" bits. For chipsets that
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200496 * we "know" about, this information is in the struct ide_port_info;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497 * for all other chipsets, we just assume both interfaces are enabled.
498 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200499static int do_ide_setup_pci_device(struct pci_dev *dev,
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200500 const struct ide_port_info *d,
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200501 u8 noisy)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700503 int pciirq, ret;
504
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505 /*
506 * Can we trust the reported IRQ?
507 */
508 pciirq = dev->irq;
509
Bartlomiej Zolnierkiewicz708e5f92008-07-24 22:53:11 +0200510 /*
511 * This allows offboard ide-pci cards the enable a BIOS,
512 * verify interrupt settings of split-mirror pci-config
513 * space, place chipset into init-mode, and/or preserve
514 * an interrupt if the card is not native ide support.
515 */
Bartlomiej Zolnierkiewicza326b022008-07-24 22:53:33 +0200516 ret = d->init_chipset ? d->init_chipset(dev) : 0;
Bartlomiej Zolnierkiewicz708e5f92008-07-24 22:53:11 +0200517 if (ret < 0)
518 goto out;
519
Bartlomiej Zolnierkiewicz8c6de942009-01-06 17:20:58 +0100520 if (ide_pci_is_in_compatibility_mode(dev)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 if (noisy)
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200522 printk(KERN_INFO "%s %s: not 100%% native mode: will "
523 "probe irqs later\n", d->name, pci_name(dev));
Bartlomiej Zolnierkiewicz2ed0ef52009-03-24 23:22:53 +0100524 pciirq = 0;
Bartlomiej Zolnierkiewicz28cfd8a2008-07-24 22:53:31 +0200525 } else if (!pciirq && noisy) {
526 printk(KERN_WARNING "%s %s: bad irq (%d): will probe later\n",
527 d->name, pci_name(dev), pciirq);
528 } else if (noisy) {
529 printk(KERN_INFO "%s %s: 100%% native mode on irq %d\n",
530 d->name, pci_name(dev), pciirq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700531 }
532
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200533 ret = pciirq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534out:
535 return ret;
536}
537
Bartlomiej Zolnierkiewicz6cdf6eb2008-07-24 22:53:14 +0200538int ide_pci_init_two(struct pci_dev *dev1, struct pci_dev *dev2,
539 const struct ide_port_info *d, void *priv)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700540{
541 struct pci_dev *pdev[] = { dev1, dev2 };
Bartlomiej Zolnierkiewicz6cdf6eb2008-07-24 22:53:14 +0200542 struct ide_host *host;
Bartlomiej Zolnierkiewiczad7c52d2009-06-10 14:37:21 +0200543 int ret, i, n_ports = dev2 ? 4 : 2;
Bartlomiej Zolnierkiewicz9f36d312009-05-17 19:12:25 +0200544 struct ide_hw hw[4], *hws[] = { NULL, NULL, NULL, NULL };
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545
Bartlomiej Zolnierkiewiczad7c52d2009-06-10 14:37:21 +0200546 for (i = 0; i < n_ports / 2; i++) {
Bartlomiej Zolnierkiewicza742d6c2008-07-24 22:53:12 +0200547 ret = ide_setup_pci_controller(pdev[i], d, !i);
548 if (ret < 0)
549 goto out;
550
Bartlomiej Zolnierkiewicz86ccf372009-03-24 23:22:53 +0100551 ide_pci_setup_ports(pdev[i], d, &hw[i*2], &hws[i*2]);
Bartlomiej Zolnierkiewicz6cdf6eb2008-07-24 22:53:14 +0200552 }
Bartlomiej Zolnierkiewicz8c2eece2008-07-24 22:53:12 +0200553
Bartlomiej Zolnierkiewiczad7c52d2009-06-10 14:37:21 +0200554 host = ide_host_alloc(d, hws, n_ports);
Bartlomiej Zolnierkiewicz6cdf6eb2008-07-24 22:53:14 +0200555 if (host == NULL) {
556 ret = -ENOMEM;
557 goto out;
558 }
559
560 host->dev[0] = &dev1->dev;
Bartlomiej Zolnierkiewiczad7c52d2009-06-10 14:37:21 +0200561 if (dev2)
562 host->dev[1] = &dev2->dev;
Bartlomiej Zolnierkiewicz6cdf6eb2008-07-24 22:53:14 +0200563
564 host->host_priv = priv;
Bartlomiej Zolnierkiewicz255115fb2009-03-27 12:46:27 +0100565 host->irq_flags = IRQF_SHARED;
566
Bartlomiej Zolnierkiewiczef0b0422008-07-24 22:53:19 +0200567 pci_set_drvdata(pdev[0], host);
Bartlomiej Zolnierkiewiczad7c52d2009-06-10 14:37:21 +0200568 if (dev2)
569 pci_set_drvdata(pdev[1], host);
Bartlomiej Zolnierkiewicz6cdf6eb2008-07-24 22:53:14 +0200570
Bartlomiej Zolnierkiewiczad7c52d2009-06-10 14:37:21 +0200571 for (i = 0; i < n_ports / 2; i++) {
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200572 ret = do_ide_setup_pci_device(pdev[i], d, !i);
573
Linus Torvalds1da177e2005-04-16 15:20:36 -0700574 /*
575 * FIXME: Mom, mom, they stole me the helper function to undo
576 * do_ide_setup_pci_device() on the first device!
577 */
578 if (ret < 0)
579 goto out;
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200580
Bartlomiej Zolnierkiewicz8c2eece2008-07-24 22:53:12 +0200581 /* fixup IRQ */
Bartlomiej Zolnierkiewiczf65dedf2009-03-24 23:22:51 +0100582 if (ide_pci_is_in_compatibility_mode(pdev[i])) {
Bartlomiej Zolnierkiewicz5bae8bf2009-03-24 23:22:49 +0100583 hw[i*2].irq = pci_get_legacy_ide_irq(pdev[i], 0);
584 hw[i*2 + 1].irq = pci_get_legacy_ide_irq(pdev[i], 1);
Bartlomiej Zolnierkiewiczf65dedf2009-03-24 23:22:51 +0100585 } else
586 hw[i*2 + 1].irq = hw[i*2].irq = ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700587 }
588
Bartlomiej Zolnierkiewicz6cdf6eb2008-07-24 22:53:14 +0200589 ret = ide_host_register(host, d, hws);
590 if (ret)
591 ide_host_free(host);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700592out:
593 return ret;
594}
Bartlomiej Zolnierkiewicz6cdf6eb2008-07-24 22:53:14 +0200595EXPORT_SYMBOL_GPL(ide_pci_init_two);
Bartlomiej Zolnierkiewiczef0b0422008-07-24 22:53:19 +0200596
Bartlomiej Zolnierkiewiczad7c52d2009-06-10 14:37:21 +0200597int ide_pci_init_one(struct pci_dev *dev, const struct ide_port_info *d,
598 void *priv)
599{
600 return ide_pci_init_two(dev, NULL, d, priv);
601}
602EXPORT_SYMBOL_GPL(ide_pci_init_one);
603
Bartlomiej Zolnierkiewiczef0b0422008-07-24 22:53:19 +0200604void ide_pci_remove(struct pci_dev *dev)
605{
606 struct ide_host *host = pci_get_drvdata(dev);
607 struct pci_dev *dev2 = host->dev[1] ? to_pci_dev(host->dev[1]) : NULL;
608 int bars;
609
610 if (host->host_flags & IDE_HFLAG_SINGLE)
611 bars = (1 << 2) - 1;
612 else
613 bars = (1 << 4) - 1;
614
615 if ((host->host_flags & IDE_HFLAG_NO_DMA) == 0) {
616 if (host->host_flags & IDE_HFLAG_CS5520)
617 bars |= (1 << 2);
618 else
619 bars |= (1 << 4);
620 }
621
622 ide_host_remove(host);
623
624 if (dev2)
625 pci_release_selected_regions(dev2, bars);
626 pci_release_selected_regions(dev, bars);
627
628 if (dev2)
629 pci_disable_device(dev2);
630 pci_disable_device(dev);
631}
632EXPORT_SYMBOL_GPL(ide_pci_remove);
Bartlomiej Zolnierkiewiczfeb22b72008-10-10 22:39:32 +0200633
634#ifdef CONFIG_PM
635int ide_pci_suspend(struct pci_dev *dev, pm_message_t state)
636{
637 pci_save_state(dev);
638 pci_disable_device(dev);
639 pci_set_power_state(dev, pci_choose_state(dev, state));
640
641 return 0;
642}
643EXPORT_SYMBOL_GPL(ide_pci_suspend);
644
645int ide_pci_resume(struct pci_dev *dev)
646{
647 struct ide_host *host = pci_get_drvdata(dev);
648 int rc;
649
650 pci_set_power_state(dev, PCI_D0);
651
652 rc = pci_enable_device(dev);
653 if (rc)
654 return rc;
655
656 pci_restore_state(dev);
657 pci_set_master(dev);
658
659 if (host->init_chipset)
660 host->init_chipset(dev);
661
662 return 0;
663}
664EXPORT_SYMBOL_GPL(ide_pci_resume);
665#endif