diff options
author | Akira Iguchi <akira2.iguchi@toshiba.co.jp> | 2007-01-26 02:28:18 -0500 |
---|---|---|
committer | Jeff Garzik <jeff@garzik.org> | 2007-02-21 04:58:16 -0500 |
commit | a619f981b477035027dd27dfbee6148b4cd4a83c (patch) | |
tree | 2dd5fa1aa6221bbce64e0f03b2f534716a9f78ab | |
parent | c8f71b01a50597e298dc3214a2f2be7b8d31170c (diff) |
libata: PATA driver for Celleb
This is the patch for PATA controller of Celleb.
This driver uses the managed iomap (devres).
Because this driver needs special taskfile accesses, there is
a copy of ata_std_softreset(). ata_dev_try_classify() is exported
so that it can be used in this function.
Signed-off-by: Kou Ishizaki <kou.ishizaki@toshiba.co.jp>
Signed-off-by: Akira Iguchi <akira2.iguchi@toshiba.co.jp>
Signed-off-by: Jeff Garzik <jeff@garzik.org>
-rw-r--r-- | drivers/ata/Kconfig | 9 | ||||
-rw-r--r-- | drivers/ata/Makefile | 1 | ||||
-rw-r--r-- | drivers/ata/libata-core.c | 3 | ||||
-rw-r--r-- | drivers/ata/pata_scc.c | 1228 | ||||
-rw-r--r-- | include/linux/libata.h | 1 |
5 files changed, 1241 insertions, 1 deletions
diff --git a/drivers/ata/Kconfig b/drivers/ata/Kconfig index 4af0a4bb5780..376d2cdde009 100644 --- a/drivers/ata/Kconfig +++ b/drivers/ata/Kconfig | |||
@@ -562,6 +562,15 @@ config PATA_IXP4XX_CF | |||
562 | 562 | ||
563 | If unsure, say N. | 563 | If unsure, say N. |
564 | 564 | ||
565 | config PATA_SCC | ||
566 | tristate "Toshiba's Cell Reference Set IDE support" | ||
567 | depends on PCI | ||
568 | help | ||
569 | This option enables support for the built-in IDE controller on | ||
570 | Toshiba Cell Reference Board. | ||
571 | |||
572 | If unsure, say N. | ||
573 | |||
565 | endif | 574 | endif |
566 | endmenu | 575 | endmenu |
567 | 576 | ||
diff --git a/drivers/ata/Makefile b/drivers/ata/Makefile index 74298afbbaa7..13d7397e0008 100644 --- a/drivers/ata/Makefile +++ b/drivers/ata/Makefile | |||
@@ -59,6 +59,7 @@ obj-$(CONFIG_PATA_WINBOND_VLB) += pata_winbond.o | |||
59 | obj-$(CONFIG_PATA_SIS) += pata_sis.o | 59 | obj-$(CONFIG_PATA_SIS) += pata_sis.o |
60 | obj-$(CONFIG_PATA_TRIFLEX) += pata_triflex.o | 60 | obj-$(CONFIG_PATA_TRIFLEX) += pata_triflex.o |
61 | obj-$(CONFIG_PATA_IXP4XX_CF) += pata_ixp4xx_cf.o | 61 | obj-$(CONFIG_PATA_IXP4XX_CF) += pata_ixp4xx_cf.o |
62 | obj-$(CONFIG_PATA_SCC) += pata_scc.o | ||
62 | obj-$(CONFIG_PATA_PLATFORM) += pata_platform.o | 63 | obj-$(CONFIG_PATA_PLATFORM) += pata_platform.o |
63 | # Should be last but one libata driver | 64 | # Should be last but one libata driver |
64 | obj-$(CONFIG_ATA_GENERIC) += ata_generic.o | 65 | obj-$(CONFIG_ATA_GENERIC) += ata_generic.o |
diff --git a/drivers/ata/libata-core.c b/drivers/ata/libata-core.c index e900c5edefc4..9c54de5addff 100644 --- a/drivers/ata/libata-core.c +++ b/drivers/ata/libata-core.c | |||
@@ -708,7 +708,7 @@ unsigned int ata_dev_classify(const struct ata_taskfile *tf) | |||
708 | * Device type - %ATA_DEV_ATA, %ATA_DEV_ATAPI or %ATA_DEV_NONE. | 708 | * Device type - %ATA_DEV_ATA, %ATA_DEV_ATAPI or %ATA_DEV_NONE. |
709 | */ | 709 | */ |
710 | 710 | ||
711 | static unsigned int | 711 | unsigned int |
712 | ata_dev_try_classify(struct ata_port *ap, unsigned int device, u8 *r_err) | 712 | ata_dev_try_classify(struct ata_port *ap, unsigned int device, u8 *r_err) |
713 | { | 713 | { |
714 | struct ata_taskfile tf; | 714 | struct ata_taskfile tf; |
@@ -6311,3 +6311,4 @@ EXPORT_SYMBOL_GPL(ata_irq_on); | |||
6311 | EXPORT_SYMBOL_GPL(ata_dummy_irq_on); | 6311 | EXPORT_SYMBOL_GPL(ata_dummy_irq_on); |
6312 | EXPORT_SYMBOL_GPL(ata_irq_ack); | 6312 | EXPORT_SYMBOL_GPL(ata_irq_ack); |
6313 | EXPORT_SYMBOL_GPL(ata_dummy_irq_ack); | 6313 | EXPORT_SYMBOL_GPL(ata_dummy_irq_ack); |
6314 | EXPORT_SYMBOL_GPL(ata_dev_try_classify); | ||
diff --git a/drivers/ata/pata_scc.c b/drivers/ata/pata_scc.c new file mode 100644 index 000000000000..049a3a284729 --- /dev/null +++ b/drivers/ata/pata_scc.c | |||
@@ -0,0 +1,1228 @@ | |||
1 | /* | ||
2 | * Support for IDE interfaces on Celleb platform | ||
3 | * | ||
4 | * (C) Copyright 2006 TOSHIBA CORPORATION | ||
5 | * | ||
6 | * This code is based on drivers/ata/ata_piix.c: | ||
7 | * Copyright 2003-2005 Red Hat Inc | ||
8 | * Copyright 2003-2005 Jeff Garzik | ||
9 | * Copyright (C) 1998-1999 Andrzej Krzysztofowicz, Author and Maintainer | ||
10 | * Copyright (C) 1998-2000 Andre Hedrick <andre@linux-ide.org> | ||
11 | * Copyright (C) 2003 Red Hat Inc <alan@redhat.com> | ||
12 | * | ||
13 | * and drivers/ata/ahci.c: | ||
14 | * Copyright 2004-2005 Red Hat, Inc. | ||
15 | * | ||
16 | * and drivers/ata/libata-core.c: | ||
17 | * Copyright 2003-2004 Red Hat, Inc. All rights reserved. | ||
18 | * Copyright 2003-2004 Jeff Garzik | ||
19 | * | ||
20 | * This program is free software; you can redistribute it and/or modify | ||
21 | * it under the terms of the GNU General Public License as published by | ||
22 | * the Free Software Foundation; either version 2 of the License, or | ||
23 | * (at your option) any later version. | ||
24 | * | ||
25 | * This program is distributed in the hope that it will be useful, | ||
26 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
27 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
28 | * GNU General Public License for more details. | ||
29 | * | ||
30 | * You should have received a copy of the GNU General Public License along | ||
31 | * with this program; if not, write to the Free Software Foundation, Inc., | ||
32 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. | ||
33 | */ | ||
34 | |||
35 | #include <linux/kernel.h> | ||
36 | #include <linux/module.h> | ||
37 | #include <linux/pci.h> | ||
38 | #include <linux/init.h> | ||
39 | #include <linux/blkdev.h> | ||
40 | #include <linux/delay.h> | ||
41 | #include <linux/device.h> | ||
42 | #include <scsi/scsi_host.h> | ||
43 | #include <linux/libata.h> | ||
44 | |||
45 | #define DRV_NAME "pata_scc" | ||
46 | #define DRV_VERSION "0.1" | ||
47 | |||
48 | #define PCI_DEVICE_ID_TOSHIBA_SCC_ATA 0x01b4 | ||
49 | |||
50 | /* PCI BARs */ | ||
51 | #define SCC_CTRL_BAR 0 | ||
52 | #define SCC_BMID_BAR 1 | ||
53 | |||
54 | /* offset of CTRL registers */ | ||
55 | #define SCC_CTL_PIOSHT 0x000 | ||
56 | #define SCC_CTL_PIOCT 0x004 | ||
57 | #define SCC_CTL_MDMACT 0x008 | ||
58 | #define SCC_CTL_MCRCST 0x00C | ||
59 | #define SCC_CTL_SDMACT 0x010 | ||
60 | #define SCC_CTL_SCRCST 0x014 | ||
61 | #define SCC_CTL_UDENVT 0x018 | ||
62 | #define SCC_CTL_TDVHSEL 0x020 | ||
63 | #define SCC_CTL_MODEREG 0x024 | ||
64 | #define SCC_CTL_ECMODE 0xF00 | ||
65 | #define SCC_CTL_MAEA0 0xF50 | ||
66 | #define SCC_CTL_MAEC0 0xF54 | ||
67 | #define SCC_CTL_CCKCTRL 0xFF0 | ||
68 | |||
69 | /* offset of BMID registers */ | ||
70 | #define SCC_DMA_CMD 0x000 | ||
71 | #define SCC_DMA_STATUS 0x004 | ||
72 | #define SCC_DMA_TABLE_OFS 0x008 | ||
73 | #define SCC_DMA_INTMASK 0x010 | ||
74 | #define SCC_DMA_INTST 0x014 | ||
75 | #define SCC_DMA_PTERADD 0x018 | ||
76 | #define SCC_REG_CMD_ADDR 0x020 | ||
77 | #define SCC_REG_DATA 0x000 | ||
78 | #define SCC_REG_ERR 0x004 | ||
79 | #define SCC_REG_FEATURE 0x004 | ||
80 | #define SCC_REG_NSECT 0x008 | ||
81 | #define SCC_REG_LBAL 0x00C | ||
82 | #define SCC_REG_LBAM 0x010 | ||
83 | #define SCC_REG_LBAH 0x014 | ||
84 | #define SCC_REG_DEVICE 0x018 | ||
85 | #define SCC_REG_STATUS 0x01C | ||
86 | #define SCC_REG_CMD 0x01C | ||
87 | #define SCC_REG_ALTSTATUS 0x020 | ||
88 | |||
89 | /* register value */ | ||
90 | #define TDVHSEL_MASTER 0x00000001 | ||
91 | #define TDVHSEL_SLAVE 0x00000004 | ||
92 | |||
93 | #define MODE_JCUSFEN 0x00000080 | ||
94 | |||
95 | #define ECMODE_VALUE 0x01 | ||
96 | |||
97 | #define CCKCTRL_ATARESET 0x00040000 | ||
98 | #define CCKCTRL_BUFCNT 0x00020000 | ||
99 | #define CCKCTRL_CRST 0x00010000 | ||
100 | #define CCKCTRL_OCLKEN 0x00000100 | ||
101 | #define CCKCTRL_ATACLKOEN 0x00000002 | ||
102 | #define CCKCTRL_LCLKEN 0x00000001 | ||
103 | |||
104 | #define QCHCD_IOS_SS 0x00000001 | ||
105 | |||
106 | #define QCHSD_STPDIAG 0x00020000 | ||
107 | |||
108 | #define INTMASK_MSK 0xD1000012 | ||
109 | #define INTSTS_SERROR 0x80000000 | ||
110 | #define INTSTS_PRERR 0x40000000 | ||
111 | #define INTSTS_RERR 0x10000000 | ||
112 | #define INTSTS_ICERR 0x01000000 | ||
113 | #define INTSTS_BMSINT 0x00000010 | ||
114 | #define INTSTS_BMHE 0x00000008 | ||
115 | #define INTSTS_IOIRQS 0x00000004 | ||
116 | #define INTSTS_INTRQ 0x00000002 | ||
117 | #define INTSTS_ACTEINT 0x00000001 | ||
118 | |||
119 | |||
120 | /* PIO transfer mode table */ | ||
121 | /* JCHST */ | ||
122 | static const unsigned long JCHSTtbl[2][7] = { | ||
123 | {0x0E, 0x05, 0x02, 0x03, 0x02, 0x00, 0x00}, /* 100MHz */ | ||
124 | {0x13, 0x07, 0x04, 0x04, 0x03, 0x00, 0x00} /* 133MHz */ | ||
125 | }; | ||
126 | |||
127 | /* JCHHT */ | ||
128 | static const unsigned long JCHHTtbl[2][7] = { | ||
129 | {0x0E, 0x02, 0x02, 0x02, 0x02, 0x00, 0x00}, /* 100MHz */ | ||
130 | {0x13, 0x03, 0x03, 0x03, 0x03, 0x00, 0x00} /* 133MHz */ | ||
131 | }; | ||
132 | |||
133 | /* JCHCT */ | ||
134 | static const unsigned long JCHCTtbl[2][7] = { | ||
135 | {0x1D, 0x1D, 0x1C, 0x0B, 0x06, 0x00, 0x00}, /* 100MHz */ | ||
136 | {0x27, 0x26, 0x26, 0x0E, 0x09, 0x00, 0x00} /* 133MHz */ | ||
137 | }; | ||
138 | |||
139 | /* DMA transfer mode table */ | ||
140 | /* JCHDCTM/JCHDCTS */ | ||
141 | static const unsigned long JCHDCTxtbl[2][7] = { | ||
142 | {0x0A, 0x06, 0x04, 0x03, 0x01, 0x00, 0x00}, /* 100MHz */ | ||
143 | {0x0E, 0x09, 0x06, 0x04, 0x02, 0x01, 0x00} /* 133MHz */ | ||
144 | }; | ||
145 | |||
146 | /* JCSTWTM/JCSTWTS */ | ||
147 | static const unsigned long JCSTWTxtbl[2][7] = { | ||
148 | {0x06, 0x04, 0x03, 0x02, 0x02, 0x02, 0x00}, /* 100MHz */ | ||
149 | {0x09, 0x06, 0x04, 0x02, 0x02, 0x02, 0x02} /* 133MHz */ | ||
150 | }; | ||
151 | |||
152 | /* JCTSS */ | ||
153 | static const unsigned long JCTSStbl[2][7] = { | ||
154 | {0x05, 0x05, 0x05, 0x05, 0x05, 0x05, 0x00}, /* 100MHz */ | ||
155 | {0x05, 0x05, 0x05, 0x05, 0x05, 0x05, 0x05} /* 133MHz */ | ||
156 | }; | ||
157 | |||
158 | /* JCENVT */ | ||
159 | static const unsigned long JCENVTtbl[2][7] = { | ||
160 | {0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x00}, /* 100MHz */ | ||
161 | {0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02} /* 133MHz */ | ||
162 | }; | ||
163 | |||
164 | /* JCACTSELS/JCACTSELM */ | ||
165 | static const unsigned long JCACTSELtbl[2][7] = { | ||
166 | {0x00, 0x00, 0x00, 0x00, 0x01, 0x01, 0x00}, /* 100MHz */ | ||
167 | {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01} /* 133MHz */ | ||
168 | }; | ||
169 | |||
170 | static const struct pci_device_id scc_pci_tbl[] = { | ||
171 | {PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_SCC_ATA, | ||
172 | PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, | ||
173 | { } /* terminate list */ | ||
174 | }; | ||
175 | |||
176 | /** | ||
177 | * scc_set_piomode - Initialize host controller PATA PIO timings | ||
178 | * @ap: Port whose timings we are configuring | ||
179 | * @adev: um | ||
180 | * | ||
181 | * Set PIO mode for device. | ||
182 | * | ||
183 | * LOCKING: | ||
184 | * None (inherited from caller). | ||
185 | */ | ||
186 | |||
187 | static void scc_set_piomode (struct ata_port *ap, struct ata_device *adev) | ||
188 | { | ||
189 | unsigned int pio = adev->pio_mode - XFER_PIO_0; | ||
190 | void __iomem *ctrl_base = ap->host->iomap[SCC_CTRL_BAR]; | ||
191 | void __iomem *cckctrl_port = ctrl_base + SCC_CTL_CCKCTRL; | ||
192 | void __iomem *piosht_port = ctrl_base + SCC_CTL_PIOSHT; | ||
193 | void __iomem *pioct_port = ctrl_base + SCC_CTL_PIOCT; | ||
194 | unsigned long reg; | ||
195 | int offset; | ||
196 | |||
197 | reg = in_be32(cckctrl_port); | ||
198 | if (reg & CCKCTRL_ATACLKOEN) | ||
199 | offset = 1; /* 133MHz */ | ||
200 | else | ||
201 | offset = 0; /* 100MHz */ | ||
202 | |||
203 | reg = JCHSTtbl[offset][pio] << 16 | JCHHTtbl[offset][pio]; | ||
204 | out_be32(piosht_port, reg); | ||
205 | reg = JCHCTtbl[offset][pio]; | ||
206 | out_be32(pioct_port, reg); | ||
207 | } | ||
208 | |||
209 | /** | ||
210 | * scc_set_dmamode - Initialize host controller PATA DMA timings | ||
211 | * @ap: Port whose timings we are configuring | ||
212 | * @adev: um | ||
213 | * @udma: udma mode, 0 - 6 | ||
214 | * | ||
215 | * Set UDMA mode for device. | ||
216 | * | ||
217 | * LOCKING: | ||
218 | * None (inherited from caller). | ||
219 | */ | ||
220 | |||
221 | static void scc_set_dmamode (struct ata_port *ap, struct ata_device *adev) | ||
222 | { | ||
223 | unsigned int udma = adev->dma_mode; | ||
224 | unsigned int is_slave = (adev->devno != 0); | ||
225 | u8 speed = udma; | ||
226 | void __iomem *ctrl_base = ap->host->iomap[SCC_CTRL_BAR]; | ||
227 | void __iomem *cckctrl_port = ctrl_base + SCC_CTL_CCKCTRL; | ||
228 | void __iomem *mdmact_port = ctrl_base + SCC_CTL_MDMACT; | ||
229 | void __iomem *mcrcst_port = ctrl_base + SCC_CTL_MCRCST; | ||
230 | void __iomem *sdmact_port = ctrl_base + SCC_CTL_SDMACT; | ||
231 | void __iomem *scrcst_port = ctrl_base + SCC_CTL_SCRCST; | ||
232 | void __iomem *udenvt_port = ctrl_base + SCC_CTL_UDENVT; | ||
233 | void __iomem *tdvhsel_port = ctrl_base + SCC_CTL_TDVHSEL; | ||
234 | int offset, idx; | ||
235 | |||
236 | if (in_be32(cckctrl_port) & CCKCTRL_ATACLKOEN) | ||
237 | offset = 1; /* 133MHz */ | ||
238 | else | ||
239 | offset = 0; /* 100MHz */ | ||
240 | |||
241 | if (speed >= XFER_UDMA_0) | ||
242 | idx = speed - XFER_UDMA_0; | ||
243 | else | ||
244 | return; | ||
245 | |||
246 | if (is_slave) { | ||
247 | out_be32(sdmact_port, JCHDCTxtbl[offset][idx]); | ||
248 | out_be32(scrcst_port, JCSTWTxtbl[offset][idx]); | ||
249 | out_be32(tdvhsel_port, | ||
250 | (in_be32(tdvhsel_port) & ~TDVHSEL_SLAVE) | (JCACTSELtbl[offset][idx] << 2)); | ||
251 | } else { | ||
252 | out_be32(mdmact_port, JCHDCTxtbl[offset][idx]); | ||
253 | out_be32(mcrcst_port, JCSTWTxtbl[offset][idx]); | ||
254 | out_be32(tdvhsel_port, | ||
255 | (in_be32(tdvhsel_port) & ~TDVHSEL_MASTER) | JCACTSELtbl[offset][idx]); | ||
256 | } | ||
257 | out_be32(udenvt_port, | ||
258 | JCTSStbl[offset][idx] << 16 | JCENVTtbl[offset][idx]); | ||
259 | } | ||
260 | |||
261 | /** | ||
262 | * scc_tf_load - send taskfile registers to host controller | ||
263 | * @ap: Port to which output is sent | ||
264 | * @tf: ATA taskfile register set | ||
265 | * | ||
266 | * Note: Original code is ata_tf_load(). | ||
267 | */ | ||
268 | |||
269 | static void scc_tf_load (struct ata_port *ap, const struct ata_taskfile *tf) | ||
270 | { | ||
271 | struct ata_ioports *ioaddr = &ap->ioaddr; | ||
272 | unsigned int is_addr = tf->flags & ATA_TFLAG_ISADDR; | ||
273 | |||
274 | if (tf->ctl != ap->last_ctl) { | ||
275 | out_be32(ioaddr->ctl_addr, tf->ctl); | ||
276 | ap->last_ctl = tf->ctl; | ||
277 | ata_wait_idle(ap); | ||
278 | } | ||
279 | |||
280 | if (is_addr && (tf->flags & ATA_TFLAG_LBA48)) { | ||
281 | out_be32(ioaddr->feature_addr, tf->hob_feature); | ||
282 | out_be32(ioaddr->nsect_addr, tf->hob_nsect); | ||
283 | out_be32(ioaddr->lbal_addr, tf->hob_lbal); | ||
284 | out_be32(ioaddr->lbam_addr, tf->hob_lbam); | ||
285 | out_be32(ioaddr->lbah_addr, tf->hob_lbah); | ||
286 | VPRINTK("hob: feat 0x%X nsect 0x%X, lba 0x%X 0x%X 0x%X\n", | ||
287 | tf->hob_feature, | ||
288 | tf->hob_nsect, | ||
289 | tf->hob_lbal, | ||
290 | tf->hob_lbam, | ||
291 | tf->hob_lbah); | ||
292 | } | ||
293 | |||
294 | if (is_addr) { | ||
295 | out_be32(ioaddr->feature_addr, tf->feature); | ||
296 | out_be32(ioaddr->nsect_addr, tf->nsect); | ||
297 | out_be32(ioaddr->lbal_addr, tf->lbal); | ||
298 | out_be32(ioaddr->lbam_addr, tf->lbam); | ||
299 | out_be32(ioaddr->lbah_addr, tf->lbah); | ||
300 | VPRINTK("feat 0x%X nsect 0x%X lba 0x%X 0x%X 0x%X\n", | ||
301 | tf->feature, | ||
302 | tf->nsect, | ||
303 | tf->lbal, | ||
304 | tf->lbam, | ||
305 | tf->lbah); | ||
306 | } | ||
307 | |||
308 | if (tf->flags & ATA_TFLAG_DEVICE) { | ||
309 | out_be32(ioaddr->device_addr, tf->device); | ||
310 | VPRINTK("device 0x%X\n", tf->device); | ||
311 | } | ||
312 | |||
313 | ata_wait_idle(ap); | ||
314 | } | ||
315 | |||
316 | /** | ||
317 | * scc_check_status - Read device status reg & clear interrupt | ||
318 | * @ap: port where the device is | ||
319 | * | ||
320 | * Note: Original code is ata_check_status(). | ||
321 | */ | ||
322 | |||
323 | static u8 scc_check_status (struct ata_port *ap) | ||
324 | { | ||
325 | return in_be32(ap->ioaddr.status_addr); | ||
326 | } | ||
327 | |||
328 | /** | ||
329 | * scc_tf_read - input device's ATA taskfile shadow registers | ||
330 | * @ap: Port from which input is read | ||
331 | * @tf: ATA taskfile register set for storing input | ||
332 | * | ||
333 | * Note: Original code is ata_tf_read(). | ||
334 | */ | ||
335 | |||
336 | static void scc_tf_read (struct ata_port *ap, struct ata_taskfile *tf) | ||
337 | { | ||
338 | struct ata_ioports *ioaddr = &ap->ioaddr; | ||
339 | |||
340 | tf->command = scc_check_status(ap); | ||
341 | tf->feature = in_be32(ioaddr->error_addr); | ||
342 | tf->nsect = in_be32(ioaddr->nsect_addr); | ||
343 | tf->lbal = in_be32(ioaddr->lbal_addr); | ||
344 | tf->lbam = in_be32(ioaddr->lbam_addr); | ||
345 | tf->lbah = in_be32(ioaddr->lbah_addr); | ||
346 | tf->device = in_be32(ioaddr->device_addr); | ||
347 | |||
348 | if (tf->flags & ATA_TFLAG_LBA48) { | ||
349 | out_be32(ioaddr->ctl_addr, tf->ctl | ATA_HOB); | ||
350 | tf->hob_feature = in_be32(ioaddr->error_addr); | ||
351 | tf->hob_nsect = in_be32(ioaddr->nsect_addr); | ||
352 | tf->hob_lbal = in_be32(ioaddr->lbal_addr); | ||
353 | tf->hob_lbam = in_be32(ioaddr->lbam_addr); | ||
354 | tf->hob_lbah = in_be32(ioaddr->lbah_addr); | ||
355 | } | ||
356 | } | ||
357 | |||
358 | /** | ||
359 | * scc_exec_command - issue ATA command to host controller | ||
360 | * @ap: port to which command is being issued | ||
361 | * @tf: ATA taskfile register set | ||
362 | * | ||
363 | * Note: Original code is ata_exec_command(). | ||
364 | */ | ||
365 | |||
366 | static void scc_exec_command (struct ata_port *ap, | ||
367 | const struct ata_taskfile *tf) | ||
368 | { | ||
369 | DPRINTK("ata%u: cmd 0x%X\n", ap->id, tf->command); | ||
370 | |||
371 | out_be32(ap->ioaddr.command_addr, tf->command); | ||
372 | ata_pause(ap); | ||
373 | } | ||
374 | |||
375 | /** | ||
376 | * scc_check_altstatus - Read device alternate status reg | ||
377 | * @ap: port where the device is | ||
378 | */ | ||
379 | |||
380 | static u8 scc_check_altstatus (struct ata_port *ap) | ||
381 | { | ||
382 | return in_be32(ap->ioaddr.altstatus_addr); | ||
383 | } | ||
384 | |||
385 | /** | ||
386 | * scc_std_dev_select - Select device 0/1 on ATA bus | ||
387 | * @ap: ATA channel to manipulate | ||
388 | * @device: ATA device (numbered from zero) to select | ||
389 | * | ||
390 | * Note: Original code is ata_std_dev_select(). | ||
391 | */ | ||
392 | |||
393 | static void scc_std_dev_select (struct ata_port *ap, unsigned int device) | ||
394 | { | ||
395 | u8 tmp; | ||
396 | |||
397 | if (device == 0) | ||
398 | tmp = ATA_DEVICE_OBS; | ||
399 | else | ||
400 | tmp = ATA_DEVICE_OBS | ATA_DEV1; | ||
401 | |||
402 | out_be32(ap->ioaddr.device_addr, tmp); | ||
403 | ata_pause(ap); | ||
404 | } | ||
405 | |||
406 | /** | ||
407 | * scc_bmdma_setup - Set up PCI IDE BMDMA transaction | ||
408 | * @qc: Info associated with this ATA transaction. | ||
409 | * | ||
410 | * Note: Original code is ata_bmdma_setup(). | ||
411 | */ | ||
412 | |||
413 | static void scc_bmdma_setup (struct ata_queued_cmd *qc) | ||
414 | { | ||
415 | struct ata_port *ap = qc->ap; | ||
416 | unsigned int rw = (qc->tf.flags & ATA_TFLAG_WRITE); | ||
417 | u8 dmactl; | ||
418 | void __iomem *mmio = ap->ioaddr.bmdma_addr; | ||
419 | |||
420 | /* load PRD table addr */ | ||
421 | out_be32(mmio + SCC_DMA_TABLE_OFS, ap->prd_dma); | ||
422 | |||
423 | /* specify data direction, triple-check start bit is clear */ | ||
424 | dmactl = in_be32(mmio + SCC_DMA_CMD); | ||
425 | dmactl &= ~(ATA_DMA_WR | ATA_DMA_START); | ||
426 | if (!rw) | ||
427 | dmactl |= ATA_DMA_WR; | ||
428 | out_be32(mmio + SCC_DMA_CMD, dmactl); | ||
429 | |||
430 | /* issue r/w command */ | ||
431 | ap->ops->exec_command(ap, &qc->tf); | ||
432 | } | ||
433 | |||
434 | /** | ||
435 | * scc_bmdma_start - Start a PCI IDE BMDMA transaction | ||
436 | * @qc: Info associated with this ATA transaction. | ||
437 | * | ||
438 | * Note: Original code is ata_bmdma_start(). | ||
439 | */ | ||
440 | |||
441 | static void scc_bmdma_start (struct ata_queued_cmd *qc) | ||
442 | { | ||
443 | struct ata_port *ap = qc->ap; | ||
444 | u8 dmactl; | ||
445 | void __iomem *mmio = ap->ioaddr.bmdma_addr; | ||
446 | |||
447 | /* start host DMA transaction */ | ||
448 | dmactl = in_be32(mmio + SCC_DMA_CMD); | ||
449 | out_be32(mmio + SCC_DMA_CMD, dmactl | ATA_DMA_START); | ||
450 | } | ||
451 | |||
452 | /** | ||
453 | * scc_devchk - PATA device presence detection | ||
454 | * @ap: ATA channel to examine | ||
455 | * @device: Device to examine (starting at zero) | ||
456 | * | ||
457 | * Note: Original code is ata_devchk(). | ||
458 | */ | ||
459 | |||
460 | static unsigned int scc_devchk (struct ata_port *ap, | ||
461 | unsigned int device) | ||
462 | { | ||
463 | struct ata_ioports *ioaddr = &ap->ioaddr; | ||
464 | u8 nsect, lbal; | ||
465 | |||
466 | ap->ops->dev_select(ap, device); | ||
467 | |||
468 | out_be32(ioaddr->nsect_addr, 0x55); | ||
469 | out_be32(ioaddr->lbal_addr, 0xaa); | ||
470 | |||
471 | out_be32(ioaddr->nsect_addr, 0xaa); | ||
472 | out_be32(ioaddr->lbal_addr, 0x55); | ||
473 | |||
474 | out_be32(ioaddr->nsect_addr, 0x55); | ||
475 | out_be32(ioaddr->lbal_addr, 0xaa); | ||
476 | |||
477 | nsect = in_be32(ioaddr->nsect_addr); | ||
478 | lbal = in_be32(ioaddr->lbal_addr); | ||
479 | |||
480 | if ((nsect == 0x55) && (lbal == 0xaa)) | ||
481 | return 1; /* we found a device */ | ||
482 | |||
483 | return 0; /* nothing found */ | ||
484 | } | ||
485 | |||
486 | /** | ||
487 | * scc_bus_post_reset - PATA device post reset | ||
488 | * | ||
489 | * Note: Original code is ata_bus_post_reset(). | ||
490 | */ | ||
491 | |||
492 | static void scc_bus_post_reset (struct ata_port *ap, unsigned int devmask) | ||
493 | { | ||
494 | struct ata_ioports *ioaddr = &ap->ioaddr; | ||
495 | unsigned int dev0 = devmask & (1 << 0); | ||
496 | unsigned int dev1 = devmask & (1 << 1); | ||
497 | unsigned long timeout; | ||
498 | |||
499 | /* if device 0 was found in ata_devchk, wait for its | ||
500 | * BSY bit to clear | ||
501 | */ | ||
502 | if (dev0) | ||
503 | ata_busy_sleep(ap, ATA_TMOUT_BOOT_QUICK, ATA_TMOUT_BOOT); | ||
504 | |||
505 | /* if device 1 was found in ata_devchk, wait for | ||
506 | * register access, then wait for BSY to clear | ||
507 | */ | ||
508 | timeout = jiffies + ATA_TMOUT_BOOT; | ||
509 | while (dev1) { | ||
510 | u8 nsect, lbal; | ||
511 | |||
512 | ap->ops->dev_select(ap, 1); | ||
513 | nsect = in_be32(ioaddr->nsect_addr); | ||
514 | lbal = in_be32(ioaddr->lbal_addr); | ||
515 | if ((nsect == 1) && (lbal == 1)) | ||
516 | break; | ||
517 | if (time_after(jiffies, timeout)) { | ||
518 | dev1 = 0; | ||
519 | break; | ||
520 | } | ||
521 | msleep(50); /* give drive a breather */ | ||
522 | } | ||
523 | if (dev1) | ||
524 | ata_busy_sleep(ap, ATA_TMOUT_BOOT_QUICK, ATA_TMOUT_BOOT); | ||
525 | |||
526 | /* is all this really necessary? */ | ||
527 | ap->ops->dev_select(ap, 0); | ||
528 | if (dev1) | ||
529 | ap->ops->dev_select(ap, 1); | ||
530 | if (dev0) | ||
531 | ap->ops->dev_select(ap, 0); | ||
532 | } | ||
533 | |||
534 | /** | ||
535 | * scc_bus_softreset - PATA device software reset | ||
536 | * | ||
537 | * Note: Original code is ata_bus_softreset(). | ||
538 | */ | ||
539 | |||
540 | static unsigned int scc_bus_softreset (struct ata_port *ap, | ||
541 | unsigned int devmask) | ||
542 | { | ||
543 | struct ata_ioports *ioaddr = &ap->ioaddr; | ||
544 | |||
545 | DPRINTK("ata%u: bus reset via SRST\n", ap->id); | ||
546 | |||
547 | /* software reset. causes dev0 to be selected */ | ||
548 | out_be32(ioaddr->ctl_addr, ap->ctl); | ||
549 | udelay(20); | ||
550 | out_be32(ioaddr->ctl_addr, ap->ctl | ATA_SRST); | ||
551 | udelay(20); | ||
552 | out_be32(ioaddr->ctl_addr, ap->ctl); | ||
553 | |||
554 | /* spec mandates ">= 2ms" before checking status. | ||
555 | * We wait 150ms, because that was the magic delay used for | ||
556 | * ATAPI devices in Hale Landis's ATADRVR, for the period of time | ||
557 | * between when the ATA command register is written, and then | ||
558 | * status is checked. Because waiting for "a while" before | ||
559 | * checking status is fine, post SRST, we perform this magic | ||
560 | * delay here as well. | ||
561 | * | ||
562 | * Old drivers/ide uses the 2mS rule and then waits for ready | ||
563 | */ | ||
564 | msleep(150); | ||
565 | |||
566 | /* Before we perform post reset processing we want to see if | ||
567 | * the bus shows 0xFF because the odd clown forgets the D7 | ||
568 | * pulldown resistor. | ||
569 | */ | ||
570 | if (scc_check_status(ap) == 0xFF) | ||
571 | return 0; | ||
572 | |||
573 | scc_bus_post_reset(ap, devmask); | ||
574 | |||
575 | return 0; | ||
576 | } | ||
577 | |||
578 | /** | ||
579 | * scc_std_softreset - reset host port via ATA SRST | ||
580 | * @ap: port to reset | ||
581 | * @classes: resulting classes of attached devices | ||
582 | * | ||
583 | * Note: Original code is ata_std_softreset(). | ||
584 | */ | ||
585 | |||
586 | static int scc_std_softreset (struct ata_port *ap, unsigned int *classes) | ||
587 | { | ||
588 | unsigned int slave_possible = ap->flags & ATA_FLAG_SLAVE_POSS; | ||
589 | unsigned int devmask = 0, err_mask; | ||
590 | u8 err; | ||
591 | |||
592 | DPRINTK("ENTER\n"); | ||
593 | |||
594 | if (ata_port_offline(ap)) { | ||
595 | classes[0] = ATA_DEV_NONE; | ||
596 | goto out; | ||
597 | } | ||
598 | |||
599 | /* determine if device 0/1 are present */ | ||
600 | if (scc_devchk(ap, 0)) | ||
601 | devmask |= (1 << 0); | ||
602 | if (slave_possible && scc_devchk(ap, 1)) | ||
603 | devmask |= (1 << 1); | ||
604 | |||
605 | /* select device 0 again */ | ||
606 | ap->ops->dev_select(ap, 0); | ||
607 | |||
608 | /* issue bus reset */ | ||
609 | DPRINTK("about to softreset, devmask=%x\n", devmask); | ||
610 | err_mask = scc_bus_softreset(ap, devmask); | ||
611 | if (err_mask) { | ||
612 | ata_port_printk(ap, KERN_ERR, "SRST failed (err_mask=0x%x)\n", | ||
613 | err_mask); | ||
614 | return -EIO; | ||
615 | } | ||
616 | |||
617 | /* determine by signature whether we have ATA or ATAPI devices */ | ||
618 | classes[0] = ata_dev_try_classify(ap, 0, &err); | ||
619 | if (slave_possible && err != 0x81) | ||
620 | classes[1] = ata_dev_try_classify(ap, 1, &err); | ||
621 | |||
622 | out: | ||
623 | DPRINTK("EXIT, classes[0]=%u [1]=%u\n", classes[0], classes[1]); | ||
624 | return 0; | ||
625 | } | ||
626 | |||
627 | /** | ||
628 | * scc_bmdma_stop - Stop PCI IDE BMDMA transfer | ||
629 | * @qc: Command we are ending DMA for | ||
630 | */ | ||
631 | |||
632 | static void scc_bmdma_stop (struct ata_queued_cmd *qc) | ||
633 | { | ||
634 | struct ata_port *ap = qc->ap; | ||
635 | void __iomem *ctrl_base = ap->host->iomap[SCC_CTRL_BAR]; | ||
636 | void __iomem *bmid_base = ap->host->iomap[SCC_BMID_BAR]; | ||
637 | u32 reg; | ||
638 | |||
639 | while (1) { | ||
640 | reg = in_be32(bmid_base + SCC_DMA_INTST); | ||
641 | |||
642 | if (reg & INTSTS_SERROR) { | ||
643 | printk(KERN_WARNING "%s: SERROR\n", DRV_NAME); | ||
644 | out_be32(bmid_base + SCC_DMA_INTST, INTSTS_SERROR|INTSTS_BMSINT); | ||
645 | out_be32(bmid_base + SCC_DMA_CMD, | ||
646 | in_be32(bmid_base + SCC_DMA_CMD) & ~ATA_DMA_START); | ||
647 | continue; | ||
648 | } | ||
649 | |||
650 | if (reg & INTSTS_PRERR) { | ||
651 | u32 maea0, maec0; | ||
652 | maea0 = in_be32(ctrl_base + SCC_CTL_MAEA0); | ||
653 | maec0 = in_be32(ctrl_base + SCC_CTL_MAEC0); | ||
654 | printk(KERN_WARNING "%s: PRERR [addr:%x cmd:%x]\n", DRV_NAME, maea0, maec0); | ||
655 | out_be32(bmid_base + SCC_DMA_INTST, INTSTS_PRERR|INTSTS_BMSINT); | ||
656 | out_be32(bmid_base + SCC_DMA_CMD, | ||
657 | in_be32(bmid_base + SCC_DMA_CMD) & ~ATA_DMA_START); | ||
658 | continue; | ||
659 | } | ||
660 | |||
661 | if (reg & INTSTS_RERR) { | ||
662 | printk(KERN_WARNING "%s: Response Error\n", DRV_NAME); | ||
663 | out_be32(bmid_base + SCC_DMA_INTST, INTSTS_RERR|INTSTS_BMSINT); | ||
664 | out_be32(bmid_base + SCC_DMA_CMD, | ||
665 | in_be32(bmid_base + SCC_DMA_CMD) & ~ATA_DMA_START); | ||
666 | continue; | ||
667 | } | ||
668 | |||
669 | if (reg & INTSTS_ICERR) { | ||
670 | out_be32(bmid_base + SCC_DMA_CMD, | ||
671 | in_be32(bmid_base + SCC_DMA_CMD) & ~ATA_DMA_START); | ||
672 | printk(KERN_WARNING "%s: Illegal Configuration\n", DRV_NAME); | ||
673 | out_be32(bmid_base + SCC_DMA_INTST, INTSTS_ICERR|INTSTS_BMSINT); | ||
674 | continue; | ||
675 | } | ||
676 | |||
677 | if (reg & INTSTS_BMSINT) { | ||
678 | unsigned int classes; | ||
679 | printk(KERN_WARNING "%s: Internal Bus Error\n", DRV_NAME); | ||
680 | out_be32(bmid_base + SCC_DMA_INTST, INTSTS_BMSINT); | ||
681 | /* TBD: SW reset */ | ||
682 | scc_std_softreset(ap, &classes); | ||
683 | continue; | ||
684 | } | ||
685 | |||
686 | if (reg & INTSTS_BMHE) { | ||
687 | out_be32(bmid_base + SCC_DMA_INTST, INTSTS_BMHE); | ||
688 | continue; | ||
689 | } | ||
690 | |||
691 | if (reg & INTSTS_ACTEINT) { | ||
692 | out_be32(bmid_base + SCC_DMA_INTST, INTSTS_ACTEINT); | ||
693 | continue; | ||
694 | } | ||
695 | |||
696 | if (reg & INTSTS_IOIRQS) { | ||
697 | out_be32(bmid_base + SCC_DMA_INTST, INTSTS_IOIRQS); | ||
698 | continue; | ||
699 | } | ||
700 | break; | ||
701 | } | ||
702 | |||
703 | /* clear start/stop bit */ | ||
704 | out_be32(bmid_base + SCC_DMA_CMD, | ||
705 | in_be32(bmid_base + SCC_DMA_CMD) & ~ATA_DMA_START); | ||
706 | |||
707 | /* one-PIO-cycle guaranteed wait, per spec, for HDMA1:0 transition */ | ||
708 | ata_altstatus(ap); /* dummy read */ | ||
709 | } | ||
710 | |||
711 | /** | ||
712 | * scc_bmdma_status - Read PCI IDE BMDMA status | ||
713 | * @ap: Port associated with this ATA transaction. | ||
714 | */ | ||
715 | |||
716 | static u8 scc_bmdma_status (struct ata_port *ap) | ||
717 | { | ||
718 | u8 host_stat; | ||
719 | void __iomem *mmio = ap->ioaddr.bmdma_addr; | ||
720 | |||
721 | host_stat = in_be32(mmio + SCC_DMA_STATUS); | ||
722 | |||
723 | /* Workaround for PTERADD: emulate DMA_INTR when | ||
724 | * - IDE_STATUS[ERR] = 1 | ||
725 | * - INT_STATUS[INTRQ] = 1 | ||
726 | * - DMA_STATUS[IORACTA] = 1 | ||
727 | */ | ||
728 | if (!(host_stat & ATA_DMA_INTR)) { | ||
729 | u32 int_status = in_be32(mmio + SCC_DMA_INTST); | ||
730 | if (ata_altstatus(ap) & ATA_ERR && | ||
731 | int_status & INTSTS_INTRQ && | ||
732 | host_stat & ATA_DMA_ACTIVE) | ||
733 | host_stat |= ATA_DMA_INTR; | ||
734 | } | ||
735 | |||
736 | return host_stat; | ||
737 | } | ||
738 | |||
739 | /** | ||
740 | * scc_data_xfer - Transfer data by PIO | ||
741 | * @adev: device for this I/O | ||
742 | * @buf: data buffer | ||
743 | * @buflen: buffer length | ||
744 | * @write_data: read/write | ||
745 | * | ||
746 | * Note: Original code is ata_data_xfer(). | ||
747 | */ | ||
748 | |||
749 | static void scc_data_xfer (struct ata_device *adev, unsigned char *buf, | ||
750 | unsigned int buflen, int write_data) | ||
751 | { | ||
752 | struct ata_port *ap = adev->ap; | ||
753 | unsigned int words = buflen >> 1; | ||
754 | unsigned int i; | ||
755 | u16 *buf16 = (u16 *) buf; | ||
756 | void __iomem *mmio = ap->ioaddr.data_addr; | ||
757 | |||
758 | /* Transfer multiple of 2 bytes */ | ||
759 | if (write_data) { | ||
760 | for (i = 0; i < words; i++) | ||
761 | out_be32(mmio, cpu_to_le16(buf16[i])); | ||
762 | } else { | ||
763 | for (i = 0; i < words; i++) | ||
764 | buf16[i] = le16_to_cpu(in_be32(mmio)); | ||
765 | } | ||
766 | |||
767 | /* Transfer trailing 1 byte, if any. */ | ||
768 | if (unlikely(buflen & 0x01)) { | ||
769 | u16 align_buf[1] = { 0 }; | ||
770 | unsigned char *trailing_buf = buf + buflen - 1; | ||
771 | |||
772 | if (write_data) { | ||
773 | memcpy(align_buf, trailing_buf, 1); | ||
774 | out_be32(mmio, cpu_to_le16(align_buf[0])); | ||
775 | } else { | ||
776 | align_buf[0] = le16_to_cpu(in_be32(mmio)); | ||
777 | memcpy(trailing_buf, align_buf, 1); | ||
778 | } | ||
779 | } | ||
780 | } | ||
781 | |||
782 | /** | ||
783 | * scc_irq_on - Enable interrupts on a port. | ||
784 | * @ap: Port on which interrupts are enabled. | ||
785 | * | ||
786 | * Note: Original code is ata_irq_on(). | ||
787 | */ | ||
788 | |||
789 | static u8 scc_irq_on (struct ata_port *ap) | ||
790 | { | ||
791 | struct ata_ioports *ioaddr = &ap->ioaddr; | ||
792 | u8 tmp; | ||
793 | |||
794 | ap->ctl &= ~ATA_NIEN; | ||
795 | ap->last_ctl = ap->ctl; | ||
796 | |||
797 | out_be32(ioaddr->ctl_addr, ap->ctl); | ||
798 | tmp = ata_wait_idle(ap); | ||
799 | |||
800 | ap->ops->irq_clear(ap); | ||
801 | |||
802 | return tmp; | ||
803 | } | ||
804 | |||
805 | /** | ||
806 | * scc_irq_ack - Acknowledge a device interrupt. | ||
807 | * @ap: Port on which interrupts are enabled. | ||
808 | * | ||
809 | * Note: Original code is ata_irq_ack(). | ||
810 | */ | ||
811 | |||
812 | static u8 scc_irq_ack (struct ata_port *ap, unsigned int chk_drq) | ||
813 | { | ||
814 | unsigned int bits = chk_drq ? ATA_BUSY | ATA_DRQ : ATA_BUSY; | ||
815 | u8 host_stat, post_stat, status; | ||
816 | |||
817 | status = ata_busy_wait(ap, bits, 1000); | ||
818 | if (status & bits) | ||
819 | if (ata_msg_err(ap)) | ||
820 | printk(KERN_ERR "abnormal status 0x%X\n", status); | ||
821 | |||
822 | /* get controller status; clear intr, err bits */ | ||
823 | host_stat = in_be32(ap->ioaddr.bmdma_addr + SCC_DMA_STATUS); | ||
824 | out_be32(ap->ioaddr.bmdma_addr + SCC_DMA_STATUS, | ||
825 | host_stat | ATA_DMA_INTR | ATA_DMA_ERR); | ||
826 | |||
827 | post_stat = in_be32(ap->ioaddr.bmdma_addr + SCC_DMA_STATUS); | ||
828 | |||
829 | if (ata_msg_intr(ap)) | ||
830 | printk(KERN_INFO "%s: irq ack: host_stat 0x%X, new host_stat 0x%X, drv_stat 0x%X\n", | ||
831 | __FUNCTION__, | ||
832 | host_stat, post_stat, status); | ||
833 | |||
834 | return status; | ||
835 | } | ||
836 | |||
837 | /** | ||
838 | * scc_bmdma_freeze - Freeze BMDMA controller port | ||
839 | * @ap: port to freeze | ||
840 | * | ||
841 | * Note: Original code is ata_bmdma_freeze(). | ||
842 | */ | ||
843 | |||
844 | static void scc_bmdma_freeze (struct ata_port *ap) | ||
845 | { | ||
846 | struct ata_ioports *ioaddr = &ap->ioaddr; | ||
847 | |||
848 | ap->ctl |= ATA_NIEN; | ||
849 | ap->last_ctl = ap->ctl; | ||
850 | |||
851 | out_be32(ioaddr->ctl_addr, ap->ctl); | ||
852 | |||
853 | /* Under certain circumstances, some controllers raise IRQ on | ||
854 | * ATA_NIEN manipulation. Also, many controllers fail to mask | ||
855 | * previously pending IRQ on ATA_NIEN assertion. Clear it. | ||
856 | */ | ||
857 | ata_chk_status(ap); | ||
858 | |||
859 | ap->ops->irq_clear(ap); | ||
860 | } | ||
861 | |||
862 | /** | ||
863 | * scc_pata_prereset - prepare for reset | ||
864 | * @ap: ATA port to be reset | ||
865 | */ | ||
866 | |||
867 | static int scc_pata_prereset (struct ata_port *ap) | ||
868 | { | ||
869 | ap->cbl = ATA_CBL_PATA80; | ||
870 | return ata_std_prereset(ap); | ||
871 | } | ||
872 | |||
873 | /** | ||
874 | * scc_std_postreset - standard postreset callback | ||
875 | * @ap: the target ata_port | ||
876 | * @classes: classes of attached devices | ||
877 | * | ||
878 | * Note: Original code is ata_std_postreset(). | ||
879 | */ | ||
880 | |||
881 | static void scc_std_postreset (struct ata_port *ap, unsigned int *classes) | ||
882 | { | ||
883 | DPRINTK("ENTER\n"); | ||
884 | |||
885 | /* re-enable interrupts */ | ||
886 | if (!ap->ops->error_handler) | ||
887 | ap->ops->irq_on(ap); | ||
888 | |||
889 | /* is double-select really necessary? */ | ||
890 | if (classes[0] != ATA_DEV_NONE) | ||
891 | ap->ops->dev_select(ap, 1); | ||
892 | if (classes[1] != ATA_DEV_NONE) | ||
893 | ap->ops->dev_select(ap, 0); | ||
894 | |||
895 | /* bail out if no device is present */ | ||
896 | if (classes[0] == ATA_DEV_NONE && classes[1] == ATA_DEV_NONE) { | ||
897 | DPRINTK("EXIT, no device\n"); | ||
898 | return; | ||
899 | } | ||
900 | |||
901 | /* set up device control */ | ||
902 | if (ap->ioaddr.ctl_addr) | ||
903 | out_be32(ap->ioaddr.ctl_addr, ap->ctl); | ||
904 | |||
905 | DPRINTK("EXIT\n"); | ||
906 | } | ||
907 | |||
908 | /** | ||
909 | * scc_error_handler - Stock error handler for BMDMA controller | ||
910 | * @ap: port to handle error for | ||
911 | */ | ||
912 | |||
913 | static void scc_error_handler (struct ata_port *ap) | ||
914 | { | ||
915 | ata_bmdma_drive_eh(ap, scc_pata_prereset, scc_std_softreset, NULL, | ||
916 | scc_std_postreset); | ||
917 | } | ||
918 | |||
919 | /** | ||
920 | * scc_bmdma_irq_clear - Clear PCI IDE BMDMA interrupt. | ||
921 | * @ap: Port associated with this ATA transaction. | ||
922 | * | ||
923 | * Note: Original code is ata_bmdma_irq_clear(). | ||
924 | */ | ||
925 | |||
926 | static void scc_bmdma_irq_clear (struct ata_port *ap) | ||
927 | { | ||
928 | void __iomem *mmio = ap->ioaddr.bmdma_addr; | ||
929 | |||
930 | if (!mmio) | ||
931 | return; | ||
932 | |||
933 | out_be32(mmio + SCC_DMA_STATUS, in_be32(mmio + SCC_DMA_STATUS)); | ||
934 | } | ||
935 | |||
936 | /** | ||
937 | * scc_port_start - Set port up for dma. | ||
938 | * @ap: Port to initialize | ||
939 | * | ||
940 | * Allocate space for PRD table using ata_port_start(). | ||
941 | * Set PRD table address for PTERADD. (PRD Transfer End Read) | ||
942 | */ | ||
943 | |||
944 | static int scc_port_start (struct ata_port *ap) | ||
945 | { | ||
946 | void __iomem *mmio = ap->ioaddr.bmdma_addr; | ||
947 | int rc; | ||
948 | |||
949 | rc = ata_port_start(ap); | ||
950 | if (rc) | ||
951 | return rc; | ||
952 | |||
953 | out_be32(mmio + SCC_DMA_PTERADD, ap->prd_dma); | ||
954 | return 0; | ||
955 | } | ||
956 | |||
957 | /** | ||
958 | * scc_port_stop - Undo scc_port_start() | ||
959 | * @ap: Port to shut down | ||
960 | * | ||
961 | * Reset PTERADD. | ||
962 | */ | ||
963 | |||
964 | static void scc_port_stop (struct ata_port *ap) | ||
965 | { | ||
966 | void __iomem *mmio = ap->ioaddr.bmdma_addr; | ||
967 | |||
968 | out_be32(mmio + SCC_DMA_PTERADD, 0); | ||
969 | } | ||
970 | |||
971 | static struct scsi_host_template scc_sht = { | ||
972 | .module = THIS_MODULE, | ||
973 | .name = DRV_NAME, | ||
974 | .ioctl = ata_scsi_ioctl, | ||
975 | .queuecommand = ata_scsi_queuecmd, | ||
976 | .can_queue = ATA_DEF_QUEUE, | ||
977 | .this_id = ATA_SHT_THIS_ID, | ||
978 | .sg_tablesize = LIBATA_MAX_PRD, | ||
979 | .cmd_per_lun = ATA_SHT_CMD_PER_LUN, | ||
980 | .emulated = ATA_SHT_EMULATED, | ||
981 | .use_clustering = ATA_SHT_USE_CLUSTERING, | ||
982 | .proc_name = DRV_NAME, | ||
983 | .dma_boundary = ATA_DMA_BOUNDARY, | ||
984 | .slave_configure = ata_scsi_slave_config, | ||
985 | .slave_destroy = ata_scsi_slave_destroy, | ||
986 | .bios_param = ata_std_bios_param, | ||
987 | .resume = ata_scsi_device_resume, | ||
988 | .suspend = ata_scsi_device_suspend, | ||
989 | }; | ||
990 | |||
991 | static const struct ata_port_operations scc_pata_ops = { | ||
992 | .port_disable = ata_port_disable, | ||
993 | .set_piomode = scc_set_piomode, | ||
994 | .set_dmamode = scc_set_dmamode, | ||
995 | .mode_filter = ata_pci_default_filter, | ||
996 | |||
997 | .tf_load = scc_tf_load, | ||
998 | .tf_read = scc_tf_read, | ||
999 | .exec_command = scc_exec_command, | ||
1000 | .check_status = scc_check_status, | ||
1001 | .check_altstatus = scc_check_altstatus, | ||
1002 | .dev_select = scc_std_dev_select, | ||
1003 | |||
1004 | .bmdma_setup = scc_bmdma_setup, | ||
1005 | .bmdma_start = scc_bmdma_start, | ||
1006 | .bmdma_stop = scc_bmdma_stop, | ||
1007 | .bmdma_status = scc_bmdma_status, | ||
1008 | .data_xfer = scc_data_xfer, | ||
1009 | |||
1010 | .qc_prep = ata_qc_prep, | ||
1011 | .qc_issue = ata_qc_issue_prot, | ||
1012 | |||
1013 | .freeze = scc_bmdma_freeze, | ||
1014 | .error_handler = scc_error_handler, | ||
1015 | .post_internal_cmd = scc_bmdma_stop, | ||
1016 | |||
1017 | .irq_handler = ata_interrupt, | ||
1018 | .irq_clear = scc_bmdma_irq_clear, | ||
1019 | .irq_on = scc_irq_on, | ||
1020 | .irq_ack = scc_irq_ack, | ||
1021 | |||
1022 | .port_start = scc_port_start, | ||
1023 | .port_stop = scc_port_stop, | ||
1024 | }; | ||
1025 | |||
1026 | static struct ata_port_info scc_port_info[] = { | ||
1027 | { | ||
1028 | .sht = &scc_sht, | ||
1029 | .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_MMIO | ATA_FLAG_NO_LEGACY, | ||
1030 | .pio_mask = 0x1f, /* pio0-4 */ | ||
1031 | .mwdma_mask = 0x00, | ||
1032 | .udma_mask = ATA_UDMA6, | ||
1033 | .port_ops = &scc_pata_ops, | ||
1034 | }, | ||
1035 | }; | ||
1036 | |||
1037 | /** | ||
1038 | * scc_reset_controller - initialize SCC PATA controller. | ||
1039 | */ | ||
1040 | |||
1041 | static int scc_reset_controller(struct ata_probe_ent *probe_ent) | ||
1042 | { | ||
1043 | void __iomem *ctrl_base = probe_ent->iomap[SCC_CTRL_BAR]; | ||
1044 | void __iomem *bmid_base = probe_ent->iomap[SCC_BMID_BAR]; | ||
1045 | void __iomem *cckctrl_port = ctrl_base + SCC_CTL_CCKCTRL; | ||
1046 | void __iomem *mode_port = ctrl_base + SCC_CTL_MODEREG; | ||
1047 | void __iomem *ecmode_port = ctrl_base + SCC_CTL_ECMODE; | ||
1048 | void __iomem *intmask_port = bmid_base + SCC_DMA_INTMASK; | ||
1049 | void __iomem *dmastatus_port = bmid_base + SCC_DMA_STATUS; | ||
1050 | u32 reg = 0; | ||
1051 | |||
1052 | out_be32(cckctrl_port, reg); | ||
1053 | reg |= CCKCTRL_ATACLKOEN; | ||
1054 | out_be32(cckctrl_port, reg); | ||
1055 | reg |= CCKCTRL_LCLKEN | CCKCTRL_OCLKEN; | ||
1056 | out_be32(cckctrl_port, reg); | ||
1057 | reg |= CCKCTRL_CRST; | ||
1058 | out_be32(cckctrl_port, reg); | ||
1059 | |||
1060 | for (;;) { | ||
1061 | reg = in_be32(cckctrl_port); | ||
1062 | if (reg & CCKCTRL_CRST) | ||
1063 | break; | ||
1064 | udelay(5000); | ||
1065 | } | ||
1066 | |||
1067 | reg |= CCKCTRL_ATARESET; | ||
1068 | out_be32(cckctrl_port, reg); | ||
1069 | out_be32(ecmode_port, ECMODE_VALUE); | ||
1070 | out_be32(mode_port, MODE_JCUSFEN); | ||
1071 | out_be32(intmask_port, INTMASK_MSK); | ||
1072 | |||
1073 | if (in_be32(dmastatus_port) & QCHSD_STPDIAG) { | ||
1074 | printk(KERN_WARNING "%s: failed to detect 80c cable. (PDIAG# is high)\n", DRV_NAME); | ||
1075 | return -EIO; | ||
1076 | } | ||
1077 | |||
1078 | return 0; | ||
1079 | } | ||
1080 | |||
1081 | /** | ||
1082 | * scc_setup_ports - initialize ioaddr with SCC PATA port offsets. | ||
1083 | * @ioaddr: IO address structure to be initialized | ||
1084 | * @base: base address of BMID region | ||
1085 | */ | ||
1086 | |||
1087 | static void scc_setup_ports (struct ata_ioports *ioaddr, void __iomem *base) | ||
1088 | { | ||
1089 | ioaddr->cmd_addr = base + SCC_REG_CMD_ADDR; | ||
1090 | ioaddr->altstatus_addr = ioaddr->cmd_addr + SCC_REG_ALTSTATUS; | ||
1091 | ioaddr->ctl_addr = ioaddr->cmd_addr + SCC_REG_ALTSTATUS; | ||
1092 | ioaddr->bmdma_addr = base; | ||
1093 | ioaddr->data_addr = ioaddr->cmd_addr + SCC_REG_DATA; | ||
1094 | ioaddr->error_addr = ioaddr->cmd_addr + SCC_REG_ERR; | ||
1095 | ioaddr->feature_addr = ioaddr->cmd_addr + SCC_REG_FEATURE; | ||
1096 | ioaddr->nsect_addr = ioaddr->cmd_addr + SCC_REG_NSECT; | ||
1097 | ioaddr->lbal_addr = ioaddr->cmd_addr + SCC_REG_LBAL; | ||
1098 | ioaddr->lbam_addr = ioaddr->cmd_addr + SCC_REG_LBAM; | ||
1099 | ioaddr->lbah_addr = ioaddr->cmd_addr + SCC_REG_LBAH; | ||
1100 | ioaddr->device_addr = ioaddr->cmd_addr + SCC_REG_DEVICE; | ||
1101 | ioaddr->status_addr = ioaddr->cmd_addr + SCC_REG_STATUS; | ||
1102 | ioaddr->command_addr = ioaddr->cmd_addr + SCC_REG_CMD; | ||
1103 | } | ||
1104 | |||
1105 | static int scc_host_init(struct ata_probe_ent *probe_ent) | ||
1106 | { | ||
1107 | struct pci_dev *pdev = to_pci_dev(probe_ent->dev); | ||
1108 | int rc; | ||
1109 | |||
1110 | rc = scc_reset_controller(probe_ent); | ||
1111 | if (rc) | ||
1112 | return rc; | ||
1113 | |||
1114 | probe_ent->n_ports = 1; | ||
1115 | |||
1116 | rc = pci_set_dma_mask(pdev, ATA_DMA_MASK); | ||
1117 | if (rc) | ||
1118 | return rc; | ||
1119 | rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK); | ||
1120 | if (rc) | ||
1121 | return rc; | ||
1122 | |||
1123 | scc_setup_ports(&probe_ent->port[0], probe_ent->iomap[SCC_BMID_BAR]); | ||
1124 | |||
1125 | pci_set_master(pdev); | ||
1126 | |||
1127 | return 0; | ||
1128 | } | ||
1129 | |||
1130 | /** | ||
1131 | * scc_init_one - Register SCC PATA device with kernel services | ||
1132 | * @pdev: PCI device to register | ||
1133 | * @ent: Entry in scc_pci_tbl matching with @pdev | ||
1134 | * | ||
1135 | * LOCKING: | ||
1136 | * Inherited from PCI layer (may sleep). | ||
1137 | * | ||
1138 | * RETURNS: | ||
1139 | * Zero on success, or -ERRNO value. | ||
1140 | */ | ||
1141 | |||
1142 | static int scc_init_one (struct pci_dev *pdev, const struct pci_device_id *ent) | ||
1143 | { | ||
1144 | static int printed_version; | ||
1145 | unsigned int board_idx = (unsigned int) ent->driver_data; | ||
1146 | struct device *dev = &pdev->dev; | ||
1147 | struct ata_probe_ent *probe_ent; | ||
1148 | int rc; | ||
1149 | |||
1150 | if (!printed_version++) | ||
1151 | dev_printk(KERN_DEBUG, &pdev->dev, | ||
1152 | "version " DRV_VERSION "\n"); | ||
1153 | |||
1154 | rc = pcim_enable_device(pdev); | ||
1155 | if (rc) | ||
1156 | return rc; | ||
1157 | |||
1158 | rc = pcim_iomap_regions(pdev, (1 << SCC_CTRL_BAR) | (1 << SCC_BMID_BAR), DRV_NAME); | ||
1159 | if (rc == -EBUSY) | ||
1160 | pcim_pin_device(pdev); | ||
1161 | if (rc) | ||
1162 | return rc; | ||
1163 | |||
1164 | probe_ent = devm_kzalloc(dev, sizeof(*probe_ent), GFP_KERNEL); | ||
1165 | if (!probe_ent) | ||
1166 | return -ENOMEM; | ||
1167 | |||
1168 | probe_ent->dev = dev; | ||
1169 | INIT_LIST_HEAD(&probe_ent->node); | ||
1170 | |||
1171 | probe_ent->sht = scc_port_info[board_idx].sht; | ||
1172 | probe_ent->port_flags = scc_port_info[board_idx].flags; | ||
1173 | probe_ent->pio_mask = scc_port_info[board_idx].pio_mask; | ||
1174 | probe_ent->udma_mask = scc_port_info[board_idx].udma_mask; | ||
1175 | probe_ent->port_ops = scc_port_info[board_idx].port_ops; | ||
1176 | |||
1177 | probe_ent->irq = pdev->irq; | ||
1178 | probe_ent->irq_flags = IRQF_SHARED; | ||
1179 | probe_ent->iomap = pcim_iomap_table(pdev); | ||
1180 | |||
1181 | rc = scc_host_init(probe_ent); | ||
1182 | if (rc) | ||
1183 | return rc; | ||
1184 | |||
1185 | if (!ata_device_add(probe_ent)) | ||
1186 | return -ENODEV; | ||
1187 | |||
1188 | devm_kfree(dev, probe_ent); | ||
1189 | return 0; | ||
1190 | } | ||
1191 | |||
1192 | static struct pci_driver scc_pci_driver = { | ||
1193 | .name = DRV_NAME, | ||
1194 | .id_table = scc_pci_tbl, | ||
1195 | .probe = scc_init_one, | ||
1196 | .remove = ata_pci_remove_one, | ||
1197 | #ifdef CONFIG_PM | ||
1198 | .suspend = ata_pci_device_suspend, | ||
1199 | .resume = ata_pci_device_resume, | ||
1200 | #endif | ||
1201 | }; | ||
1202 | |||
1203 | static int __init scc_init (void) | ||
1204 | { | ||
1205 | int rc; | ||
1206 | |||
1207 | DPRINTK("pci_register_driver\n"); | ||
1208 | rc = pci_register_driver(&scc_pci_driver); | ||
1209 | if (rc) | ||
1210 | return rc; | ||
1211 | |||
1212 | DPRINTK("done\n"); | ||
1213 | return 0; | ||
1214 | } | ||
1215 | |||
1216 | static void __exit scc_exit (void) | ||
1217 | { | ||
1218 | pci_unregister_driver(&scc_pci_driver); | ||
1219 | } | ||
1220 | |||
1221 | module_init(scc_init); | ||
1222 | module_exit(scc_exit); | ||
1223 | |||
1224 | MODULE_AUTHOR("Toshiba corp"); | ||
1225 | MODULE_DESCRIPTION("SCSI low-level driver for Toshiba SCC PATA controller"); | ||
1226 | MODULE_LICENSE("GPL"); | ||
1227 | MODULE_DEVICE_TABLE(pci, scc_pci_tbl); | ||
1228 | MODULE_VERSION(DRV_VERSION); | ||
diff --git a/include/linux/libata.h b/include/linux/libata.h index 86762a9f52ba..60dfc5f7e882 100644 --- a/include/linux/libata.h +++ b/include/linux/libata.h | |||
@@ -759,6 +759,7 @@ extern void ata_port_queue_task(struct ata_port *ap, work_func_t fn, | |||
759 | extern u32 ata_wait_register(void __iomem *reg, u32 mask, u32 val, | 759 | extern u32 ata_wait_register(void __iomem *reg, u32 mask, u32 val, |
760 | unsigned long interval_msec, | 760 | unsigned long interval_msec, |
761 | unsigned long timeout_msec); | 761 | unsigned long timeout_msec); |
762 | extern unsigned int ata_dev_try_classify(struct ata_port *, unsigned int, u8 *); | ||
762 | 763 | ||
763 | /* | 764 | /* |
764 | * Default driver ops implementations | 765 | * Default driver ops implementations |