xref: /openbmc/linux/drivers/ata/sata_mv.c (revision ee9ccdf70163ca6408f6965e0fbc65baeac7312c)
1c6fd2807SJeff Garzik /*
2c6fd2807SJeff Garzik  * sata_mv.c - Marvell SATA support
3c6fd2807SJeff Garzik  *
4c6fd2807SJeff Garzik  * Copyright 2005: EMC Corporation, all rights reserved.
5c6fd2807SJeff Garzik  * Copyright 2005 Red Hat, Inc.  All rights reserved.
6c6fd2807SJeff Garzik  *
7c6fd2807SJeff Garzik  * Please ALWAYS copy linux-ide@vger.kernel.org on emails.
8c6fd2807SJeff Garzik  *
9c6fd2807SJeff Garzik  * This program is free software; you can redistribute it and/or modify
10c6fd2807SJeff Garzik  * it under the terms of the GNU General Public License as published by
11c6fd2807SJeff Garzik  * the Free Software Foundation; version 2 of the License.
12c6fd2807SJeff Garzik  *
13c6fd2807SJeff Garzik  * This program is distributed in the hope that it will be useful,
14c6fd2807SJeff Garzik  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15c6fd2807SJeff Garzik  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16c6fd2807SJeff Garzik  * GNU General Public License for more details.
17c6fd2807SJeff Garzik  *
18c6fd2807SJeff Garzik  * You should have received a copy of the GNU General Public License
19c6fd2807SJeff Garzik  * along with this program; if not, write to the Free Software
20c6fd2807SJeff Garzik  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
21c6fd2807SJeff Garzik  *
22c6fd2807SJeff Garzik  */
23c6fd2807SJeff Garzik 
244a05e209SJeff Garzik /*
254a05e209SJeff Garzik   sata_mv TODO list:
264a05e209SJeff Garzik 
274a05e209SJeff Garzik   1) Needs a full errata audit for all chipsets.  I implemented most
284a05e209SJeff Garzik   of the errata workarounds found in the Marvell vendor driver, but
294a05e209SJeff Garzik   I distinctly remember a couple workarounds (one related to PCI-X)
304a05e209SJeff Garzik   are still needed.
314a05e209SJeff Garzik 
324a05e209SJeff Garzik   4) Add NCQ support (easy to intermediate, once new-EH support appears)
334a05e209SJeff Garzik 
344a05e209SJeff Garzik   5) Investigate problems with PCI Message Signalled Interrupts (MSI).
354a05e209SJeff Garzik 
364a05e209SJeff Garzik   6) Add port multiplier support (intermediate)
374a05e209SJeff Garzik 
384a05e209SJeff Garzik   7) Test and verify 3.0 Gbps support
394a05e209SJeff Garzik 
404a05e209SJeff Garzik   8) Develop a low-power-consumption strategy, and implement it.
414a05e209SJeff Garzik 
424a05e209SJeff Garzik   9) [Experiment, low priority] See if ATAPI can be supported using
434a05e209SJeff Garzik   "unknown FIS" or "vendor-specific FIS" support, or something creative
444a05e209SJeff Garzik   like that.
454a05e209SJeff Garzik 
464a05e209SJeff Garzik   10) [Experiment, low priority] Investigate interrupt coalescing.
474a05e209SJeff Garzik   Quite often, especially with PCI Message Signalled Interrupts (MSI),
484a05e209SJeff Garzik   the overhead reduced by interrupt mitigation is quite often not
494a05e209SJeff Garzik   worth the latency cost.
504a05e209SJeff Garzik 
514a05e209SJeff Garzik   11) [Experiment, Marvell value added] Is it possible to use target
524a05e209SJeff Garzik   mode to cross-connect two Linux boxes with Marvell cards?  If so,
534a05e209SJeff Garzik   creating LibATA target mode support would be very interesting.
544a05e209SJeff Garzik 
554a05e209SJeff Garzik   Target mode, for those without docs, is the ability to directly
564a05e209SJeff Garzik   connect two SATA controllers.
574a05e209SJeff Garzik 
584a05e209SJeff Garzik   13) Verify that 7042 is fully supported.  I only have a 6042.
594a05e209SJeff Garzik 
604a05e209SJeff Garzik */
614a05e209SJeff Garzik 
624a05e209SJeff Garzik 
63c6fd2807SJeff Garzik #include <linux/kernel.h>
64c6fd2807SJeff Garzik #include <linux/module.h>
65c6fd2807SJeff Garzik #include <linux/pci.h>
66c6fd2807SJeff Garzik #include <linux/init.h>
67c6fd2807SJeff Garzik #include <linux/blkdev.h>
68c6fd2807SJeff Garzik #include <linux/delay.h>
69c6fd2807SJeff Garzik #include <linux/interrupt.h>
70c6fd2807SJeff Garzik #include <linux/dma-mapping.h>
71c6fd2807SJeff Garzik #include <linux/device.h>
72c6fd2807SJeff Garzik #include <scsi/scsi_host.h>
73c6fd2807SJeff Garzik #include <scsi/scsi_cmnd.h>
74c6fd2807SJeff Garzik #include <linux/libata.h>
75c6fd2807SJeff Garzik 
76c6fd2807SJeff Garzik #define DRV_NAME	"sata_mv"
778bc3fc47SJeff Garzik #define DRV_VERSION	"0.81"
78c6fd2807SJeff Garzik 
79c6fd2807SJeff Garzik enum {
80c6fd2807SJeff Garzik 	/* BAR's are enumerated in terms of pci_resource_start() terms */
81c6fd2807SJeff Garzik 	MV_PRIMARY_BAR		= 0,	/* offset 0x10: memory space */
82c6fd2807SJeff Garzik 	MV_IO_BAR		= 2,	/* offset 0x18: IO space */
83c6fd2807SJeff Garzik 	MV_MISC_BAR		= 3,	/* offset 0x1c: FLASH, NVRAM, SRAM */
84c6fd2807SJeff Garzik 
85c6fd2807SJeff Garzik 	MV_MAJOR_REG_AREA_SZ	= 0x10000,	/* 64KB */
86c6fd2807SJeff Garzik 	MV_MINOR_REG_AREA_SZ	= 0x2000,	/* 8KB */
87c6fd2807SJeff Garzik 
88c6fd2807SJeff Garzik 	MV_PCI_REG_BASE		= 0,
89c6fd2807SJeff Garzik 	MV_IRQ_COAL_REG_BASE	= 0x18000,	/* 6xxx part only */
90c6fd2807SJeff Garzik 	MV_IRQ_COAL_CAUSE		= (MV_IRQ_COAL_REG_BASE + 0x08),
91c6fd2807SJeff Garzik 	MV_IRQ_COAL_CAUSE_LO		= (MV_IRQ_COAL_REG_BASE + 0x88),
92c6fd2807SJeff Garzik 	MV_IRQ_COAL_CAUSE_HI		= (MV_IRQ_COAL_REG_BASE + 0x8c),
93c6fd2807SJeff Garzik 	MV_IRQ_COAL_THRESHOLD		= (MV_IRQ_COAL_REG_BASE + 0xcc),
94c6fd2807SJeff Garzik 	MV_IRQ_COAL_TIME_THRESHOLD	= (MV_IRQ_COAL_REG_BASE + 0xd0),
95c6fd2807SJeff Garzik 
96c6fd2807SJeff Garzik 	MV_SATAHC0_REG_BASE	= 0x20000,
97c6fd2807SJeff Garzik 	MV_FLASH_CTL		= 0x1046c,
98c6fd2807SJeff Garzik 	MV_GPIO_PORT_CTL	= 0x104f0,
99c6fd2807SJeff Garzik 	MV_RESET_CFG		= 0x180d8,
100c6fd2807SJeff Garzik 
101c6fd2807SJeff Garzik 	MV_PCI_REG_SZ		= MV_MAJOR_REG_AREA_SZ,
102c6fd2807SJeff Garzik 	MV_SATAHC_REG_SZ	= MV_MAJOR_REG_AREA_SZ,
103c6fd2807SJeff Garzik 	MV_SATAHC_ARBTR_REG_SZ	= MV_MINOR_REG_AREA_SZ,		/* arbiter */
104c6fd2807SJeff Garzik 	MV_PORT_REG_SZ		= MV_MINOR_REG_AREA_SZ,
105c6fd2807SJeff Garzik 
106c6fd2807SJeff Garzik 	MV_MAX_Q_DEPTH		= 32,
107c6fd2807SJeff Garzik 	MV_MAX_Q_DEPTH_MASK	= MV_MAX_Q_DEPTH - 1,
108c6fd2807SJeff Garzik 
109c6fd2807SJeff Garzik 	/* CRQB needs alignment on a 1KB boundary. Size == 1KB
110c6fd2807SJeff Garzik 	 * CRPB needs alignment on a 256B boundary. Size == 256B
111c6fd2807SJeff Garzik 	 * SG count of 176 leads to MV_PORT_PRIV_DMA_SZ == 4KB
112c6fd2807SJeff Garzik 	 * ePRD (SG) entries need alignment on a 16B boundary. Size == 16B
113c6fd2807SJeff Garzik 	 */
114c6fd2807SJeff Garzik 	MV_CRQB_Q_SZ		= (32 * MV_MAX_Q_DEPTH),
115c6fd2807SJeff Garzik 	MV_CRPB_Q_SZ		= (8 * MV_MAX_Q_DEPTH),
116c6fd2807SJeff Garzik 	MV_MAX_SG_CT		= 176,
117c6fd2807SJeff Garzik 	MV_SG_TBL_SZ		= (16 * MV_MAX_SG_CT),
118c6fd2807SJeff Garzik 	MV_PORT_PRIV_DMA_SZ	= (MV_CRQB_Q_SZ + MV_CRPB_Q_SZ + MV_SG_TBL_SZ),
119c6fd2807SJeff Garzik 
120c6fd2807SJeff Garzik 	MV_PORTS_PER_HC		= 4,
121c6fd2807SJeff Garzik 	/* == (port / MV_PORTS_PER_HC) to determine HC from 0-7 port */
122c6fd2807SJeff Garzik 	MV_PORT_HC_SHIFT	= 2,
123c6fd2807SJeff Garzik 	/* == (port % MV_PORTS_PER_HC) to determine hard port from 0-7 port */
124c6fd2807SJeff Garzik 	MV_PORT_MASK		= 3,
125c6fd2807SJeff Garzik 
126c6fd2807SJeff Garzik 	/* Host Flags */
127c6fd2807SJeff Garzik 	MV_FLAG_DUAL_HC		= (1 << 30),  /* two SATA Host Controllers */
128c6fd2807SJeff Garzik 	MV_FLAG_IRQ_COALESCE	= (1 << 29),  /* IRQ coalescing capability */
129c5d3e45aSJeff Garzik 	MV_COMMON_FLAGS		= ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY |
130bdd4dddeSJeff Garzik 				  ATA_FLAG_MMIO | ATA_FLAG_NO_ATAPI |
131bdd4dddeSJeff Garzik 				  ATA_FLAG_PIO_POLLING,
132c6fd2807SJeff Garzik 	MV_6XXX_FLAGS		= MV_FLAG_IRQ_COALESCE,
133c6fd2807SJeff Garzik 
134c6fd2807SJeff Garzik 	CRQB_FLAG_READ		= (1 << 0),
135c6fd2807SJeff Garzik 	CRQB_TAG_SHIFT		= 1,
136c5d3e45aSJeff Garzik 	CRQB_IOID_SHIFT		= 6,	/* CRQB Gen-II/IIE IO Id shift */
137c5d3e45aSJeff Garzik 	CRQB_HOSTQ_SHIFT	= 17,	/* CRQB Gen-II/IIE HostQueTag shift */
138c6fd2807SJeff Garzik 	CRQB_CMD_ADDR_SHIFT	= 8,
139c6fd2807SJeff Garzik 	CRQB_CMD_CS		= (0x2 << 11),
140c6fd2807SJeff Garzik 	CRQB_CMD_LAST		= (1 << 15),
141c6fd2807SJeff Garzik 
142c6fd2807SJeff Garzik 	CRPB_FLAG_STATUS_SHIFT	= 8,
143c5d3e45aSJeff Garzik 	CRPB_IOID_SHIFT_6	= 5,	/* CRPB Gen-II IO Id shift */
144c5d3e45aSJeff Garzik 	CRPB_IOID_SHIFT_7	= 7,	/* CRPB Gen-IIE IO Id shift */
145c6fd2807SJeff Garzik 
146c6fd2807SJeff Garzik 	EPRD_FLAG_END_OF_TBL	= (1 << 31),
147c6fd2807SJeff Garzik 
148c6fd2807SJeff Garzik 	/* PCI interface registers */
149c6fd2807SJeff Garzik 
150c6fd2807SJeff Garzik 	PCI_COMMAND_OFS		= 0xc00,
151c6fd2807SJeff Garzik 
152c6fd2807SJeff Garzik 	PCI_MAIN_CMD_STS_OFS	= 0xd30,
153c6fd2807SJeff Garzik 	STOP_PCI_MASTER		= (1 << 2),
154c6fd2807SJeff Garzik 	PCI_MASTER_EMPTY	= (1 << 3),
155c6fd2807SJeff Garzik 	GLOB_SFT_RST		= (1 << 4),
156c6fd2807SJeff Garzik 
157c6fd2807SJeff Garzik 	MV_PCI_MODE		= 0xd00,
158c6fd2807SJeff Garzik 	MV_PCI_EXP_ROM_BAR_CTL	= 0xd2c,
159c6fd2807SJeff Garzik 	MV_PCI_DISC_TIMER	= 0xd04,
160c6fd2807SJeff Garzik 	MV_PCI_MSI_TRIGGER	= 0xc38,
161c6fd2807SJeff Garzik 	MV_PCI_SERR_MASK	= 0xc28,
162c6fd2807SJeff Garzik 	MV_PCI_XBAR_TMOUT	= 0x1d04,
163c6fd2807SJeff Garzik 	MV_PCI_ERR_LOW_ADDRESS	= 0x1d40,
164c6fd2807SJeff Garzik 	MV_PCI_ERR_HIGH_ADDRESS	= 0x1d44,
165c6fd2807SJeff Garzik 	MV_PCI_ERR_ATTRIBUTE	= 0x1d48,
166c6fd2807SJeff Garzik 	MV_PCI_ERR_COMMAND	= 0x1d50,
167c6fd2807SJeff Garzik 
168c6fd2807SJeff Garzik 	PCI_IRQ_CAUSE_OFS		= 0x1d58,
169c6fd2807SJeff Garzik 	PCI_IRQ_MASK_OFS		= 0x1d5c,
170c6fd2807SJeff Garzik 	PCI_UNMASK_ALL_IRQS	= 0x7fffff,	/* bits 22-0 */
171c6fd2807SJeff Garzik 
172c6fd2807SJeff Garzik 	HC_MAIN_IRQ_CAUSE_OFS	= 0x1d60,
173c6fd2807SJeff Garzik 	HC_MAIN_IRQ_MASK_OFS	= 0x1d64,
174c6fd2807SJeff Garzik 	PORT0_ERR		= (1 << 0),	/* shift by port # */
175c6fd2807SJeff Garzik 	PORT0_DONE		= (1 << 1),	/* shift by port # */
176c6fd2807SJeff Garzik 	HC0_IRQ_PEND		= 0x1ff,	/* bits 0-8 = HC0's ports */
177c6fd2807SJeff Garzik 	HC_SHIFT		= 9,		/* bits 9-17 = HC1's ports */
178c6fd2807SJeff Garzik 	PCI_ERR			= (1 << 18),
179c6fd2807SJeff Garzik 	TRAN_LO_DONE		= (1 << 19),	/* 6xxx: IRQ coalescing */
180c6fd2807SJeff Garzik 	TRAN_HI_DONE		= (1 << 20),	/* 6xxx: IRQ coalescing */
181fb621e2fSJeff Garzik 	PORTS_0_3_COAL_DONE	= (1 << 8),
182fb621e2fSJeff Garzik 	PORTS_4_7_COAL_DONE	= (1 << 17),
183c6fd2807SJeff Garzik 	PORTS_0_7_COAL_DONE	= (1 << 21),	/* 6xxx: IRQ coalescing */
184c6fd2807SJeff Garzik 	GPIO_INT		= (1 << 22),
185c6fd2807SJeff Garzik 	SELF_INT		= (1 << 23),
186c6fd2807SJeff Garzik 	TWSI_INT		= (1 << 24),
187c6fd2807SJeff Garzik 	HC_MAIN_RSVD		= (0x7f << 25),	/* bits 31-25 */
188fb621e2fSJeff Garzik 	HC_MAIN_RSVD_5		= (0x1fff << 19), /* bits 31-19 */
189c6fd2807SJeff Garzik 	HC_MAIN_MASKED_IRQS	= (TRAN_LO_DONE | TRAN_HI_DONE |
190c6fd2807SJeff Garzik 				   PORTS_0_7_COAL_DONE | GPIO_INT | TWSI_INT |
191c6fd2807SJeff Garzik 				   HC_MAIN_RSVD),
192fb621e2fSJeff Garzik 	HC_MAIN_MASKED_IRQS_5	= (PORTS_0_3_COAL_DONE | PORTS_4_7_COAL_DONE |
193fb621e2fSJeff Garzik 				   HC_MAIN_RSVD_5),
194c6fd2807SJeff Garzik 
195c6fd2807SJeff Garzik 	/* SATAHC registers */
196c6fd2807SJeff Garzik 	HC_CFG_OFS		= 0,
197c6fd2807SJeff Garzik 
198c6fd2807SJeff Garzik 	HC_IRQ_CAUSE_OFS	= 0x14,
199c6fd2807SJeff Garzik 	CRPB_DMA_DONE		= (1 << 0),	/* shift by port # */
200c6fd2807SJeff Garzik 	HC_IRQ_COAL		= (1 << 4),	/* IRQ coalescing */
201c6fd2807SJeff Garzik 	DEV_IRQ			= (1 << 8),	/* shift by port # */
202c6fd2807SJeff Garzik 
203c6fd2807SJeff Garzik 	/* Shadow block registers */
204c6fd2807SJeff Garzik 	SHD_BLK_OFS		= 0x100,
205c6fd2807SJeff Garzik 	SHD_CTL_AST_OFS		= 0x20,		/* ofs from SHD_BLK_OFS */
206c6fd2807SJeff Garzik 
207c6fd2807SJeff Garzik 	/* SATA registers */
208c6fd2807SJeff Garzik 	SATA_STATUS_OFS		= 0x300,  /* ctrl, err regs follow status */
209c6fd2807SJeff Garzik 	SATA_ACTIVE_OFS		= 0x350,
210c6fd2807SJeff Garzik 	PHY_MODE3		= 0x310,
211c6fd2807SJeff Garzik 	PHY_MODE4		= 0x314,
212c6fd2807SJeff Garzik 	PHY_MODE2		= 0x330,
213c6fd2807SJeff Garzik 	MV5_PHY_MODE		= 0x74,
214c6fd2807SJeff Garzik 	MV5_LT_MODE		= 0x30,
215c6fd2807SJeff Garzik 	MV5_PHY_CTL		= 0x0C,
216c6fd2807SJeff Garzik 	SATA_INTERFACE_CTL	= 0x050,
217c6fd2807SJeff Garzik 
218c6fd2807SJeff Garzik 	MV_M2_PREAMP_MASK	= 0x7e0,
219c6fd2807SJeff Garzik 
220c6fd2807SJeff Garzik 	/* Port registers */
221c6fd2807SJeff Garzik 	EDMA_CFG_OFS		= 0,
222c6fd2807SJeff Garzik 	EDMA_CFG_Q_DEPTH	= 0,			/* queueing disabled */
223c6fd2807SJeff Garzik 	EDMA_CFG_NCQ		= (1 << 5),
224c6fd2807SJeff Garzik 	EDMA_CFG_NCQ_GO_ON_ERR	= (1 << 14),		/* continue on error */
225c6fd2807SJeff Garzik 	EDMA_CFG_RD_BRST_EXT	= (1 << 11),		/* read burst 512B */
226c6fd2807SJeff Garzik 	EDMA_CFG_WR_BUFF_LEN	= (1 << 13),		/* write buffer 512B */
227c6fd2807SJeff Garzik 
228c6fd2807SJeff Garzik 	EDMA_ERR_IRQ_CAUSE_OFS	= 0x8,
229c6fd2807SJeff Garzik 	EDMA_ERR_IRQ_MASK_OFS	= 0xc,
230c6fd2807SJeff Garzik 	EDMA_ERR_D_PAR		= (1 << 0),
231c6fd2807SJeff Garzik 	EDMA_ERR_PRD_PAR	= (1 << 1),
232c6fd2807SJeff Garzik 	EDMA_ERR_DEV		= (1 << 2),
233c6fd2807SJeff Garzik 	EDMA_ERR_DEV_DCON	= (1 << 3),
234c6fd2807SJeff Garzik 	EDMA_ERR_DEV_CON	= (1 << 4),
235c6fd2807SJeff Garzik 	EDMA_ERR_SERR		= (1 << 5),
236c5d3e45aSJeff Garzik 	EDMA_ERR_SELF_DIS	= (1 << 7),	/* Gen II/IIE self-disable */
237c5d3e45aSJeff Garzik 	EDMA_ERR_SELF_DIS_5	= (1 << 8),	/* Gen I self-disable */
238c6fd2807SJeff Garzik 	EDMA_ERR_BIST_ASYNC	= (1 << 8),
239c5d3e45aSJeff Garzik 	EDMA_ERR_TRANS_IRQ_7	= (1 << 8),	/* Gen IIE transprt layer irq */
240c6fd2807SJeff Garzik 	EDMA_ERR_CRBQ_PAR	= (1 << 9),
241c6fd2807SJeff Garzik 	EDMA_ERR_CRPB_PAR	= (1 << 10),
242c6fd2807SJeff Garzik 	EDMA_ERR_INTRL_PAR	= (1 << 11),
243c6fd2807SJeff Garzik 	EDMA_ERR_IORDY		= (1 << 12),
244c6fd2807SJeff Garzik 	EDMA_ERR_LNK_CTRL_RX	= (0xf << 13),
245c6fd2807SJeff Garzik 	EDMA_ERR_LNK_CTRL_RX_2	= (1 << 15),
246c6fd2807SJeff Garzik 	EDMA_ERR_LNK_DATA_RX	= (0xf << 17),
247c6fd2807SJeff Garzik 	EDMA_ERR_LNK_CTRL_TX	= (0x1f << 21),
248c6fd2807SJeff Garzik 	EDMA_ERR_LNK_DATA_TX	= (0x1f << 26),
249c6fd2807SJeff Garzik 	EDMA_ERR_TRANS_PROTO	= (1 << 31),
250c5d3e45aSJeff Garzik 	EDMA_ERR_OVERRUN_5	= (1 << 5),
251c5d3e45aSJeff Garzik 	EDMA_ERR_UNDERRUN_5	= (1 << 6),
252bdd4dddeSJeff Garzik 	EDMA_EH_FREEZE		= EDMA_ERR_D_PAR |
253bdd4dddeSJeff Garzik 				  EDMA_ERR_PRD_PAR |
254bdd4dddeSJeff Garzik 				  EDMA_ERR_DEV_DCON |
255bdd4dddeSJeff Garzik 				  EDMA_ERR_DEV_CON |
256bdd4dddeSJeff Garzik 				  EDMA_ERR_SERR |
257bdd4dddeSJeff Garzik 				  EDMA_ERR_SELF_DIS |
258bdd4dddeSJeff Garzik 				  EDMA_ERR_CRBQ_PAR |
259bdd4dddeSJeff Garzik 				  EDMA_ERR_CRPB_PAR |
260bdd4dddeSJeff Garzik 				  EDMA_ERR_INTRL_PAR |
261bdd4dddeSJeff Garzik 				  EDMA_ERR_IORDY |
262bdd4dddeSJeff Garzik 				  EDMA_ERR_LNK_CTRL_RX_2 |
263c6fd2807SJeff Garzik 				  EDMA_ERR_LNK_DATA_RX |
264c6fd2807SJeff Garzik 				  EDMA_ERR_LNK_DATA_TX |
265bdd4dddeSJeff Garzik 				  EDMA_ERR_TRANS_PROTO,
266bdd4dddeSJeff Garzik 	EDMA_EH_FREEZE_5	= EDMA_ERR_D_PAR |
267bdd4dddeSJeff Garzik 				  EDMA_ERR_PRD_PAR |
268bdd4dddeSJeff Garzik 				  EDMA_ERR_DEV_DCON |
269bdd4dddeSJeff Garzik 				  EDMA_ERR_DEV_CON |
270bdd4dddeSJeff Garzik 				  EDMA_ERR_OVERRUN_5 |
271bdd4dddeSJeff Garzik 				  EDMA_ERR_UNDERRUN_5 |
272bdd4dddeSJeff Garzik 				  EDMA_ERR_SELF_DIS_5 |
273bdd4dddeSJeff Garzik 				  EDMA_ERR_CRBQ_PAR |
274bdd4dddeSJeff Garzik 				  EDMA_ERR_CRPB_PAR |
275bdd4dddeSJeff Garzik 				  EDMA_ERR_INTRL_PAR |
276bdd4dddeSJeff Garzik 				  EDMA_ERR_IORDY,
277c6fd2807SJeff Garzik 
278c6fd2807SJeff Garzik 	EDMA_REQ_Q_BASE_HI_OFS	= 0x10,
279c6fd2807SJeff Garzik 	EDMA_REQ_Q_IN_PTR_OFS	= 0x14,		/* also contains BASE_LO */
280c6fd2807SJeff Garzik 
281c6fd2807SJeff Garzik 	EDMA_REQ_Q_OUT_PTR_OFS	= 0x18,
282c6fd2807SJeff Garzik 	EDMA_REQ_Q_PTR_SHIFT	= 5,
283c6fd2807SJeff Garzik 
284c6fd2807SJeff Garzik 	EDMA_RSP_Q_BASE_HI_OFS	= 0x1c,
285c6fd2807SJeff Garzik 	EDMA_RSP_Q_IN_PTR_OFS	= 0x20,
286c6fd2807SJeff Garzik 	EDMA_RSP_Q_OUT_PTR_OFS	= 0x24,		/* also contains BASE_LO */
287c6fd2807SJeff Garzik 	EDMA_RSP_Q_PTR_SHIFT	= 3,
288c6fd2807SJeff Garzik 
289c6fd2807SJeff Garzik 	EDMA_CMD_OFS		= 0x28,
290c6fd2807SJeff Garzik 	EDMA_EN			= (1 << 0),
291c6fd2807SJeff Garzik 	EDMA_DS			= (1 << 1),
292c6fd2807SJeff Garzik 	ATA_RST			= (1 << 2),
293c6fd2807SJeff Garzik 
294c6fd2807SJeff Garzik 	EDMA_IORDY_TMOUT	= 0x34,
295c6fd2807SJeff Garzik 	EDMA_ARB_CFG		= 0x38,
296c6fd2807SJeff Garzik 
297c6fd2807SJeff Garzik 	/* Host private flags (hp_flags) */
298c6fd2807SJeff Garzik 	MV_HP_FLAG_MSI		= (1 << 0),
299c6fd2807SJeff Garzik 	MV_HP_ERRATA_50XXB0	= (1 << 1),
300c6fd2807SJeff Garzik 	MV_HP_ERRATA_50XXB2	= (1 << 2),
301c6fd2807SJeff Garzik 	MV_HP_ERRATA_60X1B2	= (1 << 3),
302c6fd2807SJeff Garzik 	MV_HP_ERRATA_60X1C0	= (1 << 4),
303c6fd2807SJeff Garzik 	MV_HP_ERRATA_XX42A0	= (1 << 5),
304*ee9ccdf7SJeff Garzik 	MV_HP_GEN_I		= (1 << 6),
305*ee9ccdf7SJeff Garzik 	MV_HP_GEN_II		= (1 << 7),
306*ee9ccdf7SJeff Garzik 	MV_HP_GEN_IIE		= (1 << 8),
307c6fd2807SJeff Garzik 
308c6fd2807SJeff Garzik 	/* Port private flags (pp_flags) */
309c6fd2807SJeff Garzik 	MV_PP_FLAG_EDMA_EN	= (1 << 0),
310c6fd2807SJeff Garzik 	MV_PP_FLAG_EDMA_DS_ACT	= (1 << 1),
311c5d3e45aSJeff Garzik 	MV_PP_FLAG_HAD_A_RESET	= (1 << 2),
312c6fd2807SJeff Garzik };
313c6fd2807SJeff Garzik 
314*ee9ccdf7SJeff Garzik #define IS_GEN_I(hpriv) ((hpriv)->hp_flags & MV_HP_GEN_I)
315*ee9ccdf7SJeff Garzik #define IS_GEN_II(hpriv) ((hpriv)->hp_flags & MV_HP_GEN_II)
316c6fd2807SJeff Garzik #define IS_GEN_IIE(hpriv) ((hpriv)->hp_flags & MV_HP_GEN_IIE)
317c6fd2807SJeff Garzik 
318c6fd2807SJeff Garzik enum {
319d88184fbSJeff Garzik 	MV_DMA_BOUNDARY		= 0xffffffffU,
320c6fd2807SJeff Garzik 
321c6fd2807SJeff Garzik 	EDMA_REQ_Q_BASE_LO_MASK	= 0xfffffc00U,
322c6fd2807SJeff Garzik 
323c6fd2807SJeff Garzik 	EDMA_RSP_Q_BASE_LO_MASK	= 0xffffff00U,
324c6fd2807SJeff Garzik };
325c6fd2807SJeff Garzik 
326c6fd2807SJeff Garzik enum chip_type {
327c6fd2807SJeff Garzik 	chip_504x,
328c6fd2807SJeff Garzik 	chip_508x,
329c6fd2807SJeff Garzik 	chip_5080,
330c6fd2807SJeff Garzik 	chip_604x,
331c6fd2807SJeff Garzik 	chip_608x,
332c6fd2807SJeff Garzik 	chip_6042,
333c6fd2807SJeff Garzik 	chip_7042,
334c6fd2807SJeff Garzik };
335c6fd2807SJeff Garzik 
336c6fd2807SJeff Garzik /* Command ReQuest Block: 32B */
337c6fd2807SJeff Garzik struct mv_crqb {
338c6fd2807SJeff Garzik 	__le32			sg_addr;
339c6fd2807SJeff Garzik 	__le32			sg_addr_hi;
340c6fd2807SJeff Garzik 	__le16			ctrl_flags;
341c6fd2807SJeff Garzik 	__le16			ata_cmd[11];
342c6fd2807SJeff Garzik };
343c6fd2807SJeff Garzik 
344c6fd2807SJeff Garzik struct mv_crqb_iie {
345c6fd2807SJeff Garzik 	__le32			addr;
346c6fd2807SJeff Garzik 	__le32			addr_hi;
347c6fd2807SJeff Garzik 	__le32			flags;
348c6fd2807SJeff Garzik 	__le32			len;
349c6fd2807SJeff Garzik 	__le32			ata_cmd[4];
350c6fd2807SJeff Garzik };
351c6fd2807SJeff Garzik 
352c6fd2807SJeff Garzik /* Command ResPonse Block: 8B */
353c6fd2807SJeff Garzik struct mv_crpb {
354c6fd2807SJeff Garzik 	__le16			id;
355c6fd2807SJeff Garzik 	__le16			flags;
356c6fd2807SJeff Garzik 	__le32			tmstmp;
357c6fd2807SJeff Garzik };
358c6fd2807SJeff Garzik 
359c6fd2807SJeff Garzik /* EDMA Physical Region Descriptor (ePRD); A.K.A. SG */
360c6fd2807SJeff Garzik struct mv_sg {
361c6fd2807SJeff Garzik 	__le32			addr;
362c6fd2807SJeff Garzik 	__le32			flags_size;
363c6fd2807SJeff Garzik 	__le32			addr_hi;
364c6fd2807SJeff Garzik 	__le32			reserved;
365c6fd2807SJeff Garzik };
366c6fd2807SJeff Garzik 
367c6fd2807SJeff Garzik struct mv_port_priv {
368c6fd2807SJeff Garzik 	struct mv_crqb		*crqb;
369c6fd2807SJeff Garzik 	dma_addr_t		crqb_dma;
370c6fd2807SJeff Garzik 	struct mv_crpb		*crpb;
371c6fd2807SJeff Garzik 	dma_addr_t		crpb_dma;
372c6fd2807SJeff Garzik 	struct mv_sg		*sg_tbl;
373c6fd2807SJeff Garzik 	dma_addr_t		sg_tbl_dma;
374bdd4dddeSJeff Garzik 
375bdd4dddeSJeff Garzik 	unsigned int		req_idx;
376bdd4dddeSJeff Garzik 	unsigned int		resp_idx;
377bdd4dddeSJeff Garzik 
378c6fd2807SJeff Garzik 	u32			pp_flags;
379c6fd2807SJeff Garzik };
380c6fd2807SJeff Garzik 
381c6fd2807SJeff Garzik struct mv_port_signal {
382c6fd2807SJeff Garzik 	u32			amps;
383c6fd2807SJeff Garzik 	u32			pre;
384c6fd2807SJeff Garzik };
385c6fd2807SJeff Garzik 
386c6fd2807SJeff Garzik struct mv_host_priv;
387c6fd2807SJeff Garzik struct mv_hw_ops {
388c6fd2807SJeff Garzik 	void (*phy_errata)(struct mv_host_priv *hpriv, void __iomem *mmio,
389c6fd2807SJeff Garzik 			   unsigned int port);
390c6fd2807SJeff Garzik 	void (*enable_leds)(struct mv_host_priv *hpriv, void __iomem *mmio);
391c6fd2807SJeff Garzik 	void (*read_preamp)(struct mv_host_priv *hpriv, int idx,
392c6fd2807SJeff Garzik 			   void __iomem *mmio);
393c6fd2807SJeff Garzik 	int (*reset_hc)(struct mv_host_priv *hpriv, void __iomem *mmio,
394c6fd2807SJeff Garzik 			unsigned int n_hc);
395c6fd2807SJeff Garzik 	void (*reset_flash)(struct mv_host_priv *hpriv, void __iomem *mmio);
396c6fd2807SJeff Garzik 	void (*reset_bus)(struct pci_dev *pdev, void __iomem *mmio);
397c6fd2807SJeff Garzik };
398c6fd2807SJeff Garzik 
399c6fd2807SJeff Garzik struct mv_host_priv {
400c6fd2807SJeff Garzik 	u32			hp_flags;
401c6fd2807SJeff Garzik 	struct mv_port_signal	signal[8];
402c6fd2807SJeff Garzik 	const struct mv_hw_ops	*ops;
403c6fd2807SJeff Garzik };
404c6fd2807SJeff Garzik 
405c6fd2807SJeff Garzik static void mv_irq_clear(struct ata_port *ap);
406c6fd2807SJeff Garzik static u32 mv_scr_read(struct ata_port *ap, unsigned int sc_reg_in);
407c6fd2807SJeff Garzik static void mv_scr_write(struct ata_port *ap, unsigned int sc_reg_in, u32 val);
408c6fd2807SJeff Garzik static u32 mv5_scr_read(struct ata_port *ap, unsigned int sc_reg_in);
409c6fd2807SJeff Garzik static void mv5_scr_write(struct ata_port *ap, unsigned int sc_reg_in, u32 val);
410c6fd2807SJeff Garzik static int mv_port_start(struct ata_port *ap);
411c6fd2807SJeff Garzik static void mv_port_stop(struct ata_port *ap);
412c6fd2807SJeff Garzik static void mv_qc_prep(struct ata_queued_cmd *qc);
413c6fd2807SJeff Garzik static void mv_qc_prep_iie(struct ata_queued_cmd *qc);
414c6fd2807SJeff Garzik static unsigned int mv_qc_issue(struct ata_queued_cmd *qc);
415bdd4dddeSJeff Garzik static void mv_error_handler(struct ata_port *ap);
416bdd4dddeSJeff Garzik static void mv_post_int_cmd(struct ata_queued_cmd *qc);
417bdd4dddeSJeff Garzik static void mv_eh_freeze(struct ata_port *ap);
418bdd4dddeSJeff Garzik static void mv_eh_thaw(struct ata_port *ap);
419c6fd2807SJeff Garzik static int mv_init_one(struct pci_dev *pdev, const struct pci_device_id *ent);
420c6fd2807SJeff Garzik 
421c6fd2807SJeff Garzik static void mv5_phy_errata(struct mv_host_priv *hpriv, void __iomem *mmio,
422c6fd2807SJeff Garzik 			   unsigned int port);
423c6fd2807SJeff Garzik static void mv5_enable_leds(struct mv_host_priv *hpriv, void __iomem *mmio);
424c6fd2807SJeff Garzik static void mv5_read_preamp(struct mv_host_priv *hpriv, int idx,
425c6fd2807SJeff Garzik 			   void __iomem *mmio);
426c6fd2807SJeff Garzik static int mv5_reset_hc(struct mv_host_priv *hpriv, void __iomem *mmio,
427c6fd2807SJeff Garzik 			unsigned int n_hc);
428c6fd2807SJeff Garzik static void mv5_reset_flash(struct mv_host_priv *hpriv, void __iomem *mmio);
429c6fd2807SJeff Garzik static void mv5_reset_bus(struct pci_dev *pdev, void __iomem *mmio);
430c6fd2807SJeff Garzik 
431c6fd2807SJeff Garzik static void mv6_phy_errata(struct mv_host_priv *hpriv, void __iomem *mmio,
432c6fd2807SJeff Garzik 			   unsigned int port);
433c6fd2807SJeff Garzik static void mv6_enable_leds(struct mv_host_priv *hpriv, void __iomem *mmio);
434c6fd2807SJeff Garzik static void mv6_read_preamp(struct mv_host_priv *hpriv, int idx,
435c6fd2807SJeff Garzik 			   void __iomem *mmio);
436c6fd2807SJeff Garzik static int mv6_reset_hc(struct mv_host_priv *hpriv, void __iomem *mmio,
437c6fd2807SJeff Garzik 			unsigned int n_hc);
438c6fd2807SJeff Garzik static void mv6_reset_flash(struct mv_host_priv *hpriv, void __iomem *mmio);
439c6fd2807SJeff Garzik static void mv_reset_pci_bus(struct pci_dev *pdev, void __iomem *mmio);
440c6fd2807SJeff Garzik static void mv_channel_reset(struct mv_host_priv *hpriv, void __iomem *mmio,
441c6fd2807SJeff Garzik 			     unsigned int port_no);
442c6fd2807SJeff Garzik 
443c5d3e45aSJeff Garzik static struct scsi_host_template mv5_sht = {
444c6fd2807SJeff Garzik 	.module			= THIS_MODULE,
445c6fd2807SJeff Garzik 	.name			= DRV_NAME,
446c6fd2807SJeff Garzik 	.ioctl			= ata_scsi_ioctl,
447c6fd2807SJeff Garzik 	.queuecommand		= ata_scsi_queuecmd,
448c5d3e45aSJeff Garzik 	.can_queue		= ATA_DEF_QUEUE,
449c5d3e45aSJeff Garzik 	.this_id		= ATA_SHT_THIS_ID,
450c5d3e45aSJeff Garzik 	.sg_tablesize		= MV_MAX_SG_CT,
451c5d3e45aSJeff Garzik 	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
452c5d3e45aSJeff Garzik 	.emulated		= ATA_SHT_EMULATED,
453c5d3e45aSJeff Garzik 	.use_clustering		= 1,
454c5d3e45aSJeff Garzik 	.proc_name		= DRV_NAME,
455c5d3e45aSJeff Garzik 	.dma_boundary		= MV_DMA_BOUNDARY,
456c5d3e45aSJeff Garzik 	.slave_configure	= ata_scsi_slave_config,
457c5d3e45aSJeff Garzik 	.slave_destroy		= ata_scsi_slave_destroy,
458c5d3e45aSJeff Garzik 	.bios_param		= ata_std_bios_param,
459c5d3e45aSJeff Garzik };
460c5d3e45aSJeff Garzik 
461c5d3e45aSJeff Garzik static struct scsi_host_template mv6_sht = {
462c5d3e45aSJeff Garzik 	.module			= THIS_MODULE,
463c5d3e45aSJeff Garzik 	.name			= DRV_NAME,
464c5d3e45aSJeff Garzik 	.ioctl			= ata_scsi_ioctl,
465c5d3e45aSJeff Garzik 	.queuecommand		= ata_scsi_queuecmd,
466c5d3e45aSJeff Garzik 	.can_queue		= ATA_DEF_QUEUE,
467c6fd2807SJeff Garzik 	.this_id		= ATA_SHT_THIS_ID,
468d88184fbSJeff Garzik 	.sg_tablesize		= MV_MAX_SG_CT,
469c6fd2807SJeff Garzik 	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
470c6fd2807SJeff Garzik 	.emulated		= ATA_SHT_EMULATED,
471d88184fbSJeff Garzik 	.use_clustering		= 1,
472c6fd2807SJeff Garzik 	.proc_name		= DRV_NAME,
473c6fd2807SJeff Garzik 	.dma_boundary		= MV_DMA_BOUNDARY,
474c6fd2807SJeff Garzik 	.slave_configure	= ata_scsi_slave_config,
475c6fd2807SJeff Garzik 	.slave_destroy		= ata_scsi_slave_destroy,
476c6fd2807SJeff Garzik 	.bios_param		= ata_std_bios_param,
477c6fd2807SJeff Garzik };
478c6fd2807SJeff Garzik 
479c6fd2807SJeff Garzik static const struct ata_port_operations mv5_ops = {
480c6fd2807SJeff Garzik 	.port_disable		= ata_port_disable,
481c6fd2807SJeff Garzik 
482c6fd2807SJeff Garzik 	.tf_load		= ata_tf_load,
483c6fd2807SJeff Garzik 	.tf_read		= ata_tf_read,
484c6fd2807SJeff Garzik 	.check_status		= ata_check_status,
485c6fd2807SJeff Garzik 	.exec_command		= ata_exec_command,
486c6fd2807SJeff Garzik 	.dev_select		= ata_std_dev_select,
487c6fd2807SJeff Garzik 
488cffacd85SJeff Garzik 	.cable_detect		= ata_cable_sata,
489c6fd2807SJeff Garzik 
490c6fd2807SJeff Garzik 	.qc_prep		= mv_qc_prep,
491c6fd2807SJeff Garzik 	.qc_issue		= mv_qc_issue,
4920d5ff566STejun Heo 	.data_xfer		= ata_data_xfer,
493c6fd2807SJeff Garzik 
494c6fd2807SJeff Garzik 	.irq_clear		= mv_irq_clear,
495246ce3b6SAkira Iguchi 	.irq_on			= ata_irq_on,
496246ce3b6SAkira Iguchi 	.irq_ack		= ata_irq_ack,
497c6fd2807SJeff Garzik 
498bdd4dddeSJeff Garzik 	.error_handler		= mv_error_handler,
499bdd4dddeSJeff Garzik 	.post_internal_cmd	= mv_post_int_cmd,
500bdd4dddeSJeff Garzik 	.freeze			= mv_eh_freeze,
501bdd4dddeSJeff Garzik 	.thaw			= mv_eh_thaw,
502bdd4dddeSJeff Garzik 
503c6fd2807SJeff Garzik 	.scr_read		= mv5_scr_read,
504c6fd2807SJeff Garzik 	.scr_write		= mv5_scr_write,
505c6fd2807SJeff Garzik 
506c6fd2807SJeff Garzik 	.port_start		= mv_port_start,
507c6fd2807SJeff Garzik 	.port_stop		= mv_port_stop,
508c6fd2807SJeff Garzik };
509c6fd2807SJeff Garzik 
510c6fd2807SJeff Garzik static const struct ata_port_operations mv6_ops = {
511c6fd2807SJeff Garzik 	.port_disable		= ata_port_disable,
512c6fd2807SJeff Garzik 
513c6fd2807SJeff Garzik 	.tf_load		= ata_tf_load,
514c6fd2807SJeff Garzik 	.tf_read		= ata_tf_read,
515c6fd2807SJeff Garzik 	.check_status		= ata_check_status,
516c6fd2807SJeff Garzik 	.exec_command		= ata_exec_command,
517c6fd2807SJeff Garzik 	.dev_select		= ata_std_dev_select,
518c6fd2807SJeff Garzik 
519cffacd85SJeff Garzik 	.cable_detect		= ata_cable_sata,
520c6fd2807SJeff Garzik 
521c6fd2807SJeff Garzik 	.qc_prep		= mv_qc_prep,
522c6fd2807SJeff Garzik 	.qc_issue		= mv_qc_issue,
5230d5ff566STejun Heo 	.data_xfer		= ata_data_xfer,
524c6fd2807SJeff Garzik 
525c6fd2807SJeff Garzik 	.irq_clear		= mv_irq_clear,
526246ce3b6SAkira Iguchi 	.irq_on			= ata_irq_on,
527246ce3b6SAkira Iguchi 	.irq_ack		= ata_irq_ack,
528c6fd2807SJeff Garzik 
529bdd4dddeSJeff Garzik 	.error_handler		= mv_error_handler,
530bdd4dddeSJeff Garzik 	.post_internal_cmd	= mv_post_int_cmd,
531bdd4dddeSJeff Garzik 	.freeze			= mv_eh_freeze,
532bdd4dddeSJeff Garzik 	.thaw			= mv_eh_thaw,
533bdd4dddeSJeff Garzik 
534c6fd2807SJeff Garzik 	.scr_read		= mv_scr_read,
535c6fd2807SJeff Garzik 	.scr_write		= mv_scr_write,
536c6fd2807SJeff Garzik 
537c6fd2807SJeff Garzik 	.port_start		= mv_port_start,
538c6fd2807SJeff Garzik 	.port_stop		= mv_port_stop,
539c6fd2807SJeff Garzik };
540c6fd2807SJeff Garzik 
541c6fd2807SJeff Garzik static const struct ata_port_operations mv_iie_ops = {
542c6fd2807SJeff Garzik 	.port_disable		= ata_port_disable,
543c6fd2807SJeff Garzik 
544c6fd2807SJeff Garzik 	.tf_load		= ata_tf_load,
545c6fd2807SJeff Garzik 	.tf_read		= ata_tf_read,
546c6fd2807SJeff Garzik 	.check_status		= ata_check_status,
547c6fd2807SJeff Garzik 	.exec_command		= ata_exec_command,
548c6fd2807SJeff Garzik 	.dev_select		= ata_std_dev_select,
549c6fd2807SJeff Garzik 
550cffacd85SJeff Garzik 	.cable_detect		= ata_cable_sata,
551c6fd2807SJeff Garzik 
552c6fd2807SJeff Garzik 	.qc_prep		= mv_qc_prep_iie,
553c6fd2807SJeff Garzik 	.qc_issue		= mv_qc_issue,
5540d5ff566STejun Heo 	.data_xfer		= ata_data_xfer,
555c6fd2807SJeff Garzik 
556c6fd2807SJeff Garzik 	.irq_clear		= mv_irq_clear,
557246ce3b6SAkira Iguchi 	.irq_on			= ata_irq_on,
558246ce3b6SAkira Iguchi 	.irq_ack		= ata_irq_ack,
559c6fd2807SJeff Garzik 
560bdd4dddeSJeff Garzik 	.error_handler		= mv_error_handler,
561bdd4dddeSJeff Garzik 	.post_internal_cmd	= mv_post_int_cmd,
562bdd4dddeSJeff Garzik 	.freeze			= mv_eh_freeze,
563bdd4dddeSJeff Garzik 	.thaw			= mv_eh_thaw,
564bdd4dddeSJeff Garzik 
565c6fd2807SJeff Garzik 	.scr_read		= mv_scr_read,
566c6fd2807SJeff Garzik 	.scr_write		= mv_scr_write,
567c6fd2807SJeff Garzik 
568c6fd2807SJeff Garzik 	.port_start		= mv_port_start,
569c6fd2807SJeff Garzik 	.port_stop		= mv_port_stop,
570c6fd2807SJeff Garzik };
571c6fd2807SJeff Garzik 
572c6fd2807SJeff Garzik static const struct ata_port_info mv_port_info[] = {
573c6fd2807SJeff Garzik 	{  /* chip_504x */
574cca3974eSJeff Garzik 		.flags		= MV_COMMON_FLAGS,
575c6fd2807SJeff Garzik 		.pio_mask	= 0x1f,	/* pio0-4 */
576bf6263a8SJeff Garzik 		.udma_mask	= ATA_UDMA6,
577c6fd2807SJeff Garzik 		.port_ops	= &mv5_ops,
578c6fd2807SJeff Garzik 	},
579c6fd2807SJeff Garzik 	{  /* chip_508x */
580c5d3e45aSJeff Garzik 		.flags		= MV_COMMON_FLAGS | MV_FLAG_DUAL_HC,
581c6fd2807SJeff Garzik 		.pio_mask	= 0x1f,	/* pio0-4 */
582bf6263a8SJeff Garzik 		.udma_mask	= ATA_UDMA6,
583c6fd2807SJeff Garzik 		.port_ops	= &mv5_ops,
584c6fd2807SJeff Garzik 	},
585c6fd2807SJeff Garzik 	{  /* chip_5080 */
586c5d3e45aSJeff Garzik 		.flags		= MV_COMMON_FLAGS | MV_FLAG_DUAL_HC,
587c6fd2807SJeff Garzik 		.pio_mask	= 0x1f,	/* pio0-4 */
588bf6263a8SJeff Garzik 		.udma_mask	= ATA_UDMA6,
589c6fd2807SJeff Garzik 		.port_ops	= &mv5_ops,
590c6fd2807SJeff Garzik 	},
591c6fd2807SJeff Garzik 	{  /* chip_604x */
592c5d3e45aSJeff Garzik 		.flags		= MV_COMMON_FLAGS | MV_6XXX_FLAGS,
593c6fd2807SJeff Garzik 		.pio_mask	= 0x1f,	/* pio0-4 */
594bf6263a8SJeff Garzik 		.udma_mask	= ATA_UDMA6,
595c6fd2807SJeff Garzik 		.port_ops	= &mv6_ops,
596c6fd2807SJeff Garzik 	},
597c6fd2807SJeff Garzik 	{  /* chip_608x */
598c5d3e45aSJeff Garzik 		.flags		= MV_COMMON_FLAGS | MV_6XXX_FLAGS |
599c5d3e45aSJeff Garzik 				  MV_FLAG_DUAL_HC,
600c6fd2807SJeff Garzik 		.pio_mask	= 0x1f,	/* pio0-4 */
601bf6263a8SJeff Garzik 		.udma_mask	= ATA_UDMA6,
602c6fd2807SJeff Garzik 		.port_ops	= &mv6_ops,
603c6fd2807SJeff Garzik 	},
604c6fd2807SJeff Garzik 	{  /* chip_6042 */
605c5d3e45aSJeff Garzik 		.flags		= MV_COMMON_FLAGS | MV_6XXX_FLAGS,
606c6fd2807SJeff Garzik 		.pio_mask	= 0x1f,	/* pio0-4 */
607bf6263a8SJeff Garzik 		.udma_mask	= ATA_UDMA6,
608c6fd2807SJeff Garzik 		.port_ops	= &mv_iie_ops,
609c6fd2807SJeff Garzik 	},
610c6fd2807SJeff Garzik 	{  /* chip_7042 */
611c5d3e45aSJeff Garzik 		.flags		= MV_COMMON_FLAGS | MV_6XXX_FLAGS,
612c6fd2807SJeff Garzik 		.pio_mask	= 0x1f,	/* pio0-4 */
613bf6263a8SJeff Garzik 		.udma_mask	= ATA_UDMA6,
614c6fd2807SJeff Garzik 		.port_ops	= &mv_iie_ops,
615c6fd2807SJeff Garzik 	},
616c6fd2807SJeff Garzik };
617c6fd2807SJeff Garzik 
618c6fd2807SJeff Garzik static const struct pci_device_id mv_pci_tbl[] = {
6192d2744fcSJeff Garzik 	{ PCI_VDEVICE(MARVELL, 0x5040), chip_504x },
6202d2744fcSJeff Garzik 	{ PCI_VDEVICE(MARVELL, 0x5041), chip_504x },
6212d2744fcSJeff Garzik 	{ PCI_VDEVICE(MARVELL, 0x5080), chip_5080 },
6222d2744fcSJeff Garzik 	{ PCI_VDEVICE(MARVELL, 0x5081), chip_508x },
623c6fd2807SJeff Garzik 
6242d2744fcSJeff Garzik 	{ PCI_VDEVICE(MARVELL, 0x6040), chip_604x },
6252d2744fcSJeff Garzik 	{ PCI_VDEVICE(MARVELL, 0x6041), chip_604x },
6262d2744fcSJeff Garzik 	{ PCI_VDEVICE(MARVELL, 0x6042), chip_6042 },
6272d2744fcSJeff Garzik 	{ PCI_VDEVICE(MARVELL, 0x6080), chip_608x },
6282d2744fcSJeff Garzik 	{ PCI_VDEVICE(MARVELL, 0x6081), chip_608x },
629c6fd2807SJeff Garzik 
6302d2744fcSJeff Garzik 	{ PCI_VDEVICE(ADAPTEC2, 0x0241), chip_604x },
6312d2744fcSJeff Garzik 
632d9f9c6bcSFlorian Attenberger 	/* Adaptec 1430SA */
633d9f9c6bcSFlorian Attenberger 	{ PCI_VDEVICE(ADAPTEC2, 0x0243), chip_7042 },
634d9f9c6bcSFlorian Attenberger 
635e93f09dcSOlof Johansson 	{ PCI_VDEVICE(TTI, 0x2310), chip_7042 },
636e93f09dcSOlof Johansson 
6376a3d586dSMorrison, Tom 	/* add Marvell 7042 support */
6386a3d586dSMorrison, Tom 	{ PCI_VDEVICE(MARVELL, 0x7042), chip_7042 },
6396a3d586dSMorrison, Tom 
640c6fd2807SJeff Garzik 	{ }			/* terminate list */
641c6fd2807SJeff Garzik };
642c6fd2807SJeff Garzik 
643c6fd2807SJeff Garzik static struct pci_driver mv_pci_driver = {
644c6fd2807SJeff Garzik 	.name			= DRV_NAME,
645c6fd2807SJeff Garzik 	.id_table		= mv_pci_tbl,
646c6fd2807SJeff Garzik 	.probe			= mv_init_one,
647c6fd2807SJeff Garzik 	.remove			= ata_pci_remove_one,
648c6fd2807SJeff Garzik };
649c6fd2807SJeff Garzik 
650c6fd2807SJeff Garzik static const struct mv_hw_ops mv5xxx_ops = {
651c6fd2807SJeff Garzik 	.phy_errata		= mv5_phy_errata,
652c6fd2807SJeff Garzik 	.enable_leds		= mv5_enable_leds,
653c6fd2807SJeff Garzik 	.read_preamp		= mv5_read_preamp,
654c6fd2807SJeff Garzik 	.reset_hc		= mv5_reset_hc,
655c6fd2807SJeff Garzik 	.reset_flash		= mv5_reset_flash,
656c6fd2807SJeff Garzik 	.reset_bus		= mv5_reset_bus,
657c6fd2807SJeff Garzik };
658c6fd2807SJeff Garzik 
659c6fd2807SJeff Garzik static const struct mv_hw_ops mv6xxx_ops = {
660c6fd2807SJeff Garzik 	.phy_errata		= mv6_phy_errata,
661c6fd2807SJeff Garzik 	.enable_leds		= mv6_enable_leds,
662c6fd2807SJeff Garzik 	.read_preamp		= mv6_read_preamp,
663c6fd2807SJeff Garzik 	.reset_hc		= mv6_reset_hc,
664c6fd2807SJeff Garzik 	.reset_flash		= mv6_reset_flash,
665c6fd2807SJeff Garzik 	.reset_bus		= mv_reset_pci_bus,
666c6fd2807SJeff Garzik };
667c6fd2807SJeff Garzik 
668c6fd2807SJeff Garzik /*
669c6fd2807SJeff Garzik  * module options
670c6fd2807SJeff Garzik  */
671c6fd2807SJeff Garzik static int msi;	      /* Use PCI msi; either zero (off, default) or non-zero */
672c6fd2807SJeff Garzik 
673c6fd2807SJeff Garzik 
674d88184fbSJeff Garzik /* move to PCI layer or libata core? */
675d88184fbSJeff Garzik static int pci_go_64(struct pci_dev *pdev)
676d88184fbSJeff Garzik {
677d88184fbSJeff Garzik 	int rc;
678d88184fbSJeff Garzik 
679d88184fbSJeff Garzik 	if (!pci_set_dma_mask(pdev, DMA_64BIT_MASK)) {
680d88184fbSJeff Garzik 		rc = pci_set_consistent_dma_mask(pdev, DMA_64BIT_MASK);
681d88184fbSJeff Garzik 		if (rc) {
682d88184fbSJeff Garzik 			rc = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
683d88184fbSJeff Garzik 			if (rc) {
684d88184fbSJeff Garzik 				dev_printk(KERN_ERR, &pdev->dev,
685d88184fbSJeff Garzik 					   "64-bit DMA enable failed\n");
686d88184fbSJeff Garzik 				return rc;
687d88184fbSJeff Garzik 			}
688d88184fbSJeff Garzik 		}
689d88184fbSJeff Garzik 	} else {
690d88184fbSJeff Garzik 		rc = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
691d88184fbSJeff Garzik 		if (rc) {
692d88184fbSJeff Garzik 			dev_printk(KERN_ERR, &pdev->dev,
693d88184fbSJeff Garzik 				   "32-bit DMA enable failed\n");
694d88184fbSJeff Garzik 			return rc;
695d88184fbSJeff Garzik 		}
696d88184fbSJeff Garzik 		rc = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
697d88184fbSJeff Garzik 		if (rc) {
698d88184fbSJeff Garzik 			dev_printk(KERN_ERR, &pdev->dev,
699d88184fbSJeff Garzik 				   "32-bit consistent DMA enable failed\n");
700d88184fbSJeff Garzik 			return rc;
701d88184fbSJeff Garzik 		}
702d88184fbSJeff Garzik 	}
703d88184fbSJeff Garzik 
704d88184fbSJeff Garzik 	return rc;
705d88184fbSJeff Garzik }
706d88184fbSJeff Garzik 
707c6fd2807SJeff Garzik /*
708c6fd2807SJeff Garzik  * Functions
709c6fd2807SJeff Garzik  */
710c6fd2807SJeff Garzik 
711c6fd2807SJeff Garzik static inline void writelfl(unsigned long data, void __iomem *addr)
712c6fd2807SJeff Garzik {
713c6fd2807SJeff Garzik 	writel(data, addr);
714c6fd2807SJeff Garzik 	(void) readl(addr);	/* flush to avoid PCI posted write */
715c6fd2807SJeff Garzik }
716c6fd2807SJeff Garzik 
717c6fd2807SJeff Garzik static inline void __iomem *mv_hc_base(void __iomem *base, unsigned int hc)
718c6fd2807SJeff Garzik {
719c6fd2807SJeff Garzik 	return (base + MV_SATAHC0_REG_BASE + (hc * MV_SATAHC_REG_SZ));
720c6fd2807SJeff Garzik }
721c6fd2807SJeff Garzik 
722c6fd2807SJeff Garzik static inline unsigned int mv_hc_from_port(unsigned int port)
723c6fd2807SJeff Garzik {
724c6fd2807SJeff Garzik 	return port >> MV_PORT_HC_SHIFT;
725c6fd2807SJeff Garzik }
726c6fd2807SJeff Garzik 
727c6fd2807SJeff Garzik static inline unsigned int mv_hardport_from_port(unsigned int port)
728c6fd2807SJeff Garzik {
729c6fd2807SJeff Garzik 	return port & MV_PORT_MASK;
730c6fd2807SJeff Garzik }
731c6fd2807SJeff Garzik 
732c6fd2807SJeff Garzik static inline void __iomem *mv_hc_base_from_port(void __iomem *base,
733c6fd2807SJeff Garzik 						 unsigned int port)
734c6fd2807SJeff Garzik {
735c6fd2807SJeff Garzik 	return mv_hc_base(base, mv_hc_from_port(port));
736c6fd2807SJeff Garzik }
737c6fd2807SJeff Garzik 
738c6fd2807SJeff Garzik static inline void __iomem *mv_port_base(void __iomem *base, unsigned int port)
739c6fd2807SJeff Garzik {
740c6fd2807SJeff Garzik 	return  mv_hc_base_from_port(base, port) +
741c6fd2807SJeff Garzik 		MV_SATAHC_ARBTR_REG_SZ +
742c6fd2807SJeff Garzik 		(mv_hardport_from_port(port) * MV_PORT_REG_SZ);
743c6fd2807SJeff Garzik }
744c6fd2807SJeff Garzik 
745c6fd2807SJeff Garzik static inline void __iomem *mv_ap_base(struct ata_port *ap)
746c6fd2807SJeff Garzik {
7470d5ff566STejun Heo 	return mv_port_base(ap->host->iomap[MV_PRIMARY_BAR], ap->port_no);
748c6fd2807SJeff Garzik }
749c6fd2807SJeff Garzik 
750cca3974eSJeff Garzik static inline int mv_get_hc_count(unsigned long port_flags)
751c6fd2807SJeff Garzik {
752cca3974eSJeff Garzik 	return ((port_flags & MV_FLAG_DUAL_HC) ? 2 : 1);
753c6fd2807SJeff Garzik }
754c6fd2807SJeff Garzik 
755c6fd2807SJeff Garzik static void mv_irq_clear(struct ata_port *ap)
756c6fd2807SJeff Garzik {
757c6fd2807SJeff Garzik }
758c6fd2807SJeff Garzik 
759c5d3e45aSJeff Garzik static void mv_set_edma_ptrs(void __iomem *port_mmio,
760c5d3e45aSJeff Garzik 			     struct mv_host_priv *hpriv,
761c5d3e45aSJeff Garzik 			     struct mv_port_priv *pp)
762c5d3e45aSJeff Garzik {
763bdd4dddeSJeff Garzik 	u32 index;
764bdd4dddeSJeff Garzik 
765c5d3e45aSJeff Garzik 	/*
766c5d3e45aSJeff Garzik 	 * initialize request queue
767c5d3e45aSJeff Garzik 	 */
768bdd4dddeSJeff Garzik 	index = (pp->req_idx & MV_MAX_Q_DEPTH_MASK) << EDMA_REQ_Q_PTR_SHIFT;
769bdd4dddeSJeff Garzik 
770c5d3e45aSJeff Garzik 	WARN_ON(pp->crqb_dma & 0x3ff);
771c5d3e45aSJeff Garzik 	writel((pp->crqb_dma >> 16) >> 16, port_mmio + EDMA_REQ_Q_BASE_HI_OFS);
772bdd4dddeSJeff Garzik 	writelfl((pp->crqb_dma & EDMA_REQ_Q_BASE_LO_MASK) | index,
773c5d3e45aSJeff Garzik 		 port_mmio + EDMA_REQ_Q_IN_PTR_OFS);
774c5d3e45aSJeff Garzik 
775c5d3e45aSJeff Garzik 	if (hpriv->hp_flags & MV_HP_ERRATA_XX42A0)
776bdd4dddeSJeff Garzik 		writelfl((pp->crqb_dma & 0xffffffff) | index,
777c5d3e45aSJeff Garzik 			 port_mmio + EDMA_REQ_Q_OUT_PTR_OFS);
778c5d3e45aSJeff Garzik 	else
779bdd4dddeSJeff Garzik 		writelfl(index, port_mmio + EDMA_REQ_Q_OUT_PTR_OFS);
780c5d3e45aSJeff Garzik 
781c5d3e45aSJeff Garzik 	/*
782c5d3e45aSJeff Garzik 	 * initialize response queue
783c5d3e45aSJeff Garzik 	 */
784bdd4dddeSJeff Garzik 	index = (pp->resp_idx & MV_MAX_Q_DEPTH_MASK) << EDMA_RSP_Q_PTR_SHIFT;
785bdd4dddeSJeff Garzik 
786c5d3e45aSJeff Garzik 	WARN_ON(pp->crpb_dma & 0xff);
787c5d3e45aSJeff Garzik 	writel((pp->crpb_dma >> 16) >> 16, port_mmio + EDMA_RSP_Q_BASE_HI_OFS);
788c5d3e45aSJeff Garzik 
789c5d3e45aSJeff Garzik 	if (hpriv->hp_flags & MV_HP_ERRATA_XX42A0)
790bdd4dddeSJeff Garzik 		writelfl((pp->crpb_dma & 0xffffffff) | index,
791c5d3e45aSJeff Garzik 			 port_mmio + EDMA_RSP_Q_IN_PTR_OFS);
792c5d3e45aSJeff Garzik 	else
793bdd4dddeSJeff Garzik 		writelfl(index, port_mmio + EDMA_RSP_Q_IN_PTR_OFS);
794c5d3e45aSJeff Garzik 
795bdd4dddeSJeff Garzik 	writelfl((pp->crpb_dma & EDMA_RSP_Q_BASE_LO_MASK) | index,
796c5d3e45aSJeff Garzik 		 port_mmio + EDMA_RSP_Q_OUT_PTR_OFS);
797c5d3e45aSJeff Garzik }
798c5d3e45aSJeff Garzik 
799c6fd2807SJeff Garzik /**
800c6fd2807SJeff Garzik  *      mv_start_dma - Enable eDMA engine
801c6fd2807SJeff Garzik  *      @base: port base address
802c6fd2807SJeff Garzik  *      @pp: port private data
803c6fd2807SJeff Garzik  *
804c6fd2807SJeff Garzik  *      Verify the local cache of the eDMA state is accurate with a
805c6fd2807SJeff Garzik  *      WARN_ON.
806c6fd2807SJeff Garzik  *
807c6fd2807SJeff Garzik  *      LOCKING:
808c6fd2807SJeff Garzik  *      Inherited from caller.
809c6fd2807SJeff Garzik  */
810c5d3e45aSJeff Garzik static void mv_start_dma(void __iomem *base, struct mv_host_priv *hpriv,
811c5d3e45aSJeff Garzik 			 struct mv_port_priv *pp)
812c6fd2807SJeff Garzik {
813c5d3e45aSJeff Garzik 	if (!(pp->pp_flags & MV_PP_FLAG_EDMA_EN)) {
814bdd4dddeSJeff Garzik 		/* clear EDMA event indicators, if any */
815bdd4dddeSJeff Garzik 		writelfl(0, base + EDMA_ERR_IRQ_CAUSE_OFS);
816bdd4dddeSJeff Garzik 
817bdd4dddeSJeff Garzik 		mv_set_edma_ptrs(base, hpriv, pp);
818bdd4dddeSJeff Garzik 
819c6fd2807SJeff Garzik 		writelfl(EDMA_EN, base + EDMA_CMD_OFS);
820c6fd2807SJeff Garzik 		pp->pp_flags |= MV_PP_FLAG_EDMA_EN;
821c6fd2807SJeff Garzik 	}
822c6fd2807SJeff Garzik 	WARN_ON(!(EDMA_EN & readl(base + EDMA_CMD_OFS)));
823c6fd2807SJeff Garzik }
824c6fd2807SJeff Garzik 
825c6fd2807SJeff Garzik /**
826c6fd2807SJeff Garzik  *      mv_stop_dma - Disable eDMA engine
827c6fd2807SJeff Garzik  *      @ap: ATA channel to manipulate
828c6fd2807SJeff Garzik  *
829c6fd2807SJeff Garzik  *      Verify the local cache of the eDMA state is accurate with a
830c6fd2807SJeff Garzik  *      WARN_ON.
831c6fd2807SJeff Garzik  *
832c6fd2807SJeff Garzik  *      LOCKING:
833c6fd2807SJeff Garzik  *      Inherited from caller.
834c6fd2807SJeff Garzik  */
835c5d3e45aSJeff Garzik static int mv_stop_dma(struct ata_port *ap)
836c6fd2807SJeff Garzik {
837c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_ap_base(ap);
838c6fd2807SJeff Garzik 	struct mv_port_priv *pp	= ap->private_data;
839c6fd2807SJeff Garzik 	u32 reg;
840c5d3e45aSJeff Garzik 	int i, err = 0;
841c6fd2807SJeff Garzik 
8424537deb5SJeff Garzik 	if (pp->pp_flags & MV_PP_FLAG_EDMA_EN) {
843c6fd2807SJeff Garzik 		/* Disable EDMA if active.   The disable bit auto clears.
844c6fd2807SJeff Garzik 		 */
845c6fd2807SJeff Garzik 		writelfl(EDMA_DS, port_mmio + EDMA_CMD_OFS);
846c6fd2807SJeff Garzik 		pp->pp_flags &= ~MV_PP_FLAG_EDMA_EN;
847c6fd2807SJeff Garzik 	} else {
848c6fd2807SJeff Garzik 		WARN_ON(EDMA_EN & readl(port_mmio + EDMA_CMD_OFS));
849c6fd2807SJeff Garzik   	}
850c6fd2807SJeff Garzik 
851c6fd2807SJeff Garzik 	/* now properly wait for the eDMA to stop */
852c6fd2807SJeff Garzik 	for (i = 1000; i > 0; i--) {
853c6fd2807SJeff Garzik 		reg = readl(port_mmio + EDMA_CMD_OFS);
8544537deb5SJeff Garzik 		if (!(reg & EDMA_EN))
855c6fd2807SJeff Garzik 			break;
8564537deb5SJeff Garzik 
857c6fd2807SJeff Garzik 		udelay(100);
858c6fd2807SJeff Garzik 	}
859c6fd2807SJeff Garzik 
860c5d3e45aSJeff Garzik 	if (reg & EDMA_EN) {
861c6fd2807SJeff Garzik 		ata_port_printk(ap, KERN_ERR, "Unable to stop eDMA\n");
862c5d3e45aSJeff Garzik 		err = -EIO;
863c6fd2807SJeff Garzik 	}
864c5d3e45aSJeff Garzik 
865c5d3e45aSJeff Garzik 	return err;
866c6fd2807SJeff Garzik }
867c6fd2807SJeff Garzik 
868c6fd2807SJeff Garzik #ifdef ATA_DEBUG
869c6fd2807SJeff Garzik static void mv_dump_mem(void __iomem *start, unsigned bytes)
870c6fd2807SJeff Garzik {
871c6fd2807SJeff Garzik 	int b, w;
872c6fd2807SJeff Garzik 	for (b = 0; b < bytes; ) {
873c6fd2807SJeff Garzik 		DPRINTK("%p: ", start + b);
874c6fd2807SJeff Garzik 		for (w = 0; b < bytes && w < 4; w++) {
875c6fd2807SJeff Garzik 			printk("%08x ",readl(start + b));
876c6fd2807SJeff Garzik 			b += sizeof(u32);
877c6fd2807SJeff Garzik 		}
878c6fd2807SJeff Garzik 		printk("\n");
879c6fd2807SJeff Garzik 	}
880c6fd2807SJeff Garzik }
881c6fd2807SJeff Garzik #endif
882c6fd2807SJeff Garzik 
883c6fd2807SJeff Garzik static void mv_dump_pci_cfg(struct pci_dev *pdev, unsigned bytes)
884c6fd2807SJeff Garzik {
885c6fd2807SJeff Garzik #ifdef ATA_DEBUG
886c6fd2807SJeff Garzik 	int b, w;
887c6fd2807SJeff Garzik 	u32 dw;
888c6fd2807SJeff Garzik 	for (b = 0; b < bytes; ) {
889c6fd2807SJeff Garzik 		DPRINTK("%02x: ", b);
890c6fd2807SJeff Garzik 		for (w = 0; b < bytes && w < 4; w++) {
891c6fd2807SJeff Garzik 			(void) pci_read_config_dword(pdev,b,&dw);
892c6fd2807SJeff Garzik 			printk("%08x ",dw);
893c6fd2807SJeff Garzik 			b += sizeof(u32);
894c6fd2807SJeff Garzik 		}
895c6fd2807SJeff Garzik 		printk("\n");
896c6fd2807SJeff Garzik 	}
897c6fd2807SJeff Garzik #endif
898c6fd2807SJeff Garzik }
899c6fd2807SJeff Garzik static void mv_dump_all_regs(void __iomem *mmio_base, int port,
900c6fd2807SJeff Garzik 			     struct pci_dev *pdev)
901c6fd2807SJeff Garzik {
902c6fd2807SJeff Garzik #ifdef ATA_DEBUG
903c6fd2807SJeff Garzik 	void __iomem *hc_base = mv_hc_base(mmio_base,
904c6fd2807SJeff Garzik 					   port >> MV_PORT_HC_SHIFT);
905c6fd2807SJeff Garzik 	void __iomem *port_base;
906c6fd2807SJeff Garzik 	int start_port, num_ports, p, start_hc, num_hcs, hc;
907c6fd2807SJeff Garzik 
908c6fd2807SJeff Garzik 	if (0 > port) {
909c6fd2807SJeff Garzik 		start_hc = start_port = 0;
910c6fd2807SJeff Garzik 		num_ports = 8;		/* shld be benign for 4 port devs */
911c6fd2807SJeff Garzik 		num_hcs = 2;
912c6fd2807SJeff Garzik 	} else {
913c6fd2807SJeff Garzik 		start_hc = port >> MV_PORT_HC_SHIFT;
914c6fd2807SJeff Garzik 		start_port = port;
915c6fd2807SJeff Garzik 		num_ports = num_hcs = 1;
916c6fd2807SJeff Garzik 	}
917c6fd2807SJeff Garzik 	DPRINTK("All registers for port(s) %u-%u:\n", start_port,
918c6fd2807SJeff Garzik 		num_ports > 1 ? num_ports - 1 : start_port);
919c6fd2807SJeff Garzik 
920c6fd2807SJeff Garzik 	if (NULL != pdev) {
921c6fd2807SJeff Garzik 		DPRINTK("PCI config space regs:\n");
922c6fd2807SJeff Garzik 		mv_dump_pci_cfg(pdev, 0x68);
923c6fd2807SJeff Garzik 	}
924c6fd2807SJeff Garzik 	DPRINTK("PCI regs:\n");
925c6fd2807SJeff Garzik 	mv_dump_mem(mmio_base+0xc00, 0x3c);
926c6fd2807SJeff Garzik 	mv_dump_mem(mmio_base+0xd00, 0x34);
927c6fd2807SJeff Garzik 	mv_dump_mem(mmio_base+0xf00, 0x4);
928c6fd2807SJeff Garzik 	mv_dump_mem(mmio_base+0x1d00, 0x6c);
929c6fd2807SJeff Garzik 	for (hc = start_hc; hc < start_hc + num_hcs; hc++) {
930c6fd2807SJeff Garzik 		hc_base = mv_hc_base(mmio_base, hc);
931c6fd2807SJeff Garzik 		DPRINTK("HC regs (HC %i):\n", hc);
932c6fd2807SJeff Garzik 		mv_dump_mem(hc_base, 0x1c);
933c6fd2807SJeff Garzik 	}
934c6fd2807SJeff Garzik 	for (p = start_port; p < start_port + num_ports; p++) {
935c6fd2807SJeff Garzik 		port_base = mv_port_base(mmio_base, p);
936c6fd2807SJeff Garzik 		DPRINTK("EDMA regs (port %i):\n",p);
937c6fd2807SJeff Garzik 		mv_dump_mem(port_base, 0x54);
938c6fd2807SJeff Garzik 		DPRINTK("SATA regs (port %i):\n",p);
939c6fd2807SJeff Garzik 		mv_dump_mem(port_base+0x300, 0x60);
940c6fd2807SJeff Garzik 	}
941c6fd2807SJeff Garzik #endif
942c6fd2807SJeff Garzik }
943c6fd2807SJeff Garzik 
944c6fd2807SJeff Garzik static unsigned int mv_scr_offset(unsigned int sc_reg_in)
945c6fd2807SJeff Garzik {
946c6fd2807SJeff Garzik 	unsigned int ofs;
947c6fd2807SJeff Garzik 
948c6fd2807SJeff Garzik 	switch (sc_reg_in) {
949c6fd2807SJeff Garzik 	case SCR_STATUS:
950c6fd2807SJeff Garzik 	case SCR_CONTROL:
951c6fd2807SJeff Garzik 	case SCR_ERROR:
952c6fd2807SJeff Garzik 		ofs = SATA_STATUS_OFS + (sc_reg_in * sizeof(u32));
953c6fd2807SJeff Garzik 		break;
954c6fd2807SJeff Garzik 	case SCR_ACTIVE:
955c6fd2807SJeff Garzik 		ofs = SATA_ACTIVE_OFS;   /* active is not with the others */
956c6fd2807SJeff Garzik 		break;
957c6fd2807SJeff Garzik 	default:
958c6fd2807SJeff Garzik 		ofs = 0xffffffffU;
959c6fd2807SJeff Garzik 		break;
960c6fd2807SJeff Garzik 	}
961c6fd2807SJeff Garzik 	return ofs;
962c6fd2807SJeff Garzik }
963c6fd2807SJeff Garzik 
964c6fd2807SJeff Garzik static u32 mv_scr_read(struct ata_port *ap, unsigned int sc_reg_in)
965c6fd2807SJeff Garzik {
966c6fd2807SJeff Garzik 	unsigned int ofs = mv_scr_offset(sc_reg_in);
967c6fd2807SJeff Garzik 
96835177265SJeff Garzik 	if (0xffffffffU != ofs)
969c6fd2807SJeff Garzik 		return readl(mv_ap_base(ap) + ofs);
97035177265SJeff Garzik 	else
971c6fd2807SJeff Garzik 		return (u32) ofs;
972c6fd2807SJeff Garzik }
973c6fd2807SJeff Garzik 
974c6fd2807SJeff Garzik static void mv_scr_write(struct ata_port *ap, unsigned int sc_reg_in, u32 val)
975c6fd2807SJeff Garzik {
976c6fd2807SJeff Garzik 	unsigned int ofs = mv_scr_offset(sc_reg_in);
977c6fd2807SJeff Garzik 
97835177265SJeff Garzik 	if (0xffffffffU != ofs)
979c6fd2807SJeff Garzik 		writelfl(val, mv_ap_base(ap) + ofs);
980c6fd2807SJeff Garzik }
981c6fd2807SJeff Garzik 
982c5d3e45aSJeff Garzik static void mv_edma_cfg(struct ata_port *ap, struct mv_host_priv *hpriv,
983c5d3e45aSJeff Garzik 			void __iomem *port_mmio)
984c6fd2807SJeff Garzik {
985c6fd2807SJeff Garzik 	u32 cfg = readl(port_mmio + EDMA_CFG_OFS);
986c6fd2807SJeff Garzik 
987c6fd2807SJeff Garzik 	/* set up non-NCQ EDMA configuration */
988c5d3e45aSJeff Garzik 	cfg &= ~(1 << 9);	/* disable eQue */
989c6fd2807SJeff Garzik 
990e728eabeSJeff Garzik 	if (IS_GEN_I(hpriv)) {
991e728eabeSJeff Garzik 		cfg &= ~0x1f;		/* clear queue depth */
992c6fd2807SJeff Garzik 		cfg |= (1 << 8);	/* enab config burst size mask */
993e728eabeSJeff Garzik 	}
994c6fd2807SJeff Garzik 
995e728eabeSJeff Garzik 	else if (IS_GEN_II(hpriv)) {
996e728eabeSJeff Garzik 		cfg &= ~0x1f;		/* clear queue depth */
997c6fd2807SJeff Garzik 		cfg |= EDMA_CFG_RD_BRST_EXT | EDMA_CFG_WR_BUFF_LEN;
998e728eabeSJeff Garzik 		cfg &= ~(EDMA_CFG_NCQ | EDMA_CFG_NCQ_GO_ON_ERR); /* clear NCQ */
999e728eabeSJeff Garzik 	}
1000c6fd2807SJeff Garzik 
1001c6fd2807SJeff Garzik 	else if (IS_GEN_IIE(hpriv)) {
1002e728eabeSJeff Garzik 		cfg |= (1 << 23);	/* do not mask PM field in rx'd FIS */
1003e728eabeSJeff Garzik 		cfg |= (1 << 22);	/* enab 4-entry host queue cache */
1004c6fd2807SJeff Garzik 		cfg &= ~(1 << 19);	/* dis 128-entry queue (for now?) */
1005c6fd2807SJeff Garzik 		cfg |= (1 << 18);	/* enab early completion */
1006e728eabeSJeff Garzik 		cfg |= (1 << 17);	/* enab cut-through (dis stor&forwrd) */
1007e728eabeSJeff Garzik 		cfg &= ~(1 << 16);	/* dis FIS-based switching (for now) */
10084537deb5SJeff Garzik 		cfg &= ~(EDMA_CFG_NCQ);	/* clear NCQ */
1009c6fd2807SJeff Garzik 	}
1010c6fd2807SJeff Garzik 
1011c6fd2807SJeff Garzik 	writelfl(cfg, port_mmio + EDMA_CFG_OFS);
1012c6fd2807SJeff Garzik }
1013c6fd2807SJeff Garzik 
1014c6fd2807SJeff Garzik /**
1015c6fd2807SJeff Garzik  *      mv_port_start - Port specific init/start routine.
1016c6fd2807SJeff Garzik  *      @ap: ATA channel to manipulate
1017c6fd2807SJeff Garzik  *
1018c6fd2807SJeff Garzik  *      Allocate and point to DMA memory, init port private memory,
1019c6fd2807SJeff Garzik  *      zero indices.
1020c6fd2807SJeff Garzik  *
1021c6fd2807SJeff Garzik  *      LOCKING:
1022c6fd2807SJeff Garzik  *      Inherited from caller.
1023c6fd2807SJeff Garzik  */
1024c6fd2807SJeff Garzik static int mv_port_start(struct ata_port *ap)
1025c6fd2807SJeff Garzik {
1026cca3974eSJeff Garzik 	struct device *dev = ap->host->dev;
1027cca3974eSJeff Garzik 	struct mv_host_priv *hpriv = ap->host->private_data;
1028c6fd2807SJeff Garzik 	struct mv_port_priv *pp;
1029c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_ap_base(ap);
1030c6fd2807SJeff Garzik 	void *mem;
1031c6fd2807SJeff Garzik 	dma_addr_t mem_dma;
103224dc5f33STejun Heo 	int rc;
1033c6fd2807SJeff Garzik 
103424dc5f33STejun Heo 	pp = devm_kzalloc(dev, sizeof(*pp), GFP_KERNEL);
1035c6fd2807SJeff Garzik 	if (!pp)
103624dc5f33STejun Heo 		return -ENOMEM;
1037c6fd2807SJeff Garzik 
103824dc5f33STejun Heo 	mem = dmam_alloc_coherent(dev, MV_PORT_PRIV_DMA_SZ, &mem_dma,
1039c6fd2807SJeff Garzik 				  GFP_KERNEL);
1040c6fd2807SJeff Garzik 	if (!mem)
104124dc5f33STejun Heo 		return -ENOMEM;
1042c6fd2807SJeff Garzik 	memset(mem, 0, MV_PORT_PRIV_DMA_SZ);
1043c6fd2807SJeff Garzik 
1044c6fd2807SJeff Garzik 	rc = ata_pad_alloc(ap, dev);
1045c6fd2807SJeff Garzik 	if (rc)
104624dc5f33STejun Heo 		return rc;
1047c6fd2807SJeff Garzik 
1048c6fd2807SJeff Garzik 	/* First item in chunk of DMA memory:
1049c6fd2807SJeff Garzik 	 * 32-slot command request table (CRQB), 32 bytes each in size
1050c6fd2807SJeff Garzik 	 */
1051c6fd2807SJeff Garzik 	pp->crqb = mem;
1052c6fd2807SJeff Garzik 	pp->crqb_dma = mem_dma;
1053c6fd2807SJeff Garzik 	mem += MV_CRQB_Q_SZ;
1054c6fd2807SJeff Garzik 	mem_dma += MV_CRQB_Q_SZ;
1055c6fd2807SJeff Garzik 
1056c6fd2807SJeff Garzik 	/* Second item:
1057c6fd2807SJeff Garzik 	 * 32-slot command response table (CRPB), 8 bytes each in size
1058c6fd2807SJeff Garzik 	 */
1059c6fd2807SJeff Garzik 	pp->crpb = mem;
1060c6fd2807SJeff Garzik 	pp->crpb_dma = mem_dma;
1061c6fd2807SJeff Garzik 	mem += MV_CRPB_Q_SZ;
1062c6fd2807SJeff Garzik 	mem_dma += MV_CRPB_Q_SZ;
1063c6fd2807SJeff Garzik 
1064c6fd2807SJeff Garzik 	/* Third item:
1065c6fd2807SJeff Garzik 	 * Table of scatter-gather descriptors (ePRD), 16 bytes each
1066c6fd2807SJeff Garzik 	 */
1067c6fd2807SJeff Garzik 	pp->sg_tbl = mem;
1068c6fd2807SJeff Garzik 	pp->sg_tbl_dma = mem_dma;
1069c6fd2807SJeff Garzik 
1070c5d3e45aSJeff Garzik 	mv_edma_cfg(ap, hpriv, port_mmio);
1071c6fd2807SJeff Garzik 
1072c5d3e45aSJeff Garzik 	mv_set_edma_ptrs(port_mmio, hpriv, pp);
1073c6fd2807SJeff Garzik 
1074c6fd2807SJeff Garzik 	/* Don't turn on EDMA here...do it before DMA commands only.  Else
1075c6fd2807SJeff Garzik 	 * we'll be unable to send non-data, PIO, etc due to restricted access
1076c6fd2807SJeff Garzik 	 * to shadow regs.
1077c6fd2807SJeff Garzik 	 */
1078c6fd2807SJeff Garzik 	ap->private_data = pp;
1079c6fd2807SJeff Garzik 	return 0;
1080c6fd2807SJeff Garzik }
1081c6fd2807SJeff Garzik 
1082c6fd2807SJeff Garzik /**
1083c6fd2807SJeff Garzik  *      mv_port_stop - Port specific cleanup/stop routine.
1084c6fd2807SJeff Garzik  *      @ap: ATA channel to manipulate
1085c6fd2807SJeff Garzik  *
1086c6fd2807SJeff Garzik  *      Stop DMA, cleanup port memory.
1087c6fd2807SJeff Garzik  *
1088c6fd2807SJeff Garzik  *      LOCKING:
1089cca3974eSJeff Garzik  *      This routine uses the host lock to protect the DMA stop.
1090c6fd2807SJeff Garzik  */
1091c6fd2807SJeff Garzik static void mv_port_stop(struct ata_port *ap)
1092c6fd2807SJeff Garzik {
1093c6fd2807SJeff Garzik 	unsigned long flags;
1094c6fd2807SJeff Garzik 
1095cca3974eSJeff Garzik 	spin_lock_irqsave(&ap->host->lock, flags);
1096c6fd2807SJeff Garzik 	mv_stop_dma(ap);
1097cca3974eSJeff Garzik 	spin_unlock_irqrestore(&ap->host->lock, flags);
1098c6fd2807SJeff Garzik }
1099c6fd2807SJeff Garzik 
1100c6fd2807SJeff Garzik /**
1101c6fd2807SJeff Garzik  *      mv_fill_sg - Fill out the Marvell ePRD (scatter gather) entries
1102c6fd2807SJeff Garzik  *      @qc: queued command whose SG list to source from
1103c6fd2807SJeff Garzik  *
1104c6fd2807SJeff Garzik  *      Populate the SG list and mark the last entry.
1105c6fd2807SJeff Garzik  *
1106c6fd2807SJeff Garzik  *      LOCKING:
1107c6fd2807SJeff Garzik  *      Inherited from caller.
1108c6fd2807SJeff Garzik  */
1109d88184fbSJeff Garzik static unsigned int mv_fill_sg(struct ata_queued_cmd *qc)
1110c6fd2807SJeff Garzik {
1111c6fd2807SJeff Garzik 	struct mv_port_priv *pp = qc->ap->private_data;
1112d88184fbSJeff Garzik 	unsigned int n_sg = 0;
1113c6fd2807SJeff Garzik 	struct scatterlist *sg;
1114d88184fbSJeff Garzik 	struct mv_sg *mv_sg;
1115c6fd2807SJeff Garzik 
1116d88184fbSJeff Garzik 	mv_sg = pp->sg_tbl;
1117c6fd2807SJeff Garzik 	ata_for_each_sg(sg, qc) {
1118d88184fbSJeff Garzik 		dma_addr_t addr = sg_dma_address(sg);
1119d88184fbSJeff Garzik 		u32 sg_len = sg_dma_len(sg);
1120c6fd2807SJeff Garzik 
1121d88184fbSJeff Garzik 		mv_sg->addr = cpu_to_le32(addr & 0xffffffff);
1122d88184fbSJeff Garzik 		mv_sg->addr_hi = cpu_to_le32((addr >> 16) >> 16);
1123d88184fbSJeff Garzik 		mv_sg->flags_size = cpu_to_le32(sg_len & 0xffff);
1124c6fd2807SJeff Garzik 
1125d88184fbSJeff Garzik 		if (ata_sg_is_last(sg, qc))
1126d88184fbSJeff Garzik 			mv_sg->flags_size |= cpu_to_le32(EPRD_FLAG_END_OF_TBL);
1127c6fd2807SJeff Garzik 
1128d88184fbSJeff Garzik 		mv_sg++;
1129d88184fbSJeff Garzik 		n_sg++;
1130c6fd2807SJeff Garzik 	}
1131d88184fbSJeff Garzik 
1132d88184fbSJeff Garzik 	return n_sg;
1133c6fd2807SJeff Garzik }
1134c6fd2807SJeff Garzik 
1135c6fd2807SJeff Garzik static inline void mv_crqb_pack_cmd(__le16 *cmdw, u8 data, u8 addr, unsigned last)
1136c6fd2807SJeff Garzik {
1137c6fd2807SJeff Garzik 	u16 tmp = data | (addr << CRQB_CMD_ADDR_SHIFT) | CRQB_CMD_CS |
1138c6fd2807SJeff Garzik 		(last ? CRQB_CMD_LAST : 0);
1139c6fd2807SJeff Garzik 	*cmdw = cpu_to_le16(tmp);
1140c6fd2807SJeff Garzik }
1141c6fd2807SJeff Garzik 
1142c6fd2807SJeff Garzik /**
1143c6fd2807SJeff Garzik  *      mv_qc_prep - Host specific command preparation.
1144c6fd2807SJeff Garzik  *      @qc: queued command to prepare
1145c6fd2807SJeff Garzik  *
1146c6fd2807SJeff Garzik  *      This routine simply redirects to the general purpose routine
1147c6fd2807SJeff Garzik  *      if command is not DMA.  Else, it handles prep of the CRQB
1148c6fd2807SJeff Garzik  *      (command request block), does some sanity checking, and calls
1149c6fd2807SJeff Garzik  *      the SG load routine.
1150c6fd2807SJeff Garzik  *
1151c6fd2807SJeff Garzik  *      LOCKING:
1152c6fd2807SJeff Garzik  *      Inherited from caller.
1153c6fd2807SJeff Garzik  */
1154c6fd2807SJeff Garzik static void mv_qc_prep(struct ata_queued_cmd *qc)
1155c6fd2807SJeff Garzik {
1156c6fd2807SJeff Garzik 	struct ata_port *ap = qc->ap;
1157c6fd2807SJeff Garzik 	struct mv_port_priv *pp = ap->private_data;
1158c6fd2807SJeff Garzik 	__le16 *cw;
1159c6fd2807SJeff Garzik 	struct ata_taskfile *tf;
1160c6fd2807SJeff Garzik 	u16 flags = 0;
1161c6fd2807SJeff Garzik 	unsigned in_index;
1162c6fd2807SJeff Garzik 
1163c5d3e45aSJeff Garzik  	if (qc->tf.protocol != ATA_PROT_DMA)
1164c6fd2807SJeff Garzik 		return;
1165c6fd2807SJeff Garzik 
1166c6fd2807SJeff Garzik 	/* Fill in command request block
1167c6fd2807SJeff Garzik 	 */
1168c6fd2807SJeff Garzik 	if (!(qc->tf.flags & ATA_TFLAG_WRITE))
1169c6fd2807SJeff Garzik 		flags |= CRQB_FLAG_READ;
1170c6fd2807SJeff Garzik 	WARN_ON(MV_MAX_Q_DEPTH <= qc->tag);
1171c6fd2807SJeff Garzik 	flags |= qc->tag << CRQB_TAG_SHIFT;
11724537deb5SJeff Garzik 	flags |= qc->tag << CRQB_IOID_SHIFT;	/* 50xx appears to ignore this*/
1173c6fd2807SJeff Garzik 
1174bdd4dddeSJeff Garzik 	/* get current queue index from software */
1175bdd4dddeSJeff Garzik 	in_index = pp->req_idx & MV_MAX_Q_DEPTH_MASK;
1176c6fd2807SJeff Garzik 
1177c6fd2807SJeff Garzik 	pp->crqb[in_index].sg_addr =
1178c6fd2807SJeff Garzik 		cpu_to_le32(pp->sg_tbl_dma & 0xffffffff);
1179c6fd2807SJeff Garzik 	pp->crqb[in_index].sg_addr_hi =
1180c6fd2807SJeff Garzik 		cpu_to_le32((pp->sg_tbl_dma >> 16) >> 16);
1181c6fd2807SJeff Garzik 	pp->crqb[in_index].ctrl_flags = cpu_to_le16(flags);
1182c6fd2807SJeff Garzik 
1183c6fd2807SJeff Garzik 	cw = &pp->crqb[in_index].ata_cmd[0];
1184c6fd2807SJeff Garzik 	tf = &qc->tf;
1185c6fd2807SJeff Garzik 
1186c6fd2807SJeff Garzik 	/* Sadly, the CRQB cannot accomodate all registers--there are
1187c6fd2807SJeff Garzik 	 * only 11 bytes...so we must pick and choose required
1188c6fd2807SJeff Garzik 	 * registers based on the command.  So, we drop feature and
1189c6fd2807SJeff Garzik 	 * hob_feature for [RW] DMA commands, but they are needed for
1190c6fd2807SJeff Garzik 	 * NCQ.  NCQ will drop hob_nsect.
1191c6fd2807SJeff Garzik 	 */
1192c6fd2807SJeff Garzik 	switch (tf->command) {
1193c6fd2807SJeff Garzik 	case ATA_CMD_READ:
1194c6fd2807SJeff Garzik 	case ATA_CMD_READ_EXT:
1195c6fd2807SJeff Garzik 	case ATA_CMD_WRITE:
1196c6fd2807SJeff Garzik 	case ATA_CMD_WRITE_EXT:
1197c6fd2807SJeff Garzik 	case ATA_CMD_WRITE_FUA_EXT:
1198c6fd2807SJeff Garzik 		mv_crqb_pack_cmd(cw++, tf->hob_nsect, ATA_REG_NSECT, 0);
1199c6fd2807SJeff Garzik 		break;
1200c6fd2807SJeff Garzik #ifdef LIBATA_NCQ		/* FIXME: remove this line when NCQ added */
1201c6fd2807SJeff Garzik 	case ATA_CMD_FPDMA_READ:
1202c6fd2807SJeff Garzik 	case ATA_CMD_FPDMA_WRITE:
1203c6fd2807SJeff Garzik 		mv_crqb_pack_cmd(cw++, tf->hob_feature, ATA_REG_FEATURE, 0);
1204c6fd2807SJeff Garzik 		mv_crqb_pack_cmd(cw++, tf->feature, ATA_REG_FEATURE, 0);
1205c6fd2807SJeff Garzik 		break;
1206c6fd2807SJeff Garzik #endif				/* FIXME: remove this line when NCQ added */
1207c6fd2807SJeff Garzik 	default:
1208c6fd2807SJeff Garzik 		/* The only other commands EDMA supports in non-queued and
1209c6fd2807SJeff Garzik 		 * non-NCQ mode are: [RW] STREAM DMA and W DMA FUA EXT, none
1210c6fd2807SJeff Garzik 		 * of which are defined/used by Linux.  If we get here, this
1211c6fd2807SJeff Garzik 		 * driver needs work.
1212c6fd2807SJeff Garzik 		 *
1213c6fd2807SJeff Garzik 		 * FIXME: modify libata to give qc_prep a return value and
1214c6fd2807SJeff Garzik 		 * return error here.
1215c6fd2807SJeff Garzik 		 */
1216c6fd2807SJeff Garzik 		BUG_ON(tf->command);
1217c6fd2807SJeff Garzik 		break;
1218c6fd2807SJeff Garzik 	}
1219c6fd2807SJeff Garzik 	mv_crqb_pack_cmd(cw++, tf->nsect, ATA_REG_NSECT, 0);
1220c6fd2807SJeff Garzik 	mv_crqb_pack_cmd(cw++, tf->hob_lbal, ATA_REG_LBAL, 0);
1221c6fd2807SJeff Garzik 	mv_crqb_pack_cmd(cw++, tf->lbal, ATA_REG_LBAL, 0);
1222c6fd2807SJeff Garzik 	mv_crqb_pack_cmd(cw++, tf->hob_lbam, ATA_REG_LBAM, 0);
1223c6fd2807SJeff Garzik 	mv_crqb_pack_cmd(cw++, tf->lbam, ATA_REG_LBAM, 0);
1224c6fd2807SJeff Garzik 	mv_crqb_pack_cmd(cw++, tf->hob_lbah, ATA_REG_LBAH, 0);
1225c6fd2807SJeff Garzik 	mv_crqb_pack_cmd(cw++, tf->lbah, ATA_REG_LBAH, 0);
1226c6fd2807SJeff Garzik 	mv_crqb_pack_cmd(cw++, tf->device, ATA_REG_DEVICE, 0);
1227c6fd2807SJeff Garzik 	mv_crqb_pack_cmd(cw++, tf->command, ATA_REG_CMD, 1);	/* last */
1228c6fd2807SJeff Garzik 
1229c6fd2807SJeff Garzik 	if (!(qc->flags & ATA_QCFLAG_DMAMAP))
1230c6fd2807SJeff Garzik 		return;
1231c6fd2807SJeff Garzik 	mv_fill_sg(qc);
1232c6fd2807SJeff Garzik }
1233c6fd2807SJeff Garzik 
1234c6fd2807SJeff Garzik /**
1235c6fd2807SJeff Garzik  *      mv_qc_prep_iie - Host specific command preparation.
1236c6fd2807SJeff Garzik  *      @qc: queued command to prepare
1237c6fd2807SJeff Garzik  *
1238c6fd2807SJeff Garzik  *      This routine simply redirects to the general purpose routine
1239c6fd2807SJeff Garzik  *      if command is not DMA.  Else, it handles prep of the CRQB
1240c6fd2807SJeff Garzik  *      (command request block), does some sanity checking, and calls
1241c6fd2807SJeff Garzik  *      the SG load routine.
1242c6fd2807SJeff Garzik  *
1243c6fd2807SJeff Garzik  *      LOCKING:
1244c6fd2807SJeff Garzik  *      Inherited from caller.
1245c6fd2807SJeff Garzik  */
1246c6fd2807SJeff Garzik static void mv_qc_prep_iie(struct ata_queued_cmd *qc)
1247c6fd2807SJeff Garzik {
1248c6fd2807SJeff Garzik 	struct ata_port *ap = qc->ap;
1249c6fd2807SJeff Garzik 	struct mv_port_priv *pp = ap->private_data;
1250c6fd2807SJeff Garzik 	struct mv_crqb_iie *crqb;
1251c6fd2807SJeff Garzik 	struct ata_taskfile *tf;
1252c6fd2807SJeff Garzik 	unsigned in_index;
1253c6fd2807SJeff Garzik 	u32 flags = 0;
1254c6fd2807SJeff Garzik 
1255c5d3e45aSJeff Garzik  	if (qc->tf.protocol != ATA_PROT_DMA)
1256c6fd2807SJeff Garzik 		return;
1257c6fd2807SJeff Garzik 
1258c6fd2807SJeff Garzik 	/* Fill in Gen IIE command request block
1259c6fd2807SJeff Garzik 	 */
1260c6fd2807SJeff Garzik 	if (!(qc->tf.flags & ATA_TFLAG_WRITE))
1261c6fd2807SJeff Garzik 		flags |= CRQB_FLAG_READ;
1262c6fd2807SJeff Garzik 
1263c6fd2807SJeff Garzik 	WARN_ON(MV_MAX_Q_DEPTH <= qc->tag);
1264c6fd2807SJeff Garzik 	flags |= qc->tag << CRQB_TAG_SHIFT;
12654537deb5SJeff Garzik 	flags |= qc->tag << CRQB_IOID_SHIFT;	/* "I/O Id" is -really-
12664537deb5SJeff Garzik 						   what we use as our tag */
1267c6fd2807SJeff Garzik 
1268bdd4dddeSJeff Garzik 	/* get current queue index from software */
1269bdd4dddeSJeff Garzik 	in_index = pp->req_idx & MV_MAX_Q_DEPTH_MASK;
1270c6fd2807SJeff Garzik 
1271c6fd2807SJeff Garzik 	crqb = (struct mv_crqb_iie *) &pp->crqb[in_index];
1272c6fd2807SJeff Garzik 	crqb->addr = cpu_to_le32(pp->sg_tbl_dma & 0xffffffff);
1273c6fd2807SJeff Garzik 	crqb->addr_hi = cpu_to_le32((pp->sg_tbl_dma >> 16) >> 16);
1274c6fd2807SJeff Garzik 	crqb->flags = cpu_to_le32(flags);
1275c6fd2807SJeff Garzik 
1276c6fd2807SJeff Garzik 	tf = &qc->tf;
1277c6fd2807SJeff Garzik 	crqb->ata_cmd[0] = cpu_to_le32(
1278c6fd2807SJeff Garzik 			(tf->command << 16) |
1279c6fd2807SJeff Garzik 			(tf->feature << 24)
1280c6fd2807SJeff Garzik 		);
1281c6fd2807SJeff Garzik 	crqb->ata_cmd[1] = cpu_to_le32(
1282c6fd2807SJeff Garzik 			(tf->lbal << 0) |
1283c6fd2807SJeff Garzik 			(tf->lbam << 8) |
1284c6fd2807SJeff Garzik 			(tf->lbah << 16) |
1285c6fd2807SJeff Garzik 			(tf->device << 24)
1286c6fd2807SJeff Garzik 		);
1287c6fd2807SJeff Garzik 	crqb->ata_cmd[2] = cpu_to_le32(
1288c6fd2807SJeff Garzik 			(tf->hob_lbal << 0) |
1289c6fd2807SJeff Garzik 			(tf->hob_lbam << 8) |
1290c6fd2807SJeff Garzik 			(tf->hob_lbah << 16) |
1291c6fd2807SJeff Garzik 			(tf->hob_feature << 24)
1292c6fd2807SJeff Garzik 		);
1293c6fd2807SJeff Garzik 	crqb->ata_cmd[3] = cpu_to_le32(
1294c6fd2807SJeff Garzik 			(tf->nsect << 0) |
1295c6fd2807SJeff Garzik 			(tf->hob_nsect << 8)
1296c6fd2807SJeff Garzik 		);
1297c6fd2807SJeff Garzik 
1298c6fd2807SJeff Garzik 	if (!(qc->flags & ATA_QCFLAG_DMAMAP))
1299c6fd2807SJeff Garzik 		return;
1300c6fd2807SJeff Garzik 	mv_fill_sg(qc);
1301c6fd2807SJeff Garzik }
1302c6fd2807SJeff Garzik 
1303c6fd2807SJeff Garzik /**
1304c6fd2807SJeff Garzik  *      mv_qc_issue - Initiate a command to the host
1305c6fd2807SJeff Garzik  *      @qc: queued command to start
1306c6fd2807SJeff Garzik  *
1307c6fd2807SJeff Garzik  *      This routine simply redirects to the general purpose routine
1308c6fd2807SJeff Garzik  *      if command is not DMA.  Else, it sanity checks our local
1309c6fd2807SJeff Garzik  *      caches of the request producer/consumer indices then enables
1310c6fd2807SJeff Garzik  *      DMA and bumps the request producer index.
1311c6fd2807SJeff Garzik  *
1312c6fd2807SJeff Garzik  *      LOCKING:
1313c6fd2807SJeff Garzik  *      Inherited from caller.
1314c6fd2807SJeff Garzik  */
1315c6fd2807SJeff Garzik static unsigned int mv_qc_issue(struct ata_queued_cmd *qc)
1316c6fd2807SJeff Garzik {
1317c5d3e45aSJeff Garzik 	struct ata_port *ap = qc->ap;
1318c5d3e45aSJeff Garzik 	void __iomem *port_mmio = mv_ap_base(ap);
1319c5d3e45aSJeff Garzik 	struct mv_port_priv *pp = ap->private_data;
1320c5d3e45aSJeff Garzik 	struct mv_host_priv *hpriv = ap->host->private_data;
1321bdd4dddeSJeff Garzik 	u32 in_index;
1322c6fd2807SJeff Garzik 
1323c5d3e45aSJeff Garzik 	if (qc->tf.protocol != ATA_PROT_DMA) {
1324c6fd2807SJeff Garzik 		/* We're about to send a non-EDMA capable command to the
1325c6fd2807SJeff Garzik 		 * port.  Turn off EDMA so there won't be problems accessing
1326c6fd2807SJeff Garzik 		 * shadow block, etc registers.
1327c6fd2807SJeff Garzik 		 */
1328c5d3e45aSJeff Garzik 		mv_stop_dma(ap);
1329c6fd2807SJeff Garzik 		return ata_qc_issue_prot(qc);
1330c6fd2807SJeff Garzik 	}
1331c6fd2807SJeff Garzik 
1332bdd4dddeSJeff Garzik 	mv_start_dma(port_mmio, hpriv, pp);
1333bdd4dddeSJeff Garzik 
1334bdd4dddeSJeff Garzik 	in_index = pp->req_idx & MV_MAX_Q_DEPTH_MASK;
1335c6fd2807SJeff Garzik 
1336c6fd2807SJeff Garzik 	/* until we do queuing, the queue should be empty at this point */
1337c6fd2807SJeff Garzik 	WARN_ON(in_index != ((readl(port_mmio + EDMA_REQ_Q_OUT_PTR_OFS)
1338c6fd2807SJeff Garzik 		>> EDMA_REQ_Q_PTR_SHIFT) & MV_MAX_Q_DEPTH_MASK));
1339c6fd2807SJeff Garzik 
1340bdd4dddeSJeff Garzik 	pp->req_idx++;
1341c6fd2807SJeff Garzik 
1342bdd4dddeSJeff Garzik 	in_index = (pp->req_idx & MV_MAX_Q_DEPTH_MASK) << EDMA_REQ_Q_PTR_SHIFT;
1343c6fd2807SJeff Garzik 
1344c6fd2807SJeff Garzik 	/* and write the request in pointer to kick the EDMA to life */
1345bdd4dddeSJeff Garzik 	writelfl((pp->crqb_dma & EDMA_REQ_Q_BASE_LO_MASK) | in_index,
1346bdd4dddeSJeff Garzik 		 port_mmio + EDMA_REQ_Q_IN_PTR_OFS);
1347c6fd2807SJeff Garzik 
1348c6fd2807SJeff Garzik 	return 0;
1349c6fd2807SJeff Garzik }
1350c6fd2807SJeff Garzik 
1351c6fd2807SJeff Garzik /**
1352c6fd2807SJeff Garzik  *      mv_err_intr - Handle error interrupts on the port
1353c6fd2807SJeff Garzik  *      @ap: ATA channel to manipulate
1354c6fd2807SJeff Garzik  *      @reset_allowed: bool: 0 == don't trigger from reset here
1355c6fd2807SJeff Garzik  *
1356c6fd2807SJeff Garzik  *      In most cases, just clear the interrupt and move on.  However,
1357c6fd2807SJeff Garzik  *      some cases require an eDMA reset, which is done right before
1358c6fd2807SJeff Garzik  *      the COMRESET in mv_phy_reset().  The SERR case requires a
1359c6fd2807SJeff Garzik  *      clear of pending errors in the SATA SERROR register.  Finally,
1360c6fd2807SJeff Garzik  *      if the port disabled DMA, update our cached copy to match.
1361c6fd2807SJeff Garzik  *
1362c6fd2807SJeff Garzik  *      LOCKING:
1363c6fd2807SJeff Garzik  *      Inherited from caller.
1364c6fd2807SJeff Garzik  */
1365bdd4dddeSJeff Garzik static void mv_err_intr(struct ata_port *ap, struct ata_queued_cmd *qc)
1366c6fd2807SJeff Garzik {
1367c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_ap_base(ap);
1368bdd4dddeSJeff Garzik 	u32 edma_err_cause, eh_freeze_mask, serr = 0;
1369bdd4dddeSJeff Garzik 	struct mv_port_priv *pp = ap->private_data;
1370bdd4dddeSJeff Garzik 	struct mv_host_priv *hpriv = ap->host->private_data;
1371bdd4dddeSJeff Garzik 	unsigned int edma_enabled = (pp->pp_flags & MV_PP_FLAG_EDMA_EN);
1372bdd4dddeSJeff Garzik 	unsigned int action = 0, err_mask = 0;
1373bdd4dddeSJeff Garzik 	struct ata_eh_info *ehi = &ap->eh_info;
1374c6fd2807SJeff Garzik 
1375bdd4dddeSJeff Garzik 	ata_ehi_clear_desc(ehi);
1376c6fd2807SJeff Garzik 
1377bdd4dddeSJeff Garzik 	if (!edma_enabled) {
1378bdd4dddeSJeff Garzik 		/* just a guess: do we need to do this? should we
1379bdd4dddeSJeff Garzik 		 * expand this, and do it in all cases?
1380bdd4dddeSJeff Garzik 		 */
1381c6fd2807SJeff Garzik 		sata_scr_read(ap, SCR_ERROR, &serr);
1382c6fd2807SJeff Garzik 		sata_scr_write_flush(ap, SCR_ERROR, serr);
1383c6fd2807SJeff Garzik 	}
1384bdd4dddeSJeff Garzik 
1385bdd4dddeSJeff Garzik 	edma_err_cause = readl(port_mmio + EDMA_ERR_IRQ_CAUSE_OFS);
1386bdd4dddeSJeff Garzik 
1387bdd4dddeSJeff Garzik 	ata_ehi_push_desc(ehi, "edma_err 0x%08x", edma_err_cause);
1388bdd4dddeSJeff Garzik 
1389bdd4dddeSJeff Garzik 	/*
1390bdd4dddeSJeff Garzik 	 * all generations share these EDMA error cause bits
1391bdd4dddeSJeff Garzik 	 */
1392bdd4dddeSJeff Garzik 
1393bdd4dddeSJeff Garzik 	if (edma_err_cause & EDMA_ERR_DEV)
1394bdd4dddeSJeff Garzik 		err_mask |= AC_ERR_DEV;
1395bdd4dddeSJeff Garzik 	if (edma_err_cause & (EDMA_ERR_D_PAR | EDMA_ERR_PRD_PAR |
1396bdd4dddeSJeff Garzik 			EDMA_ERR_CRBQ_PAR | EDMA_ERR_CRPB_PAR |
1397bdd4dddeSJeff Garzik 			EDMA_ERR_INTRL_PAR)) {
1398bdd4dddeSJeff Garzik 		err_mask |= AC_ERR_ATA_BUS;
1399bdd4dddeSJeff Garzik 		action |= ATA_EH_HARDRESET;
1400bdd4dddeSJeff Garzik 		ata_ehi_push_desc(ehi, ", parity error");
1401bdd4dddeSJeff Garzik 	}
1402bdd4dddeSJeff Garzik 	if (edma_err_cause & (EDMA_ERR_DEV_DCON | EDMA_ERR_DEV_CON)) {
1403bdd4dddeSJeff Garzik 		ata_ehi_hotplugged(ehi);
1404bdd4dddeSJeff Garzik 		ata_ehi_push_desc(ehi, edma_err_cause & EDMA_ERR_DEV_DCON ?
1405bdd4dddeSJeff Garzik 			", dev disconnect" : ", dev connect");
1406bdd4dddeSJeff Garzik 	}
1407bdd4dddeSJeff Garzik 
1408*ee9ccdf7SJeff Garzik 	if (IS_GEN_I(hpriv)) {
1409bdd4dddeSJeff Garzik 		eh_freeze_mask = EDMA_EH_FREEZE_5;
1410bdd4dddeSJeff Garzik 
1411bdd4dddeSJeff Garzik 		if (edma_err_cause & EDMA_ERR_SELF_DIS_5) {
1412c6fd2807SJeff Garzik 			struct mv_port_priv *pp	= ap->private_data;
1413c6fd2807SJeff Garzik 			pp->pp_flags &= ~MV_PP_FLAG_EDMA_EN;
1414bdd4dddeSJeff Garzik 			ata_ehi_push_desc(ehi, ", EDMA self-disable");
1415c6fd2807SJeff Garzik 		}
1416bdd4dddeSJeff Garzik 	} else {
1417bdd4dddeSJeff Garzik 		eh_freeze_mask = EDMA_EH_FREEZE;
1418bdd4dddeSJeff Garzik 
1419bdd4dddeSJeff Garzik 		if (edma_err_cause & EDMA_ERR_SELF_DIS) {
1420bdd4dddeSJeff Garzik 			struct mv_port_priv *pp	= ap->private_data;
1421bdd4dddeSJeff Garzik 			pp->pp_flags &= ~MV_PP_FLAG_EDMA_EN;
1422bdd4dddeSJeff Garzik 			ata_ehi_push_desc(ehi, ", EDMA self-disable");
1423bdd4dddeSJeff Garzik 		}
1424bdd4dddeSJeff Garzik 
1425bdd4dddeSJeff Garzik 		if (edma_err_cause & EDMA_ERR_SERR) {
1426bdd4dddeSJeff Garzik 			sata_scr_read(ap, SCR_ERROR, &serr);
1427bdd4dddeSJeff Garzik 			sata_scr_write_flush(ap, SCR_ERROR, serr);
1428bdd4dddeSJeff Garzik 			err_mask = AC_ERR_ATA_BUS;
1429bdd4dddeSJeff Garzik 			action |= ATA_EH_HARDRESET;
1430bdd4dddeSJeff Garzik 		}
1431bdd4dddeSJeff Garzik 	}
1432c6fd2807SJeff Garzik 
1433c6fd2807SJeff Garzik 	/* Clear EDMA now that SERR cleanup done */
1434c6fd2807SJeff Garzik 	writelfl(0, port_mmio + EDMA_ERR_IRQ_CAUSE_OFS);
1435c6fd2807SJeff Garzik 
1436bdd4dddeSJeff Garzik 	if (!err_mask) {
1437bdd4dddeSJeff Garzik 		err_mask = AC_ERR_OTHER;
1438bdd4dddeSJeff Garzik 		action |= ATA_EH_HARDRESET;
1439bdd4dddeSJeff Garzik 	}
1440bdd4dddeSJeff Garzik 
1441bdd4dddeSJeff Garzik 	ehi->serror |= serr;
1442bdd4dddeSJeff Garzik 	ehi->action |= action;
1443bdd4dddeSJeff Garzik 
1444bdd4dddeSJeff Garzik 	if (qc)
1445bdd4dddeSJeff Garzik 		qc->err_mask |= err_mask;
1446bdd4dddeSJeff Garzik 	else
1447bdd4dddeSJeff Garzik 		ehi->err_mask |= err_mask;
1448bdd4dddeSJeff Garzik 
1449bdd4dddeSJeff Garzik 	if (edma_err_cause & eh_freeze_mask)
1450bdd4dddeSJeff Garzik 		ata_port_freeze(ap);
1451bdd4dddeSJeff Garzik 	else
1452bdd4dddeSJeff Garzik 		ata_port_abort(ap);
1453bdd4dddeSJeff Garzik }
1454bdd4dddeSJeff Garzik 
1455bdd4dddeSJeff Garzik static void mv_intr_pio(struct ata_port *ap)
1456bdd4dddeSJeff Garzik {
1457bdd4dddeSJeff Garzik 	struct ata_queued_cmd *qc;
1458bdd4dddeSJeff Garzik 	u8 ata_status;
1459bdd4dddeSJeff Garzik 
1460bdd4dddeSJeff Garzik 	/* ignore spurious intr if drive still BUSY */
1461bdd4dddeSJeff Garzik 	ata_status = readb(ap->ioaddr.status_addr);
1462bdd4dddeSJeff Garzik 	if (unlikely(ata_status & ATA_BUSY))
1463bdd4dddeSJeff Garzik 		return;
1464bdd4dddeSJeff Garzik 
1465bdd4dddeSJeff Garzik 	/* get active ATA command */
1466bdd4dddeSJeff Garzik 	qc = ata_qc_from_tag(ap, ap->active_tag);
1467bdd4dddeSJeff Garzik 	if (unlikely(!qc))			/* no active tag */
1468bdd4dddeSJeff Garzik 		return;
1469bdd4dddeSJeff Garzik 	if (qc->tf.flags & ATA_TFLAG_POLLING)	/* polling; we don't own qc */
1470bdd4dddeSJeff Garzik 		return;
1471bdd4dddeSJeff Garzik 
1472bdd4dddeSJeff Garzik 	/* and finally, complete the ATA command */
1473bdd4dddeSJeff Garzik 	qc->err_mask |= ac_err_mask(ata_status);
1474bdd4dddeSJeff Garzik 	ata_qc_complete(qc);
1475bdd4dddeSJeff Garzik }
1476bdd4dddeSJeff Garzik 
1477bdd4dddeSJeff Garzik static void mv_intr_edma(struct ata_port *ap)
1478bdd4dddeSJeff Garzik {
1479bdd4dddeSJeff Garzik 	void __iomem *port_mmio = mv_ap_base(ap);
1480bdd4dddeSJeff Garzik 	struct mv_host_priv *hpriv = ap->host->private_data;
1481bdd4dddeSJeff Garzik 	struct mv_port_priv *pp = ap->private_data;
1482bdd4dddeSJeff Garzik 	struct ata_queued_cmd *qc;
1483bdd4dddeSJeff Garzik 	u32 out_index, in_index;
1484bdd4dddeSJeff Garzik 	bool work_done = false;
1485bdd4dddeSJeff Garzik 
1486bdd4dddeSJeff Garzik 	/* get h/w response queue pointer */
1487bdd4dddeSJeff Garzik 	in_index = (readl(port_mmio + EDMA_RSP_Q_IN_PTR_OFS)
1488bdd4dddeSJeff Garzik 			>> EDMA_RSP_Q_PTR_SHIFT) & MV_MAX_Q_DEPTH_MASK;
1489bdd4dddeSJeff Garzik 
1490bdd4dddeSJeff Garzik 	while (1) {
1491bdd4dddeSJeff Garzik 		u16 status;
1492bdd4dddeSJeff Garzik 
1493bdd4dddeSJeff Garzik 		/* get s/w response queue last-read pointer, and compare */
1494bdd4dddeSJeff Garzik 		out_index = pp->resp_idx & MV_MAX_Q_DEPTH_MASK;
1495bdd4dddeSJeff Garzik 		if (in_index == out_index)
1496bdd4dddeSJeff Garzik 			break;
1497bdd4dddeSJeff Garzik 
1498bdd4dddeSJeff Garzik 
1499bdd4dddeSJeff Garzik 		/* 50xx: get active ATA command */
1500bdd4dddeSJeff Garzik 		if (IS_GEN_I(hpriv))
1501bdd4dddeSJeff Garzik 			qc = ata_qc_from_tag(ap, ap->active_tag);
1502bdd4dddeSJeff Garzik 
1503bdd4dddeSJeff Garzik 		/* 60xx: get active ATA command via tag, to enable support
1504bdd4dddeSJeff Garzik 		 * for queueing.  this works transparently for queued and
1505bdd4dddeSJeff Garzik 		 * non-queued modes.
1506bdd4dddeSJeff Garzik 		 */
1507bdd4dddeSJeff Garzik 		else {
1508bdd4dddeSJeff Garzik 			unsigned int tag;
1509bdd4dddeSJeff Garzik 
1510bdd4dddeSJeff Garzik 			if (IS_GEN_II(hpriv))
1511bdd4dddeSJeff Garzik 				tag = (le16_to_cpu(pp->crpb[out_index].id)
1512bdd4dddeSJeff Garzik 					>> CRPB_IOID_SHIFT_6) & 0x3f;
1513bdd4dddeSJeff Garzik 			else
1514bdd4dddeSJeff Garzik 				tag = (le16_to_cpu(pp->crpb[out_index].id)
1515bdd4dddeSJeff Garzik 					>> CRPB_IOID_SHIFT_7) & 0x3f;
1516bdd4dddeSJeff Garzik 
1517bdd4dddeSJeff Garzik 			qc = ata_qc_from_tag(ap, tag);
1518bdd4dddeSJeff Garzik 		}
1519bdd4dddeSJeff Garzik 
1520bdd4dddeSJeff Garzik 		/* lower 8 bits of status are EDMA_ERR_IRQ_CAUSE_OFS
1521bdd4dddeSJeff Garzik 		 * bits (WARNING: might not necessarily be associated
1522bdd4dddeSJeff Garzik 		 * with this command), which -should- be clear
1523bdd4dddeSJeff Garzik 		 * if all is well
1524bdd4dddeSJeff Garzik 		 */
1525bdd4dddeSJeff Garzik 		status = le16_to_cpu(pp->crpb[out_index].flags);
1526bdd4dddeSJeff Garzik 		if (unlikely(status & 0xff)) {
1527bdd4dddeSJeff Garzik 			mv_err_intr(ap, qc);
1528bdd4dddeSJeff Garzik 			return;
1529bdd4dddeSJeff Garzik 		}
1530bdd4dddeSJeff Garzik 
1531bdd4dddeSJeff Garzik 		/* and finally, complete the ATA command */
1532bdd4dddeSJeff Garzik 		if (qc) {
1533bdd4dddeSJeff Garzik 			qc->err_mask |=
1534bdd4dddeSJeff Garzik 				ac_err_mask(status >> CRPB_FLAG_STATUS_SHIFT);
1535bdd4dddeSJeff Garzik 			ata_qc_complete(qc);
1536bdd4dddeSJeff Garzik 		}
1537bdd4dddeSJeff Garzik 
1538bdd4dddeSJeff Garzik 		/* advance software response queue pointer, to
1539bdd4dddeSJeff Garzik 		 * indicate (after the loop completes) to hardware
1540bdd4dddeSJeff Garzik 		 * that we have consumed a response queue entry.
1541bdd4dddeSJeff Garzik 		 */
1542bdd4dddeSJeff Garzik 		work_done = true;
1543bdd4dddeSJeff Garzik 		pp->resp_idx++;
1544bdd4dddeSJeff Garzik 	}
1545bdd4dddeSJeff Garzik 
1546bdd4dddeSJeff Garzik 	if (work_done)
1547bdd4dddeSJeff Garzik 		writelfl((pp->crpb_dma & EDMA_RSP_Q_BASE_LO_MASK) |
1548bdd4dddeSJeff Garzik 			 (out_index << EDMA_RSP_Q_PTR_SHIFT),
1549bdd4dddeSJeff Garzik 			 port_mmio + EDMA_RSP_Q_OUT_PTR_OFS);
1550c6fd2807SJeff Garzik }
1551c6fd2807SJeff Garzik 
1552c6fd2807SJeff Garzik /**
1553c6fd2807SJeff Garzik  *      mv_host_intr - Handle all interrupts on the given host controller
1554cca3974eSJeff Garzik  *      @host: host specific structure
1555c6fd2807SJeff Garzik  *      @relevant: port error bits relevant to this host controller
1556c6fd2807SJeff Garzik  *      @hc: which host controller we're to look at
1557c6fd2807SJeff Garzik  *
1558c6fd2807SJeff Garzik  *      Read then write clear the HC interrupt status then walk each
1559c6fd2807SJeff Garzik  *      port connected to the HC and see if it needs servicing.  Port
1560c6fd2807SJeff Garzik  *      success ints are reported in the HC interrupt status reg, the
1561c6fd2807SJeff Garzik  *      port error ints are reported in the higher level main
1562c6fd2807SJeff Garzik  *      interrupt status register and thus are passed in via the
1563c6fd2807SJeff Garzik  *      'relevant' argument.
1564c6fd2807SJeff Garzik  *
1565c6fd2807SJeff Garzik  *      LOCKING:
1566c6fd2807SJeff Garzik  *      Inherited from caller.
1567c6fd2807SJeff Garzik  */
1568cca3974eSJeff Garzik static void mv_host_intr(struct ata_host *host, u32 relevant, unsigned int hc)
1569c6fd2807SJeff Garzik {
15700d5ff566STejun Heo 	void __iomem *mmio = host->iomap[MV_PRIMARY_BAR];
1571c6fd2807SJeff Garzik 	void __iomem *hc_mmio = mv_hc_base(mmio, hc);
1572c6fd2807SJeff Garzik 	u32 hc_irq_cause;
1573c5d3e45aSJeff Garzik 	int port, port0;
1574c6fd2807SJeff Garzik 
157535177265SJeff Garzik 	if (hc == 0)
1576c6fd2807SJeff Garzik 		port0 = 0;
157735177265SJeff Garzik 	else
1578c6fd2807SJeff Garzik 		port0 = MV_PORTS_PER_HC;
1579c6fd2807SJeff Garzik 
1580c6fd2807SJeff Garzik 	/* we'll need the HC success int register in most cases */
1581c6fd2807SJeff Garzik 	hc_irq_cause = readl(hc_mmio + HC_IRQ_CAUSE_OFS);
1582bdd4dddeSJeff Garzik 	if (!hc_irq_cause)
1583bdd4dddeSJeff Garzik 		return;
1584bdd4dddeSJeff Garzik 
1585c6fd2807SJeff Garzik 	writelfl(~hc_irq_cause, hc_mmio + HC_IRQ_CAUSE_OFS);
1586c6fd2807SJeff Garzik 
1587c6fd2807SJeff Garzik 	VPRINTK("ENTER, hc%u relevant=0x%08x HC IRQ cause=0x%08x\n",
1588c6fd2807SJeff Garzik 		hc,relevant,hc_irq_cause);
1589c6fd2807SJeff Garzik 
1590c6fd2807SJeff Garzik 	for (port = port0; port < port0 + MV_PORTS_PER_HC; port++) {
1591cca3974eSJeff Garzik 		struct ata_port *ap = host->ports[port];
1592c6fd2807SJeff Garzik 		struct mv_port_priv *pp = ap->private_data;
1593bdd4dddeSJeff Garzik 		int have_err_bits, hard_port, shift;
1594c6fd2807SJeff Garzik 
1595bdd4dddeSJeff Garzik 		if ((!ap) || (ap->flags & ATA_FLAG_DISABLED))
1596c6fd2807SJeff Garzik 			continue;
1597c6fd2807SJeff Garzik 
1598c6fd2807SJeff Garzik 		shift = port << 1;		/* (port * 2) */
1599c6fd2807SJeff Garzik 		if (port >= MV_PORTS_PER_HC) {
1600c6fd2807SJeff Garzik 			shift++;	/* skip bit 8 in the HC Main IRQ reg */
1601c6fd2807SJeff Garzik 		}
1602bdd4dddeSJeff Garzik 		have_err_bits = ((PORT0_ERR << shift) & relevant);
1603bdd4dddeSJeff Garzik 
1604bdd4dddeSJeff Garzik 		if (unlikely(have_err_bits)) {
1605bdd4dddeSJeff Garzik 			struct ata_queued_cmd *qc;
1606bdd4dddeSJeff Garzik 
1607bdd4dddeSJeff Garzik 			qc = ata_qc_from_tag(ap, ap->active_tag);
1608bdd4dddeSJeff Garzik 			if (qc && (qc->tf.flags & ATA_TFLAG_POLLING))
1609bdd4dddeSJeff Garzik 				continue;
1610bdd4dddeSJeff Garzik 
1611bdd4dddeSJeff Garzik 			mv_err_intr(ap, qc);
1612bdd4dddeSJeff Garzik 			continue;
1613c6fd2807SJeff Garzik 		}
1614c6fd2807SJeff Garzik 
1615bdd4dddeSJeff Garzik 		hard_port = mv_hardport_from_port(port); /* range 0..3 */
1616bdd4dddeSJeff Garzik 
1617bdd4dddeSJeff Garzik 		if (pp->pp_flags & MV_PP_FLAG_EDMA_EN) {
1618bdd4dddeSJeff Garzik 			if ((CRPB_DMA_DONE << hard_port) & hc_irq_cause)
1619bdd4dddeSJeff Garzik 				mv_intr_edma(ap);
1620bdd4dddeSJeff Garzik 		} else {
1621bdd4dddeSJeff Garzik 			if ((DEV_IRQ << hard_port) & hc_irq_cause)
1622bdd4dddeSJeff Garzik 				mv_intr_pio(ap);
1623c6fd2807SJeff Garzik 		}
1624c6fd2807SJeff Garzik 	}
1625c6fd2807SJeff Garzik 	VPRINTK("EXIT\n");
1626c6fd2807SJeff Garzik }
1627c6fd2807SJeff Garzik 
1628bdd4dddeSJeff Garzik static void mv_pci_error(struct ata_host *host, void __iomem *mmio)
1629bdd4dddeSJeff Garzik {
1630bdd4dddeSJeff Garzik 	struct ata_port *ap;
1631bdd4dddeSJeff Garzik 	struct ata_queued_cmd *qc;
1632bdd4dddeSJeff Garzik 	struct ata_eh_info *ehi;
1633bdd4dddeSJeff Garzik 	unsigned int i, err_mask, printed = 0;
1634bdd4dddeSJeff Garzik 	u32 err_cause;
1635bdd4dddeSJeff Garzik 
1636bdd4dddeSJeff Garzik 	err_cause = readl(mmio + PCI_IRQ_CAUSE_OFS);
1637bdd4dddeSJeff Garzik 
1638bdd4dddeSJeff Garzik 	dev_printk(KERN_ERR, host->dev, "PCI ERROR; PCI IRQ cause=0x%08x\n",
1639bdd4dddeSJeff Garzik 		   err_cause);
1640bdd4dddeSJeff Garzik 
1641bdd4dddeSJeff Garzik 	DPRINTK("All regs @ PCI error\n");
1642bdd4dddeSJeff Garzik 	mv_dump_all_regs(mmio, -1, to_pci_dev(host->dev));
1643bdd4dddeSJeff Garzik 
1644bdd4dddeSJeff Garzik 	writelfl(0, mmio + PCI_IRQ_CAUSE_OFS);
1645bdd4dddeSJeff Garzik 
1646bdd4dddeSJeff Garzik 	for (i = 0; i < host->n_ports; i++) {
1647bdd4dddeSJeff Garzik 		ap = host->ports[i];
1648bdd4dddeSJeff Garzik 		if (!ata_port_offline(ap)) {
1649bdd4dddeSJeff Garzik 			ehi = &ap->eh_info;
1650bdd4dddeSJeff Garzik 			ata_ehi_clear_desc(ehi);
1651bdd4dddeSJeff Garzik 			if (!printed++)
1652bdd4dddeSJeff Garzik 				ata_ehi_push_desc(ehi,
1653bdd4dddeSJeff Garzik 					"PCI err cause 0x%08x", err_cause);
1654bdd4dddeSJeff Garzik 			err_mask = AC_ERR_HOST_BUS;
1655bdd4dddeSJeff Garzik 			ehi->action = ATA_EH_HARDRESET;
1656bdd4dddeSJeff Garzik 			qc = ata_qc_from_tag(ap, ap->active_tag);
1657bdd4dddeSJeff Garzik 			if (qc)
1658bdd4dddeSJeff Garzik 				qc->err_mask |= err_mask;
1659bdd4dddeSJeff Garzik 			else
1660bdd4dddeSJeff Garzik 				ehi->err_mask |= err_mask;
1661bdd4dddeSJeff Garzik 
1662bdd4dddeSJeff Garzik 			ata_port_freeze(ap);
1663bdd4dddeSJeff Garzik 		}
1664bdd4dddeSJeff Garzik 	}
1665bdd4dddeSJeff Garzik }
1666bdd4dddeSJeff Garzik 
1667c6fd2807SJeff Garzik /**
1668c5d3e45aSJeff Garzik  *      mv_interrupt - Main interrupt event handler
1669c6fd2807SJeff Garzik  *      @irq: unused
1670c6fd2807SJeff Garzik  *      @dev_instance: private data; in this case the host structure
1671c6fd2807SJeff Garzik  *
1672c6fd2807SJeff Garzik  *      Read the read only register to determine if any host
1673c6fd2807SJeff Garzik  *      controllers have pending interrupts.  If so, call lower level
1674c6fd2807SJeff Garzik  *      routine to handle.  Also check for PCI errors which are only
1675c6fd2807SJeff Garzik  *      reported here.
1676c6fd2807SJeff Garzik  *
1677c6fd2807SJeff Garzik  *      LOCKING:
1678cca3974eSJeff Garzik  *      This routine holds the host lock while processing pending
1679c6fd2807SJeff Garzik  *      interrupts.
1680c6fd2807SJeff Garzik  */
16817d12e780SDavid Howells static irqreturn_t mv_interrupt(int irq, void *dev_instance)
1682c6fd2807SJeff Garzik {
1683cca3974eSJeff Garzik 	struct ata_host *host = dev_instance;
1684c6fd2807SJeff Garzik 	unsigned int hc, handled = 0, n_hcs;
16850d5ff566STejun Heo 	void __iomem *mmio = host->iomap[MV_PRIMARY_BAR];
1686c6fd2807SJeff Garzik 	u32 irq_stat;
1687c6fd2807SJeff Garzik 
1688c6fd2807SJeff Garzik 	irq_stat = readl(mmio + HC_MAIN_IRQ_CAUSE_OFS);
1689c6fd2807SJeff Garzik 
1690c6fd2807SJeff Garzik 	/* check the cases where we either have nothing pending or have read
1691c6fd2807SJeff Garzik 	 * a bogus register value which can indicate HW removal or PCI fault
1692c6fd2807SJeff Garzik 	 */
169335177265SJeff Garzik 	if (!irq_stat || (0xffffffffU == irq_stat))
1694c6fd2807SJeff Garzik 		return IRQ_NONE;
1695c6fd2807SJeff Garzik 
1696cca3974eSJeff Garzik 	n_hcs = mv_get_hc_count(host->ports[0]->flags);
1697cca3974eSJeff Garzik 	spin_lock(&host->lock);
1698c6fd2807SJeff Garzik 
1699bdd4dddeSJeff Garzik 	if (unlikely(irq_stat & PCI_ERR)) {
1700bdd4dddeSJeff Garzik 		mv_pci_error(host, mmio);
1701bdd4dddeSJeff Garzik 		handled = 1;
1702bdd4dddeSJeff Garzik 		goto out_unlock;	/* skip all other HC irq handling */
1703bdd4dddeSJeff Garzik 	}
1704bdd4dddeSJeff Garzik 
1705c6fd2807SJeff Garzik 	for (hc = 0; hc < n_hcs; hc++) {
1706c6fd2807SJeff Garzik 		u32 relevant = irq_stat & (HC0_IRQ_PEND << (hc * HC_SHIFT));
1707c6fd2807SJeff Garzik 		if (relevant) {
1708cca3974eSJeff Garzik 			mv_host_intr(host, relevant, hc);
1709bdd4dddeSJeff Garzik 			handled = 1;
1710c6fd2807SJeff Garzik 		}
1711c6fd2807SJeff Garzik 	}
1712c6fd2807SJeff Garzik 
1713bdd4dddeSJeff Garzik out_unlock:
1714cca3974eSJeff Garzik 	spin_unlock(&host->lock);
1715c6fd2807SJeff Garzik 
1716c6fd2807SJeff Garzik 	return IRQ_RETVAL(handled);
1717c6fd2807SJeff Garzik }
1718c6fd2807SJeff Garzik 
1719c6fd2807SJeff Garzik static void __iomem *mv5_phy_base(void __iomem *mmio, unsigned int port)
1720c6fd2807SJeff Garzik {
1721c6fd2807SJeff Garzik 	void __iomem *hc_mmio = mv_hc_base_from_port(mmio, port);
1722c6fd2807SJeff Garzik 	unsigned long ofs = (mv_hardport_from_port(port) + 1) * 0x100UL;
1723c6fd2807SJeff Garzik 
1724c6fd2807SJeff Garzik 	return hc_mmio + ofs;
1725c6fd2807SJeff Garzik }
1726c6fd2807SJeff Garzik 
1727c6fd2807SJeff Garzik static unsigned int mv5_scr_offset(unsigned int sc_reg_in)
1728c6fd2807SJeff Garzik {
1729c6fd2807SJeff Garzik 	unsigned int ofs;
1730c6fd2807SJeff Garzik 
1731c6fd2807SJeff Garzik 	switch (sc_reg_in) {
1732c6fd2807SJeff Garzik 	case SCR_STATUS:
1733c6fd2807SJeff Garzik 	case SCR_ERROR:
1734c6fd2807SJeff Garzik 	case SCR_CONTROL:
1735c6fd2807SJeff Garzik 		ofs = sc_reg_in * sizeof(u32);
1736c6fd2807SJeff Garzik 		break;
1737c6fd2807SJeff Garzik 	default:
1738c6fd2807SJeff Garzik 		ofs = 0xffffffffU;
1739c6fd2807SJeff Garzik 		break;
1740c6fd2807SJeff Garzik 	}
1741c6fd2807SJeff Garzik 	return ofs;
1742c6fd2807SJeff Garzik }
1743c6fd2807SJeff Garzik 
1744c6fd2807SJeff Garzik static u32 mv5_scr_read(struct ata_port *ap, unsigned int sc_reg_in)
1745c6fd2807SJeff Garzik {
17460d5ff566STejun Heo 	void __iomem *mmio = ap->host->iomap[MV_PRIMARY_BAR];
17470d5ff566STejun Heo 	void __iomem *addr = mv5_phy_base(mmio, ap->port_no);
1748c6fd2807SJeff Garzik 	unsigned int ofs = mv5_scr_offset(sc_reg_in);
1749c6fd2807SJeff Garzik 
1750c6fd2807SJeff Garzik 	if (ofs != 0xffffffffU)
17510d5ff566STejun Heo 		return readl(addr + ofs);
1752c6fd2807SJeff Garzik 	else
1753c6fd2807SJeff Garzik 		return (u32) ofs;
1754c6fd2807SJeff Garzik }
1755c6fd2807SJeff Garzik 
1756c6fd2807SJeff Garzik static void mv5_scr_write(struct ata_port *ap, unsigned int sc_reg_in, u32 val)
1757c6fd2807SJeff Garzik {
17580d5ff566STejun Heo 	void __iomem *mmio = ap->host->iomap[MV_PRIMARY_BAR];
17590d5ff566STejun Heo 	void __iomem *addr = mv5_phy_base(mmio, ap->port_no);
1760c6fd2807SJeff Garzik 	unsigned int ofs = mv5_scr_offset(sc_reg_in);
1761c6fd2807SJeff Garzik 
1762c6fd2807SJeff Garzik 	if (ofs != 0xffffffffU)
17630d5ff566STejun Heo 		writelfl(val, addr + ofs);
1764c6fd2807SJeff Garzik }
1765c6fd2807SJeff Garzik 
1766c6fd2807SJeff Garzik static void mv5_reset_bus(struct pci_dev *pdev, void __iomem *mmio)
1767c6fd2807SJeff Garzik {
1768c6fd2807SJeff Garzik 	u8 rev_id;
1769c6fd2807SJeff Garzik 	int early_5080;
1770c6fd2807SJeff Garzik 
1771c6fd2807SJeff Garzik 	pci_read_config_byte(pdev, PCI_REVISION_ID, &rev_id);
1772c6fd2807SJeff Garzik 
1773c6fd2807SJeff Garzik 	early_5080 = (pdev->device == 0x5080) && (rev_id == 0);
1774c6fd2807SJeff Garzik 
1775c6fd2807SJeff Garzik 	if (!early_5080) {
1776c6fd2807SJeff Garzik 		u32 tmp = readl(mmio + MV_PCI_EXP_ROM_BAR_CTL);
1777c6fd2807SJeff Garzik 		tmp |= (1 << 0);
1778c6fd2807SJeff Garzik 		writel(tmp, mmio + MV_PCI_EXP_ROM_BAR_CTL);
1779c6fd2807SJeff Garzik 	}
1780c6fd2807SJeff Garzik 
1781c6fd2807SJeff Garzik 	mv_reset_pci_bus(pdev, mmio);
1782c6fd2807SJeff Garzik }
1783c6fd2807SJeff Garzik 
1784c6fd2807SJeff Garzik static void mv5_reset_flash(struct mv_host_priv *hpriv, void __iomem *mmio)
1785c6fd2807SJeff Garzik {
1786c6fd2807SJeff Garzik 	writel(0x0fcfffff, mmio + MV_FLASH_CTL);
1787c6fd2807SJeff Garzik }
1788c6fd2807SJeff Garzik 
1789c6fd2807SJeff Garzik static void mv5_read_preamp(struct mv_host_priv *hpriv, int idx,
1790c6fd2807SJeff Garzik 			   void __iomem *mmio)
1791c6fd2807SJeff Garzik {
1792c6fd2807SJeff Garzik 	void __iomem *phy_mmio = mv5_phy_base(mmio, idx);
1793c6fd2807SJeff Garzik 	u32 tmp;
1794c6fd2807SJeff Garzik 
1795c6fd2807SJeff Garzik 	tmp = readl(phy_mmio + MV5_PHY_MODE);
1796c6fd2807SJeff Garzik 
1797c6fd2807SJeff Garzik 	hpriv->signal[idx].pre = tmp & 0x1800;	/* bits 12:11 */
1798c6fd2807SJeff Garzik 	hpriv->signal[idx].amps = tmp & 0xe0;	/* bits 7:5 */
1799c6fd2807SJeff Garzik }
1800c6fd2807SJeff Garzik 
1801c6fd2807SJeff Garzik static void mv5_enable_leds(struct mv_host_priv *hpriv, void __iomem *mmio)
1802c6fd2807SJeff Garzik {
1803c6fd2807SJeff Garzik 	u32 tmp;
1804c6fd2807SJeff Garzik 
1805c6fd2807SJeff Garzik 	writel(0, mmio + MV_GPIO_PORT_CTL);
1806c6fd2807SJeff Garzik 
1807c6fd2807SJeff Garzik 	/* FIXME: handle MV_HP_ERRATA_50XXB2 errata */
1808c6fd2807SJeff Garzik 
1809c6fd2807SJeff Garzik 	tmp = readl(mmio + MV_PCI_EXP_ROM_BAR_CTL);
1810c6fd2807SJeff Garzik 	tmp |= ~(1 << 0);
1811c6fd2807SJeff Garzik 	writel(tmp, mmio + MV_PCI_EXP_ROM_BAR_CTL);
1812c6fd2807SJeff Garzik }
1813c6fd2807SJeff Garzik 
1814c6fd2807SJeff Garzik static void mv5_phy_errata(struct mv_host_priv *hpriv, void __iomem *mmio,
1815c6fd2807SJeff Garzik 			   unsigned int port)
1816c6fd2807SJeff Garzik {
1817c6fd2807SJeff Garzik 	void __iomem *phy_mmio = mv5_phy_base(mmio, port);
1818c6fd2807SJeff Garzik 	const u32 mask = (1<<12) | (1<<11) | (1<<7) | (1<<6) | (1<<5);
1819c6fd2807SJeff Garzik 	u32 tmp;
1820c6fd2807SJeff Garzik 	int fix_apm_sq = (hpriv->hp_flags & MV_HP_ERRATA_50XXB0);
1821c6fd2807SJeff Garzik 
1822c6fd2807SJeff Garzik 	if (fix_apm_sq) {
1823c6fd2807SJeff Garzik 		tmp = readl(phy_mmio + MV5_LT_MODE);
1824c6fd2807SJeff Garzik 		tmp |= (1 << 19);
1825c6fd2807SJeff Garzik 		writel(tmp, phy_mmio + MV5_LT_MODE);
1826c6fd2807SJeff Garzik 
1827c6fd2807SJeff Garzik 		tmp = readl(phy_mmio + MV5_PHY_CTL);
1828c6fd2807SJeff Garzik 		tmp &= ~0x3;
1829c6fd2807SJeff Garzik 		tmp |= 0x1;
1830c6fd2807SJeff Garzik 		writel(tmp, phy_mmio + MV5_PHY_CTL);
1831c6fd2807SJeff Garzik 	}
1832c6fd2807SJeff Garzik 
1833c6fd2807SJeff Garzik 	tmp = readl(phy_mmio + MV5_PHY_MODE);
1834c6fd2807SJeff Garzik 	tmp &= ~mask;
1835c6fd2807SJeff Garzik 	tmp |= hpriv->signal[port].pre;
1836c6fd2807SJeff Garzik 	tmp |= hpriv->signal[port].amps;
1837c6fd2807SJeff Garzik 	writel(tmp, phy_mmio + MV5_PHY_MODE);
1838c6fd2807SJeff Garzik }
1839c6fd2807SJeff Garzik 
1840c6fd2807SJeff Garzik 
1841c6fd2807SJeff Garzik #undef ZERO
1842c6fd2807SJeff Garzik #define ZERO(reg) writel(0, port_mmio + (reg))
1843c6fd2807SJeff Garzik static void mv5_reset_hc_port(struct mv_host_priv *hpriv, void __iomem *mmio,
1844c6fd2807SJeff Garzik 			     unsigned int port)
1845c6fd2807SJeff Garzik {
1846c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_port_base(mmio, port);
1847c6fd2807SJeff Garzik 
1848c6fd2807SJeff Garzik 	writelfl(EDMA_DS, port_mmio + EDMA_CMD_OFS);
1849c6fd2807SJeff Garzik 
1850c6fd2807SJeff Garzik 	mv_channel_reset(hpriv, mmio, port);
1851c6fd2807SJeff Garzik 
1852c6fd2807SJeff Garzik 	ZERO(0x028);	/* command */
1853c6fd2807SJeff Garzik 	writel(0x11f, port_mmio + EDMA_CFG_OFS);
1854c6fd2807SJeff Garzik 	ZERO(0x004);	/* timer */
1855c6fd2807SJeff Garzik 	ZERO(0x008);	/* irq err cause */
1856c6fd2807SJeff Garzik 	ZERO(0x00c);	/* irq err mask */
1857c6fd2807SJeff Garzik 	ZERO(0x010);	/* rq bah */
1858c6fd2807SJeff Garzik 	ZERO(0x014);	/* rq inp */
1859c6fd2807SJeff Garzik 	ZERO(0x018);	/* rq outp */
1860c6fd2807SJeff Garzik 	ZERO(0x01c);	/* respq bah */
1861c6fd2807SJeff Garzik 	ZERO(0x024);	/* respq outp */
1862c6fd2807SJeff Garzik 	ZERO(0x020);	/* respq inp */
1863c6fd2807SJeff Garzik 	ZERO(0x02c);	/* test control */
1864c6fd2807SJeff Garzik 	writel(0xbc, port_mmio + EDMA_IORDY_TMOUT);
1865c6fd2807SJeff Garzik }
1866c6fd2807SJeff Garzik #undef ZERO
1867c6fd2807SJeff Garzik 
1868c6fd2807SJeff Garzik #define ZERO(reg) writel(0, hc_mmio + (reg))
1869c6fd2807SJeff Garzik static void mv5_reset_one_hc(struct mv_host_priv *hpriv, void __iomem *mmio,
1870c6fd2807SJeff Garzik 			unsigned int hc)
1871c6fd2807SJeff Garzik {
1872c6fd2807SJeff Garzik 	void __iomem *hc_mmio = mv_hc_base(mmio, hc);
1873c6fd2807SJeff Garzik 	u32 tmp;
1874c6fd2807SJeff Garzik 
1875c6fd2807SJeff Garzik 	ZERO(0x00c);
1876c6fd2807SJeff Garzik 	ZERO(0x010);
1877c6fd2807SJeff Garzik 	ZERO(0x014);
1878c6fd2807SJeff Garzik 	ZERO(0x018);
1879c6fd2807SJeff Garzik 
1880c6fd2807SJeff Garzik 	tmp = readl(hc_mmio + 0x20);
1881c6fd2807SJeff Garzik 	tmp &= 0x1c1c1c1c;
1882c6fd2807SJeff Garzik 	tmp |= 0x03030303;
1883c6fd2807SJeff Garzik 	writel(tmp, hc_mmio + 0x20);
1884c6fd2807SJeff Garzik }
1885c6fd2807SJeff Garzik #undef ZERO
1886c6fd2807SJeff Garzik 
1887c6fd2807SJeff Garzik static int mv5_reset_hc(struct mv_host_priv *hpriv, void __iomem *mmio,
1888c6fd2807SJeff Garzik 			unsigned int n_hc)
1889c6fd2807SJeff Garzik {
1890c6fd2807SJeff Garzik 	unsigned int hc, port;
1891c6fd2807SJeff Garzik 
1892c6fd2807SJeff Garzik 	for (hc = 0; hc < n_hc; hc++) {
1893c6fd2807SJeff Garzik 		for (port = 0; port < MV_PORTS_PER_HC; port++)
1894c6fd2807SJeff Garzik 			mv5_reset_hc_port(hpriv, mmio,
1895c6fd2807SJeff Garzik 					  (hc * MV_PORTS_PER_HC) + port);
1896c6fd2807SJeff Garzik 
1897c6fd2807SJeff Garzik 		mv5_reset_one_hc(hpriv, mmio, hc);
1898c6fd2807SJeff Garzik 	}
1899c6fd2807SJeff Garzik 
1900c6fd2807SJeff Garzik 	return 0;
1901c6fd2807SJeff Garzik }
1902c6fd2807SJeff Garzik 
1903c6fd2807SJeff Garzik #undef ZERO
1904c6fd2807SJeff Garzik #define ZERO(reg) writel(0, mmio + (reg))
1905c6fd2807SJeff Garzik static void mv_reset_pci_bus(struct pci_dev *pdev, void __iomem *mmio)
1906c6fd2807SJeff Garzik {
1907c6fd2807SJeff Garzik 	u32 tmp;
1908c6fd2807SJeff Garzik 
1909c6fd2807SJeff Garzik 	tmp = readl(mmio + MV_PCI_MODE);
1910c6fd2807SJeff Garzik 	tmp &= 0xff00ffff;
1911c6fd2807SJeff Garzik 	writel(tmp, mmio + MV_PCI_MODE);
1912c6fd2807SJeff Garzik 
1913c6fd2807SJeff Garzik 	ZERO(MV_PCI_DISC_TIMER);
1914c6fd2807SJeff Garzik 	ZERO(MV_PCI_MSI_TRIGGER);
1915c6fd2807SJeff Garzik 	writel(0x000100ff, mmio + MV_PCI_XBAR_TMOUT);
1916c6fd2807SJeff Garzik 	ZERO(HC_MAIN_IRQ_MASK_OFS);
1917c6fd2807SJeff Garzik 	ZERO(MV_PCI_SERR_MASK);
1918c6fd2807SJeff Garzik 	ZERO(PCI_IRQ_CAUSE_OFS);
1919c6fd2807SJeff Garzik 	ZERO(PCI_IRQ_MASK_OFS);
1920c6fd2807SJeff Garzik 	ZERO(MV_PCI_ERR_LOW_ADDRESS);
1921c6fd2807SJeff Garzik 	ZERO(MV_PCI_ERR_HIGH_ADDRESS);
1922c6fd2807SJeff Garzik 	ZERO(MV_PCI_ERR_ATTRIBUTE);
1923c6fd2807SJeff Garzik 	ZERO(MV_PCI_ERR_COMMAND);
1924c6fd2807SJeff Garzik }
1925c6fd2807SJeff Garzik #undef ZERO
1926c6fd2807SJeff Garzik 
1927c6fd2807SJeff Garzik static void mv6_reset_flash(struct mv_host_priv *hpriv, void __iomem *mmio)
1928c6fd2807SJeff Garzik {
1929c6fd2807SJeff Garzik 	u32 tmp;
1930c6fd2807SJeff Garzik 
1931c6fd2807SJeff Garzik 	mv5_reset_flash(hpriv, mmio);
1932c6fd2807SJeff Garzik 
1933c6fd2807SJeff Garzik 	tmp = readl(mmio + MV_GPIO_PORT_CTL);
1934c6fd2807SJeff Garzik 	tmp &= 0x3;
1935c6fd2807SJeff Garzik 	tmp |= (1 << 5) | (1 << 6);
1936c6fd2807SJeff Garzik 	writel(tmp, mmio + MV_GPIO_PORT_CTL);
1937c6fd2807SJeff Garzik }
1938c6fd2807SJeff Garzik 
1939c6fd2807SJeff Garzik /**
1940c6fd2807SJeff Garzik  *      mv6_reset_hc - Perform the 6xxx global soft reset
1941c6fd2807SJeff Garzik  *      @mmio: base address of the HBA
1942c6fd2807SJeff Garzik  *
1943c6fd2807SJeff Garzik  *      This routine only applies to 6xxx parts.
1944c6fd2807SJeff Garzik  *
1945c6fd2807SJeff Garzik  *      LOCKING:
1946c6fd2807SJeff Garzik  *      Inherited from caller.
1947c6fd2807SJeff Garzik  */
1948c6fd2807SJeff Garzik static int mv6_reset_hc(struct mv_host_priv *hpriv, void __iomem *mmio,
1949c6fd2807SJeff Garzik 			unsigned int n_hc)
1950c6fd2807SJeff Garzik {
1951c6fd2807SJeff Garzik 	void __iomem *reg = mmio + PCI_MAIN_CMD_STS_OFS;
1952c6fd2807SJeff Garzik 	int i, rc = 0;
1953c6fd2807SJeff Garzik 	u32 t;
1954c6fd2807SJeff Garzik 
1955c6fd2807SJeff Garzik 	/* Following procedure defined in PCI "main command and status
1956c6fd2807SJeff Garzik 	 * register" table.
1957c6fd2807SJeff Garzik 	 */
1958c6fd2807SJeff Garzik 	t = readl(reg);
1959c6fd2807SJeff Garzik 	writel(t | STOP_PCI_MASTER, reg);
1960c6fd2807SJeff Garzik 
1961c6fd2807SJeff Garzik 	for (i = 0; i < 1000; i++) {
1962c6fd2807SJeff Garzik 		udelay(1);
1963c6fd2807SJeff Garzik 		t = readl(reg);
1964c6fd2807SJeff Garzik 		if (PCI_MASTER_EMPTY & t) {
1965c6fd2807SJeff Garzik 			break;
1966c6fd2807SJeff Garzik 		}
1967c6fd2807SJeff Garzik 	}
1968c6fd2807SJeff Garzik 	if (!(PCI_MASTER_EMPTY & t)) {
1969c6fd2807SJeff Garzik 		printk(KERN_ERR DRV_NAME ": PCI master won't flush\n");
1970c6fd2807SJeff Garzik 		rc = 1;
1971c6fd2807SJeff Garzik 		goto done;
1972c6fd2807SJeff Garzik 	}
1973c6fd2807SJeff Garzik 
1974c6fd2807SJeff Garzik 	/* set reset */
1975c6fd2807SJeff Garzik 	i = 5;
1976c6fd2807SJeff Garzik 	do {
1977c6fd2807SJeff Garzik 		writel(t | GLOB_SFT_RST, reg);
1978c6fd2807SJeff Garzik 		t = readl(reg);
1979c6fd2807SJeff Garzik 		udelay(1);
1980c6fd2807SJeff Garzik 	} while (!(GLOB_SFT_RST & t) && (i-- > 0));
1981c6fd2807SJeff Garzik 
1982c6fd2807SJeff Garzik 	if (!(GLOB_SFT_RST & t)) {
1983c6fd2807SJeff Garzik 		printk(KERN_ERR DRV_NAME ": can't set global reset\n");
1984c6fd2807SJeff Garzik 		rc = 1;
1985c6fd2807SJeff Garzik 		goto done;
1986c6fd2807SJeff Garzik 	}
1987c6fd2807SJeff Garzik 
1988c6fd2807SJeff Garzik 	/* clear reset and *reenable the PCI master* (not mentioned in spec) */
1989c6fd2807SJeff Garzik 	i = 5;
1990c6fd2807SJeff Garzik 	do {
1991c6fd2807SJeff Garzik 		writel(t & ~(GLOB_SFT_RST | STOP_PCI_MASTER), reg);
1992c6fd2807SJeff Garzik 		t = readl(reg);
1993c6fd2807SJeff Garzik 		udelay(1);
1994c6fd2807SJeff Garzik 	} while ((GLOB_SFT_RST & t) && (i-- > 0));
1995c6fd2807SJeff Garzik 
1996c6fd2807SJeff Garzik 	if (GLOB_SFT_RST & t) {
1997c6fd2807SJeff Garzik 		printk(KERN_ERR DRV_NAME ": can't clear global reset\n");
1998c6fd2807SJeff Garzik 		rc = 1;
1999c6fd2807SJeff Garzik 	}
2000c6fd2807SJeff Garzik done:
2001c6fd2807SJeff Garzik 	return rc;
2002c6fd2807SJeff Garzik }
2003c6fd2807SJeff Garzik 
2004c6fd2807SJeff Garzik static void mv6_read_preamp(struct mv_host_priv *hpriv, int idx,
2005c6fd2807SJeff Garzik 			   void __iomem *mmio)
2006c6fd2807SJeff Garzik {
2007c6fd2807SJeff Garzik 	void __iomem *port_mmio;
2008c6fd2807SJeff Garzik 	u32 tmp;
2009c6fd2807SJeff Garzik 
2010c6fd2807SJeff Garzik 	tmp = readl(mmio + MV_RESET_CFG);
2011c6fd2807SJeff Garzik 	if ((tmp & (1 << 0)) == 0) {
2012c6fd2807SJeff Garzik 		hpriv->signal[idx].amps = 0x7 << 8;
2013c6fd2807SJeff Garzik 		hpriv->signal[idx].pre = 0x1 << 5;
2014c6fd2807SJeff Garzik 		return;
2015c6fd2807SJeff Garzik 	}
2016c6fd2807SJeff Garzik 
2017c6fd2807SJeff Garzik 	port_mmio = mv_port_base(mmio, idx);
2018c6fd2807SJeff Garzik 	tmp = readl(port_mmio + PHY_MODE2);
2019c6fd2807SJeff Garzik 
2020c6fd2807SJeff Garzik 	hpriv->signal[idx].amps = tmp & 0x700;	/* bits 10:8 */
2021c6fd2807SJeff Garzik 	hpriv->signal[idx].pre = tmp & 0xe0;	/* bits 7:5 */
2022c6fd2807SJeff Garzik }
2023c6fd2807SJeff Garzik 
2024c6fd2807SJeff Garzik static void mv6_enable_leds(struct mv_host_priv *hpriv, void __iomem *mmio)
2025c6fd2807SJeff Garzik {
2026c6fd2807SJeff Garzik 	writel(0x00000060, mmio + MV_GPIO_PORT_CTL);
2027c6fd2807SJeff Garzik }
2028c6fd2807SJeff Garzik 
2029c6fd2807SJeff Garzik static void mv6_phy_errata(struct mv_host_priv *hpriv, void __iomem *mmio,
2030c6fd2807SJeff Garzik 			   unsigned int port)
2031c6fd2807SJeff Garzik {
2032c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_port_base(mmio, port);
2033c6fd2807SJeff Garzik 
2034c6fd2807SJeff Garzik 	u32 hp_flags = hpriv->hp_flags;
2035c6fd2807SJeff Garzik 	int fix_phy_mode2 =
2036c6fd2807SJeff Garzik 		hp_flags & (MV_HP_ERRATA_60X1B2 | MV_HP_ERRATA_60X1C0);
2037c6fd2807SJeff Garzik 	int fix_phy_mode4 =
2038c6fd2807SJeff Garzik 		hp_flags & (MV_HP_ERRATA_60X1B2 | MV_HP_ERRATA_60X1C0);
2039c6fd2807SJeff Garzik 	u32 m2, tmp;
2040c6fd2807SJeff Garzik 
2041c6fd2807SJeff Garzik 	if (fix_phy_mode2) {
2042c6fd2807SJeff Garzik 		m2 = readl(port_mmio + PHY_MODE2);
2043c6fd2807SJeff Garzik 		m2 &= ~(1 << 16);
2044c6fd2807SJeff Garzik 		m2 |= (1 << 31);
2045c6fd2807SJeff Garzik 		writel(m2, port_mmio + PHY_MODE2);
2046c6fd2807SJeff Garzik 
2047c6fd2807SJeff Garzik 		udelay(200);
2048c6fd2807SJeff Garzik 
2049c6fd2807SJeff Garzik 		m2 = readl(port_mmio + PHY_MODE2);
2050c6fd2807SJeff Garzik 		m2 &= ~((1 << 16) | (1 << 31));
2051c6fd2807SJeff Garzik 		writel(m2, port_mmio + PHY_MODE2);
2052c6fd2807SJeff Garzik 
2053c6fd2807SJeff Garzik 		udelay(200);
2054c6fd2807SJeff Garzik 	}
2055c6fd2807SJeff Garzik 
2056c6fd2807SJeff Garzik 	/* who knows what this magic does */
2057c6fd2807SJeff Garzik 	tmp = readl(port_mmio + PHY_MODE3);
2058c6fd2807SJeff Garzik 	tmp &= ~0x7F800000;
2059c6fd2807SJeff Garzik 	tmp |= 0x2A800000;
2060c6fd2807SJeff Garzik 	writel(tmp, port_mmio + PHY_MODE3);
2061c6fd2807SJeff Garzik 
2062c6fd2807SJeff Garzik 	if (fix_phy_mode4) {
2063c6fd2807SJeff Garzik 		u32 m4;
2064c6fd2807SJeff Garzik 
2065c6fd2807SJeff Garzik 		m4 = readl(port_mmio + PHY_MODE4);
2066c6fd2807SJeff Garzik 
2067c6fd2807SJeff Garzik 		if (hp_flags & MV_HP_ERRATA_60X1B2)
2068c6fd2807SJeff Garzik 			tmp = readl(port_mmio + 0x310);
2069c6fd2807SJeff Garzik 
2070c6fd2807SJeff Garzik 		m4 = (m4 & ~(1 << 1)) | (1 << 0);
2071c6fd2807SJeff Garzik 
2072c6fd2807SJeff Garzik 		writel(m4, port_mmio + PHY_MODE4);
2073c6fd2807SJeff Garzik 
2074c6fd2807SJeff Garzik 		if (hp_flags & MV_HP_ERRATA_60X1B2)
2075c6fd2807SJeff Garzik 			writel(tmp, port_mmio + 0x310);
2076c6fd2807SJeff Garzik 	}
2077c6fd2807SJeff Garzik 
2078c6fd2807SJeff Garzik 	/* Revert values of pre-emphasis and signal amps to the saved ones */
2079c6fd2807SJeff Garzik 	m2 = readl(port_mmio + PHY_MODE2);
2080c6fd2807SJeff Garzik 
2081c6fd2807SJeff Garzik 	m2 &= ~MV_M2_PREAMP_MASK;
2082c6fd2807SJeff Garzik 	m2 |= hpriv->signal[port].amps;
2083c6fd2807SJeff Garzik 	m2 |= hpriv->signal[port].pre;
2084c6fd2807SJeff Garzik 	m2 &= ~(1 << 16);
2085c6fd2807SJeff Garzik 
2086c6fd2807SJeff Garzik 	/* according to mvSata 3.6.1, some IIE values are fixed */
2087c6fd2807SJeff Garzik 	if (IS_GEN_IIE(hpriv)) {
2088c6fd2807SJeff Garzik 		m2 &= ~0xC30FF01F;
2089c6fd2807SJeff Garzik 		m2 |= 0x0000900F;
2090c6fd2807SJeff Garzik 	}
2091c6fd2807SJeff Garzik 
2092c6fd2807SJeff Garzik 	writel(m2, port_mmio + PHY_MODE2);
2093c6fd2807SJeff Garzik }
2094c6fd2807SJeff Garzik 
2095c6fd2807SJeff Garzik static void mv_channel_reset(struct mv_host_priv *hpriv, void __iomem *mmio,
2096c6fd2807SJeff Garzik 			     unsigned int port_no)
2097c6fd2807SJeff Garzik {
2098c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_port_base(mmio, port_no);
2099c6fd2807SJeff Garzik 
2100c6fd2807SJeff Garzik 	writelfl(ATA_RST, port_mmio + EDMA_CMD_OFS);
2101c6fd2807SJeff Garzik 
2102*ee9ccdf7SJeff Garzik 	if (IS_GEN_II(hpriv)) {
2103c6fd2807SJeff Garzik 		u32 ifctl = readl(port_mmio + SATA_INTERFACE_CTL);
2104c6fd2807SJeff Garzik 		ifctl |= (1 << 7);		/* enable gen2i speed */
2105c6fd2807SJeff Garzik 		ifctl = (ifctl & 0xfff) | 0x9b1000; /* from chip spec */
2106c6fd2807SJeff Garzik 		writelfl(ifctl, port_mmio + SATA_INTERFACE_CTL);
2107c6fd2807SJeff Garzik 	}
2108c6fd2807SJeff Garzik 
2109c6fd2807SJeff Garzik 	udelay(25);		/* allow reset propagation */
2110c6fd2807SJeff Garzik 
2111c6fd2807SJeff Garzik 	/* Spec never mentions clearing the bit.  Marvell's driver does
2112c6fd2807SJeff Garzik 	 * clear the bit, however.
2113c6fd2807SJeff Garzik 	 */
2114c6fd2807SJeff Garzik 	writelfl(0, port_mmio + EDMA_CMD_OFS);
2115c6fd2807SJeff Garzik 
2116c6fd2807SJeff Garzik 	hpriv->ops->phy_errata(hpriv, mmio, port_no);
2117c6fd2807SJeff Garzik 
2118*ee9ccdf7SJeff Garzik 	if (IS_GEN_I(hpriv))
2119c6fd2807SJeff Garzik 		mdelay(1);
2120c6fd2807SJeff Garzik }
2121c6fd2807SJeff Garzik 
2122c6fd2807SJeff Garzik /**
2123bdd4dddeSJeff Garzik  *      mv_phy_reset - Perform eDMA reset followed by COMRESET
2124c6fd2807SJeff Garzik  *      @ap: ATA channel to manipulate
2125c6fd2807SJeff Garzik  *
2126c6fd2807SJeff Garzik  *      Part of this is taken from __sata_phy_reset and modified to
2127c6fd2807SJeff Garzik  *      not sleep since this routine gets called from interrupt level.
2128c6fd2807SJeff Garzik  *
2129c6fd2807SJeff Garzik  *      LOCKING:
2130c6fd2807SJeff Garzik  *      Inherited from caller.  This is coded to safe to call at
2131c6fd2807SJeff Garzik  *      interrupt level, i.e. it does not sleep.
2132c6fd2807SJeff Garzik  */
2133bdd4dddeSJeff Garzik static void mv_phy_reset(struct ata_port *ap, unsigned int *class,
2134bdd4dddeSJeff Garzik 			 unsigned long deadline)
2135c6fd2807SJeff Garzik {
2136c6fd2807SJeff Garzik 	struct mv_port_priv *pp	= ap->private_data;
2137cca3974eSJeff Garzik 	struct mv_host_priv *hpriv = ap->host->private_data;
2138c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_ap_base(ap);
2139c6fd2807SJeff Garzik 	int retry = 5;
2140c6fd2807SJeff Garzik 	u32 sstatus;
2141c6fd2807SJeff Garzik 
2142c6fd2807SJeff Garzik 	VPRINTK("ENTER, port %u, mmio 0x%p\n", ap->port_no, port_mmio);
2143c6fd2807SJeff Garzik 
2144c6fd2807SJeff Garzik 	DPRINTK("S-regs after ATA_RST: SStat 0x%08x SErr 0x%08x "
2145c6fd2807SJeff Garzik 		"SCtrl 0x%08x\n", mv_scr_read(ap, SCR_STATUS),
2146c6fd2807SJeff Garzik 		mv_scr_read(ap, SCR_ERROR), mv_scr_read(ap, SCR_CONTROL));
2147c6fd2807SJeff Garzik 
2148c6fd2807SJeff Garzik 	/* Issue COMRESET via SControl */
2149c6fd2807SJeff Garzik comreset_retry:
2150c6fd2807SJeff Garzik 	sata_scr_write_flush(ap, SCR_CONTROL, 0x301);
2151bdd4dddeSJeff Garzik 	msleep(1);
2152c6fd2807SJeff Garzik 
2153c6fd2807SJeff Garzik 	sata_scr_write_flush(ap, SCR_CONTROL, 0x300);
2154bdd4dddeSJeff Garzik 	msleep(20);
2155c6fd2807SJeff Garzik 
2156c6fd2807SJeff Garzik 	do {
2157c6fd2807SJeff Garzik 		sata_scr_read(ap, SCR_STATUS, &sstatus);
2158dd1dc802SJeff Garzik 		if (((sstatus & 0x3) == 3) || ((sstatus & 0x3) == 0))
2159c6fd2807SJeff Garzik 			break;
2160c6fd2807SJeff Garzik 
2161bdd4dddeSJeff Garzik 		msleep(1);
2162c5d3e45aSJeff Garzik 	} while (time_before(jiffies, deadline));
2163c6fd2807SJeff Garzik 
2164c6fd2807SJeff Garzik 	/* work around errata */
2165*ee9ccdf7SJeff Garzik 	if (IS_GEN_II(hpriv) &&
2166c6fd2807SJeff Garzik 	    (sstatus != 0x0) && (sstatus != 0x113) && (sstatus != 0x123) &&
2167c6fd2807SJeff Garzik 	    (retry-- > 0))
2168c6fd2807SJeff Garzik 		goto comreset_retry;
2169c6fd2807SJeff Garzik 
2170c6fd2807SJeff Garzik 	DPRINTK("S-regs after PHY wake: SStat 0x%08x SErr 0x%08x "
2171c6fd2807SJeff Garzik 		"SCtrl 0x%08x\n", mv_scr_read(ap, SCR_STATUS),
2172c6fd2807SJeff Garzik 		mv_scr_read(ap, SCR_ERROR), mv_scr_read(ap, SCR_CONTROL));
2173c6fd2807SJeff Garzik 
2174bdd4dddeSJeff Garzik 	if (ata_port_offline(ap)) {
2175bdd4dddeSJeff Garzik 		*class = ATA_DEV_NONE;
2176c6fd2807SJeff Garzik 		return;
2177c6fd2807SJeff Garzik 	}
2178c6fd2807SJeff Garzik 
2179c6fd2807SJeff Garzik 	/* even after SStatus reflects that device is ready,
2180c6fd2807SJeff Garzik 	 * it seems to take a while for link to be fully
2181c6fd2807SJeff Garzik 	 * established (and thus Status no longer 0x80/0x7F),
2182c6fd2807SJeff Garzik 	 * so we poll a bit for that, here.
2183c6fd2807SJeff Garzik 	 */
2184c6fd2807SJeff Garzik 	retry = 20;
2185c6fd2807SJeff Garzik 	while (1) {
2186c6fd2807SJeff Garzik 		u8 drv_stat = ata_check_status(ap);
2187c6fd2807SJeff Garzik 		if ((drv_stat != 0x80) && (drv_stat != 0x7f))
2188c6fd2807SJeff Garzik 			break;
2189bdd4dddeSJeff Garzik 		msleep(500);
2190c6fd2807SJeff Garzik 		if (retry-- <= 0)
2191c6fd2807SJeff Garzik 			break;
2192bdd4dddeSJeff Garzik 		if (time_after(jiffies, deadline))
2193bdd4dddeSJeff Garzik 			break;
2194c6fd2807SJeff Garzik 	}
2195c6fd2807SJeff Garzik 
2196bdd4dddeSJeff Garzik 	/* FIXME: if we passed the deadline, the following
2197bdd4dddeSJeff Garzik 	 * code probably produces an invalid result
2198bdd4dddeSJeff Garzik 	 */
2199c6fd2807SJeff Garzik 
2200bdd4dddeSJeff Garzik 	/* finally, read device signature from TF registers */
2201bdd4dddeSJeff Garzik 	*class = ata_dev_try_classify(ap, 0, NULL);
2202c6fd2807SJeff Garzik 
2203c6fd2807SJeff Garzik 	writelfl(0, port_mmio + EDMA_ERR_IRQ_CAUSE_OFS);
2204c6fd2807SJeff Garzik 
2205bdd4dddeSJeff Garzik 	WARN_ON(pp->pp_flags & MV_PP_FLAG_EDMA_EN);
2206c6fd2807SJeff Garzik 
2207c6fd2807SJeff Garzik 	VPRINTK("EXIT\n");
2208c6fd2807SJeff Garzik }
2209c6fd2807SJeff Garzik 
2210bdd4dddeSJeff Garzik static int mv_prereset(struct ata_port *ap, unsigned long deadline)
2211c6fd2807SJeff Garzik {
2212bdd4dddeSJeff Garzik 	struct mv_port_priv *pp	= ap->private_data;
2213bdd4dddeSJeff Garzik 	struct ata_eh_context *ehc = &ap->eh_context;
2214bdd4dddeSJeff Garzik 	int rc;
2215bdd4dddeSJeff Garzik 
2216bdd4dddeSJeff Garzik 	rc = mv_stop_dma(ap);
2217bdd4dddeSJeff Garzik 	if (rc)
2218bdd4dddeSJeff Garzik 		ehc->i.action |= ATA_EH_HARDRESET;
2219bdd4dddeSJeff Garzik 
2220bdd4dddeSJeff Garzik 	if (!(pp->pp_flags & MV_PP_FLAG_HAD_A_RESET)) {
2221bdd4dddeSJeff Garzik 		pp->pp_flags |= MV_PP_FLAG_HAD_A_RESET;
2222bdd4dddeSJeff Garzik 		ehc->i.action |= ATA_EH_HARDRESET;
2223c6fd2807SJeff Garzik 	}
2224c6fd2807SJeff Garzik 
2225bdd4dddeSJeff Garzik 	/* if we're about to do hardreset, nothing more to do */
2226bdd4dddeSJeff Garzik 	if (ehc->i.action & ATA_EH_HARDRESET)
2227bdd4dddeSJeff Garzik 		return 0;
2228bdd4dddeSJeff Garzik 
2229bdd4dddeSJeff Garzik 	if (ata_port_online(ap))
2230bdd4dddeSJeff Garzik 		rc = ata_wait_ready(ap, deadline);
2231bdd4dddeSJeff Garzik 	else
2232bdd4dddeSJeff Garzik 		rc = -ENODEV;
2233bdd4dddeSJeff Garzik 
2234bdd4dddeSJeff Garzik 	return rc;
2235bdd4dddeSJeff Garzik }
2236bdd4dddeSJeff Garzik 
2237bdd4dddeSJeff Garzik static int mv_hardreset(struct ata_port *ap, unsigned int *class,
2238bdd4dddeSJeff Garzik 			unsigned long deadline)
2239bdd4dddeSJeff Garzik {
2240bdd4dddeSJeff Garzik 	struct mv_host_priv *hpriv = ap->host->private_data;
2241bdd4dddeSJeff Garzik 	void __iomem *mmio = ap->host->iomap[MV_PRIMARY_BAR];
2242bdd4dddeSJeff Garzik 
2243bdd4dddeSJeff Garzik 	mv_stop_dma(ap);
2244bdd4dddeSJeff Garzik 
2245bdd4dddeSJeff Garzik 	mv_channel_reset(hpriv, mmio, ap->port_no);
2246bdd4dddeSJeff Garzik 
2247bdd4dddeSJeff Garzik 	mv_phy_reset(ap, class, deadline);
2248bdd4dddeSJeff Garzik 
2249bdd4dddeSJeff Garzik 	return 0;
2250bdd4dddeSJeff Garzik }
2251bdd4dddeSJeff Garzik 
2252bdd4dddeSJeff Garzik static void mv_postreset(struct ata_port *ap, unsigned int *classes)
2253bdd4dddeSJeff Garzik {
2254bdd4dddeSJeff Garzik 	u32 serr;
2255bdd4dddeSJeff Garzik 
2256bdd4dddeSJeff Garzik 	/* print link status */
2257bdd4dddeSJeff Garzik 	sata_print_link_status(ap);
2258bdd4dddeSJeff Garzik 
2259bdd4dddeSJeff Garzik 	/* clear SError */
2260bdd4dddeSJeff Garzik 	sata_scr_read(ap, SCR_ERROR, &serr);
2261bdd4dddeSJeff Garzik 	sata_scr_write_flush(ap, SCR_ERROR, serr);
2262bdd4dddeSJeff Garzik 
2263bdd4dddeSJeff Garzik 	/* bail out if no device is present */
2264bdd4dddeSJeff Garzik 	if (classes[0] == ATA_DEV_NONE && classes[1] == ATA_DEV_NONE) {
2265bdd4dddeSJeff Garzik 		DPRINTK("EXIT, no device\n");
2266bdd4dddeSJeff Garzik 		return;
2267bdd4dddeSJeff Garzik 	}
2268bdd4dddeSJeff Garzik 
2269bdd4dddeSJeff Garzik 	/* set up device control */
2270bdd4dddeSJeff Garzik 	iowrite8(ap->ctl, ap->ioaddr.ctl_addr);
2271bdd4dddeSJeff Garzik }
2272bdd4dddeSJeff Garzik 
2273bdd4dddeSJeff Garzik static void mv_error_handler(struct ata_port *ap)
2274bdd4dddeSJeff Garzik {
2275bdd4dddeSJeff Garzik 	ata_do_eh(ap, mv_prereset, ata_std_softreset,
2276bdd4dddeSJeff Garzik 		  mv_hardreset, mv_postreset);
2277bdd4dddeSJeff Garzik }
2278bdd4dddeSJeff Garzik 
2279bdd4dddeSJeff Garzik static void mv_post_int_cmd(struct ata_queued_cmd *qc)
2280bdd4dddeSJeff Garzik {
2281bdd4dddeSJeff Garzik 	mv_stop_dma(qc->ap);
2282bdd4dddeSJeff Garzik }
2283bdd4dddeSJeff Garzik 
2284bdd4dddeSJeff Garzik static void mv_eh_freeze(struct ata_port *ap)
2285c6fd2807SJeff Garzik {
22860d5ff566STejun Heo 	void __iomem *mmio = ap->host->iomap[MV_PRIMARY_BAR];
2287bdd4dddeSJeff Garzik 	unsigned int hc = (ap->port_no > 3) ? 1 : 0;
2288bdd4dddeSJeff Garzik 	u32 tmp, mask;
2289bdd4dddeSJeff Garzik 	unsigned int shift;
2290c6fd2807SJeff Garzik 
2291bdd4dddeSJeff Garzik 	/* FIXME: handle coalescing completion events properly */
2292c6fd2807SJeff Garzik 
2293bdd4dddeSJeff Garzik 	shift = ap->port_no * 2;
2294bdd4dddeSJeff Garzik 	if (hc > 0)
2295bdd4dddeSJeff Garzik 		shift++;
2296c6fd2807SJeff Garzik 
2297bdd4dddeSJeff Garzik 	mask = 0x3 << shift;
2298c6fd2807SJeff Garzik 
2299bdd4dddeSJeff Garzik 	/* disable assertion of portN err, done events */
2300bdd4dddeSJeff Garzik 	tmp = readl(mmio + HC_MAIN_IRQ_MASK_OFS);
2301bdd4dddeSJeff Garzik 	writelfl(tmp & ~mask, mmio + HC_MAIN_IRQ_MASK_OFS);
2302c6fd2807SJeff Garzik }
2303bdd4dddeSJeff Garzik 
2304bdd4dddeSJeff Garzik static void mv_eh_thaw(struct ata_port *ap)
2305bdd4dddeSJeff Garzik {
2306bdd4dddeSJeff Garzik 	void __iomem *mmio = ap->host->iomap[MV_PRIMARY_BAR];
2307bdd4dddeSJeff Garzik 	unsigned int hc = (ap->port_no > 3) ? 1 : 0;
2308bdd4dddeSJeff Garzik 	void __iomem *hc_mmio = mv_hc_base(mmio, hc);
2309bdd4dddeSJeff Garzik 	void __iomem *port_mmio = mv_ap_base(ap);
2310bdd4dddeSJeff Garzik 	u32 tmp, mask, hc_irq_cause;
2311bdd4dddeSJeff Garzik 	unsigned int shift, hc_port_no = ap->port_no;
2312bdd4dddeSJeff Garzik 
2313bdd4dddeSJeff Garzik 	/* FIXME: handle coalescing completion events properly */
2314bdd4dddeSJeff Garzik 
2315bdd4dddeSJeff Garzik 	shift = ap->port_no * 2;
2316bdd4dddeSJeff Garzik 	if (hc > 0) {
2317bdd4dddeSJeff Garzik 		shift++;
2318bdd4dddeSJeff Garzik 		hc_port_no -= 4;
2319bdd4dddeSJeff Garzik 	}
2320bdd4dddeSJeff Garzik 
2321bdd4dddeSJeff Garzik 	mask = 0x3 << shift;
2322bdd4dddeSJeff Garzik 
2323bdd4dddeSJeff Garzik 	/* clear EDMA errors on this port */
2324bdd4dddeSJeff Garzik 	writel(0, port_mmio + EDMA_ERR_IRQ_CAUSE_OFS);
2325bdd4dddeSJeff Garzik 
2326bdd4dddeSJeff Garzik 	/* clear pending irq events */
2327bdd4dddeSJeff Garzik 	hc_irq_cause = readl(hc_mmio + HC_IRQ_CAUSE_OFS);
2328bdd4dddeSJeff Garzik 	hc_irq_cause &= ~(1 << hc_port_no);	/* clear CRPB-done */
2329bdd4dddeSJeff Garzik 	hc_irq_cause &= ~(1 << (hc_port_no + 8)); /* clear Device int */
2330bdd4dddeSJeff Garzik 	writel(hc_irq_cause, hc_mmio + HC_IRQ_CAUSE_OFS);
2331bdd4dddeSJeff Garzik 
2332bdd4dddeSJeff Garzik 	/* enable assertion of portN err, done events */
2333bdd4dddeSJeff Garzik 	tmp = readl(mmio + HC_MAIN_IRQ_MASK_OFS);
2334bdd4dddeSJeff Garzik 	writelfl(tmp | mask, mmio + HC_MAIN_IRQ_MASK_OFS);
2335c6fd2807SJeff Garzik }
2336c6fd2807SJeff Garzik 
2337c6fd2807SJeff Garzik /**
2338c6fd2807SJeff Garzik  *      mv_port_init - Perform some early initialization on a single port.
2339c6fd2807SJeff Garzik  *      @port: libata data structure storing shadow register addresses
2340c6fd2807SJeff Garzik  *      @port_mmio: base address of the port
2341c6fd2807SJeff Garzik  *
2342c6fd2807SJeff Garzik  *      Initialize shadow register mmio addresses, clear outstanding
2343c6fd2807SJeff Garzik  *      interrupts on the port, and unmask interrupts for the future
2344c6fd2807SJeff Garzik  *      start of the port.
2345c6fd2807SJeff Garzik  *
2346c6fd2807SJeff Garzik  *      LOCKING:
2347c6fd2807SJeff Garzik  *      Inherited from caller.
2348c6fd2807SJeff Garzik  */
2349c6fd2807SJeff Garzik static void mv_port_init(struct ata_ioports *port,  void __iomem *port_mmio)
2350c6fd2807SJeff Garzik {
23510d5ff566STejun Heo 	void __iomem *shd_base = port_mmio + SHD_BLK_OFS;
2352c6fd2807SJeff Garzik 	unsigned serr_ofs;
2353c6fd2807SJeff Garzik 
2354c6fd2807SJeff Garzik 	/* PIO related setup
2355c6fd2807SJeff Garzik 	 */
2356c6fd2807SJeff Garzik 	port->data_addr = shd_base + (sizeof(u32) * ATA_REG_DATA);
2357c6fd2807SJeff Garzik 	port->error_addr =
2358c6fd2807SJeff Garzik 		port->feature_addr = shd_base + (sizeof(u32) * ATA_REG_ERR);
2359c6fd2807SJeff Garzik 	port->nsect_addr = shd_base + (sizeof(u32) * ATA_REG_NSECT);
2360c6fd2807SJeff Garzik 	port->lbal_addr = shd_base + (sizeof(u32) * ATA_REG_LBAL);
2361c6fd2807SJeff Garzik 	port->lbam_addr = shd_base + (sizeof(u32) * ATA_REG_LBAM);
2362c6fd2807SJeff Garzik 	port->lbah_addr = shd_base + (sizeof(u32) * ATA_REG_LBAH);
2363c6fd2807SJeff Garzik 	port->device_addr = shd_base + (sizeof(u32) * ATA_REG_DEVICE);
2364c6fd2807SJeff Garzik 	port->status_addr =
2365c6fd2807SJeff Garzik 		port->command_addr = shd_base + (sizeof(u32) * ATA_REG_STATUS);
2366c6fd2807SJeff Garzik 	/* special case: control/altstatus doesn't have ATA_REG_ address */
2367c6fd2807SJeff Garzik 	port->altstatus_addr = port->ctl_addr = shd_base + SHD_CTL_AST_OFS;
2368c6fd2807SJeff Garzik 
2369c6fd2807SJeff Garzik 	/* unused: */
23708d9db2d2SRandy Dunlap 	port->cmd_addr = port->bmdma_addr = port->scr_addr = NULL;
2371c6fd2807SJeff Garzik 
2372c6fd2807SJeff Garzik 	/* Clear any currently outstanding port interrupt conditions */
2373c6fd2807SJeff Garzik 	serr_ofs = mv_scr_offset(SCR_ERROR);
2374c6fd2807SJeff Garzik 	writelfl(readl(port_mmio + serr_ofs), port_mmio + serr_ofs);
2375c6fd2807SJeff Garzik 	writelfl(0, port_mmio + EDMA_ERR_IRQ_CAUSE_OFS);
2376c6fd2807SJeff Garzik 
2377c6fd2807SJeff Garzik 	/* unmask all EDMA error interrupts */
2378c6fd2807SJeff Garzik 	writelfl(~0, port_mmio + EDMA_ERR_IRQ_MASK_OFS);
2379c6fd2807SJeff Garzik 
2380c6fd2807SJeff Garzik 	VPRINTK("EDMA cfg=0x%08x EDMA IRQ err cause/mask=0x%08x/0x%08x\n",
2381c6fd2807SJeff Garzik 		readl(port_mmio + EDMA_CFG_OFS),
2382c6fd2807SJeff Garzik 		readl(port_mmio + EDMA_ERR_IRQ_CAUSE_OFS),
2383c6fd2807SJeff Garzik 		readl(port_mmio + EDMA_ERR_IRQ_MASK_OFS));
2384c6fd2807SJeff Garzik }
2385c6fd2807SJeff Garzik 
23864447d351STejun Heo static int mv_chip_id(struct ata_host *host, unsigned int board_idx)
2387c6fd2807SJeff Garzik {
23884447d351STejun Heo 	struct pci_dev *pdev = to_pci_dev(host->dev);
23894447d351STejun Heo 	struct mv_host_priv *hpriv = host->private_data;
2390c6fd2807SJeff Garzik 	u8 rev_id;
2391c6fd2807SJeff Garzik 	u32 hp_flags = hpriv->hp_flags;
2392c6fd2807SJeff Garzik 
2393c6fd2807SJeff Garzik 	pci_read_config_byte(pdev, PCI_REVISION_ID, &rev_id);
2394c6fd2807SJeff Garzik 
2395c6fd2807SJeff Garzik 	switch(board_idx) {
2396c6fd2807SJeff Garzik 	case chip_5080:
2397c6fd2807SJeff Garzik 		hpriv->ops = &mv5xxx_ops;
2398*ee9ccdf7SJeff Garzik 		hp_flags |= MV_HP_GEN_I;
2399c6fd2807SJeff Garzik 
2400c6fd2807SJeff Garzik 		switch (rev_id) {
2401c6fd2807SJeff Garzik 		case 0x1:
2402c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB0;
2403c6fd2807SJeff Garzik 			break;
2404c6fd2807SJeff Garzik 		case 0x3:
2405c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB2;
2406c6fd2807SJeff Garzik 			break;
2407c6fd2807SJeff Garzik 		default:
2408c6fd2807SJeff Garzik 			dev_printk(KERN_WARNING, &pdev->dev,
2409c6fd2807SJeff Garzik 			   "Applying 50XXB2 workarounds to unknown rev\n");
2410c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB2;
2411c6fd2807SJeff Garzik 			break;
2412c6fd2807SJeff Garzik 		}
2413c6fd2807SJeff Garzik 		break;
2414c6fd2807SJeff Garzik 
2415c6fd2807SJeff Garzik 	case chip_504x:
2416c6fd2807SJeff Garzik 	case chip_508x:
2417c6fd2807SJeff Garzik 		hpriv->ops = &mv5xxx_ops;
2418*ee9ccdf7SJeff Garzik 		hp_flags |= MV_HP_GEN_I;
2419c6fd2807SJeff Garzik 
2420c6fd2807SJeff Garzik 		switch (rev_id) {
2421c6fd2807SJeff Garzik 		case 0x0:
2422c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB0;
2423c6fd2807SJeff Garzik 			break;
2424c6fd2807SJeff Garzik 		case 0x3:
2425c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB2;
2426c6fd2807SJeff Garzik 			break;
2427c6fd2807SJeff Garzik 		default:
2428c6fd2807SJeff Garzik 			dev_printk(KERN_WARNING, &pdev->dev,
2429c6fd2807SJeff Garzik 			   "Applying B2 workarounds to unknown rev\n");
2430c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB2;
2431c6fd2807SJeff Garzik 			break;
2432c6fd2807SJeff Garzik 		}
2433c6fd2807SJeff Garzik 		break;
2434c6fd2807SJeff Garzik 
2435c6fd2807SJeff Garzik 	case chip_604x:
2436c6fd2807SJeff Garzik 	case chip_608x:
2437c6fd2807SJeff Garzik 		hpriv->ops = &mv6xxx_ops;
2438*ee9ccdf7SJeff Garzik 		hp_flags |= MV_HP_GEN_II;
2439c6fd2807SJeff Garzik 
2440c6fd2807SJeff Garzik 		switch (rev_id) {
2441c6fd2807SJeff Garzik 		case 0x7:
2442c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_60X1B2;
2443c6fd2807SJeff Garzik 			break;
2444c6fd2807SJeff Garzik 		case 0x9:
2445c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_60X1C0;
2446c6fd2807SJeff Garzik 			break;
2447c6fd2807SJeff Garzik 		default:
2448c6fd2807SJeff Garzik 			dev_printk(KERN_WARNING, &pdev->dev,
2449c6fd2807SJeff Garzik 				   "Applying B2 workarounds to unknown rev\n");
2450c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_60X1B2;
2451c6fd2807SJeff Garzik 			break;
2452c6fd2807SJeff Garzik 		}
2453c6fd2807SJeff Garzik 		break;
2454c6fd2807SJeff Garzik 
2455c6fd2807SJeff Garzik 	case chip_7042:
2456c6fd2807SJeff Garzik 	case chip_6042:
2457c6fd2807SJeff Garzik 		hpriv->ops = &mv6xxx_ops;
2458c6fd2807SJeff Garzik 		hp_flags |= MV_HP_GEN_IIE;
2459c6fd2807SJeff Garzik 
2460c6fd2807SJeff Garzik 		switch (rev_id) {
2461c6fd2807SJeff Garzik 		case 0x0:
2462c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_XX42A0;
2463c6fd2807SJeff Garzik 			break;
2464c6fd2807SJeff Garzik 		case 0x1:
2465c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_60X1C0;
2466c6fd2807SJeff Garzik 			break;
2467c6fd2807SJeff Garzik 		default:
2468c6fd2807SJeff Garzik 			dev_printk(KERN_WARNING, &pdev->dev,
2469c6fd2807SJeff Garzik 			   "Applying 60X1C0 workarounds to unknown rev\n");
2470c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_60X1C0;
2471c6fd2807SJeff Garzik 			break;
2472c6fd2807SJeff Garzik 		}
2473c6fd2807SJeff Garzik 		break;
2474c6fd2807SJeff Garzik 
2475c6fd2807SJeff Garzik 	default:
2476c6fd2807SJeff Garzik 		printk(KERN_ERR DRV_NAME ": BUG: invalid board index %u\n", board_idx);
2477c6fd2807SJeff Garzik 		return 1;
2478c6fd2807SJeff Garzik 	}
2479c6fd2807SJeff Garzik 
2480c6fd2807SJeff Garzik 	hpriv->hp_flags = hp_flags;
2481c6fd2807SJeff Garzik 
2482c6fd2807SJeff Garzik 	return 0;
2483c6fd2807SJeff Garzik }
2484c6fd2807SJeff Garzik 
2485c6fd2807SJeff Garzik /**
2486c6fd2807SJeff Garzik  *      mv_init_host - Perform some early initialization of the host.
24874447d351STejun Heo  *	@host: ATA host to initialize
24884447d351STejun Heo  *      @board_idx: controller index
2489c6fd2807SJeff Garzik  *
2490c6fd2807SJeff Garzik  *      If possible, do an early global reset of the host.  Then do
2491c6fd2807SJeff Garzik  *      our port init and clear/unmask all/relevant host interrupts.
2492c6fd2807SJeff Garzik  *
2493c6fd2807SJeff Garzik  *      LOCKING:
2494c6fd2807SJeff Garzik  *      Inherited from caller.
2495c6fd2807SJeff Garzik  */
24964447d351STejun Heo static int mv_init_host(struct ata_host *host, unsigned int board_idx)
2497c6fd2807SJeff Garzik {
2498c6fd2807SJeff Garzik 	int rc = 0, n_hc, port, hc;
24994447d351STejun Heo 	struct pci_dev *pdev = to_pci_dev(host->dev);
25004447d351STejun Heo 	void __iomem *mmio = host->iomap[MV_PRIMARY_BAR];
25014447d351STejun Heo 	struct mv_host_priv *hpriv = host->private_data;
2502c6fd2807SJeff Garzik 
2503c6fd2807SJeff Garzik 	/* global interrupt mask */
2504c6fd2807SJeff Garzik 	writel(0, mmio + HC_MAIN_IRQ_MASK_OFS);
2505c6fd2807SJeff Garzik 
25064447d351STejun Heo 	rc = mv_chip_id(host, board_idx);
2507c6fd2807SJeff Garzik 	if (rc)
2508c6fd2807SJeff Garzik 		goto done;
2509c6fd2807SJeff Garzik 
25104447d351STejun Heo 	n_hc = mv_get_hc_count(host->ports[0]->flags);
2511c6fd2807SJeff Garzik 
25124447d351STejun Heo 	for (port = 0; port < host->n_ports; port++)
2513c6fd2807SJeff Garzik 		hpriv->ops->read_preamp(hpriv, port, mmio);
2514c6fd2807SJeff Garzik 
2515c6fd2807SJeff Garzik 	rc = hpriv->ops->reset_hc(hpriv, mmio, n_hc);
2516c6fd2807SJeff Garzik 	if (rc)
2517c6fd2807SJeff Garzik 		goto done;
2518c6fd2807SJeff Garzik 
2519c6fd2807SJeff Garzik 	hpriv->ops->reset_flash(hpriv, mmio);
2520c6fd2807SJeff Garzik 	hpriv->ops->reset_bus(pdev, mmio);
2521c6fd2807SJeff Garzik 	hpriv->ops->enable_leds(hpriv, mmio);
2522c6fd2807SJeff Garzik 
25234447d351STejun Heo 	for (port = 0; port < host->n_ports; port++) {
2524*ee9ccdf7SJeff Garzik 		if (IS_GEN_II(hpriv)) {
2525c6fd2807SJeff Garzik 			void __iomem *port_mmio = mv_port_base(mmio, port);
2526c6fd2807SJeff Garzik 
2527c6fd2807SJeff Garzik 			u32 ifctl = readl(port_mmio + SATA_INTERFACE_CTL);
2528c6fd2807SJeff Garzik 			ifctl |= (1 << 7);		/* enable gen2i speed */
2529c6fd2807SJeff Garzik 			ifctl = (ifctl & 0xfff) | 0x9b1000; /* from chip spec */
2530c6fd2807SJeff Garzik 			writelfl(ifctl, port_mmio + SATA_INTERFACE_CTL);
2531c6fd2807SJeff Garzik 		}
2532c6fd2807SJeff Garzik 
2533c6fd2807SJeff Garzik 		hpriv->ops->phy_errata(hpriv, mmio, port);
2534c6fd2807SJeff Garzik 	}
2535c6fd2807SJeff Garzik 
25364447d351STejun Heo 	for (port = 0; port < host->n_ports; port++) {
2537c6fd2807SJeff Garzik 		void __iomem *port_mmio = mv_port_base(mmio, port);
25384447d351STejun Heo 		mv_port_init(&host->ports[port]->ioaddr, port_mmio);
2539c6fd2807SJeff Garzik 	}
2540c6fd2807SJeff Garzik 
2541c6fd2807SJeff Garzik 	for (hc = 0; hc < n_hc; hc++) {
2542c6fd2807SJeff Garzik 		void __iomem *hc_mmio = mv_hc_base(mmio, hc);
2543c6fd2807SJeff Garzik 
2544c6fd2807SJeff Garzik 		VPRINTK("HC%i: HC config=0x%08x HC IRQ cause "
2545c6fd2807SJeff Garzik 			"(before clear)=0x%08x\n", hc,
2546c6fd2807SJeff Garzik 			readl(hc_mmio + HC_CFG_OFS),
2547c6fd2807SJeff Garzik 			readl(hc_mmio + HC_IRQ_CAUSE_OFS));
2548c6fd2807SJeff Garzik 
2549c6fd2807SJeff Garzik 		/* Clear any currently outstanding hc interrupt conditions */
2550c6fd2807SJeff Garzik 		writelfl(0, hc_mmio + HC_IRQ_CAUSE_OFS);
2551c6fd2807SJeff Garzik 	}
2552c6fd2807SJeff Garzik 
2553c6fd2807SJeff Garzik 	/* Clear any currently outstanding host interrupt conditions */
2554c6fd2807SJeff Garzik 	writelfl(0, mmio + PCI_IRQ_CAUSE_OFS);
2555c6fd2807SJeff Garzik 
2556c6fd2807SJeff Garzik 	/* and unmask interrupt generation for host regs */
2557c6fd2807SJeff Garzik 	writelfl(PCI_UNMASK_ALL_IRQS, mmio + PCI_IRQ_MASK_OFS);
2558fb621e2fSJeff Garzik 
2559*ee9ccdf7SJeff Garzik 	if (IS_GEN_I(hpriv))
2560fb621e2fSJeff Garzik 		writelfl(~HC_MAIN_MASKED_IRQS_5, mmio + HC_MAIN_IRQ_MASK_OFS);
2561fb621e2fSJeff Garzik 	else
2562c6fd2807SJeff Garzik 		writelfl(~HC_MAIN_MASKED_IRQS, mmio + HC_MAIN_IRQ_MASK_OFS);
2563c6fd2807SJeff Garzik 
2564c6fd2807SJeff Garzik 	VPRINTK("HC MAIN IRQ cause/mask=0x%08x/0x%08x "
2565c6fd2807SJeff Garzik 		"PCI int cause/mask=0x%08x/0x%08x\n",
2566c6fd2807SJeff Garzik 		readl(mmio + HC_MAIN_IRQ_CAUSE_OFS),
2567c6fd2807SJeff Garzik 		readl(mmio + HC_MAIN_IRQ_MASK_OFS),
2568c6fd2807SJeff Garzik 		readl(mmio + PCI_IRQ_CAUSE_OFS),
2569c6fd2807SJeff Garzik 		readl(mmio + PCI_IRQ_MASK_OFS));
2570c6fd2807SJeff Garzik 
2571c6fd2807SJeff Garzik done:
2572c6fd2807SJeff Garzik 	return rc;
2573c6fd2807SJeff Garzik }
2574c6fd2807SJeff Garzik 
2575c6fd2807SJeff Garzik /**
2576c6fd2807SJeff Garzik  *      mv_print_info - Dump key info to kernel log for perusal.
25774447d351STejun Heo  *      @host: ATA host to print info about
2578c6fd2807SJeff Garzik  *
2579c6fd2807SJeff Garzik  *      FIXME: complete this.
2580c6fd2807SJeff Garzik  *
2581c6fd2807SJeff Garzik  *      LOCKING:
2582c6fd2807SJeff Garzik  *      Inherited from caller.
2583c6fd2807SJeff Garzik  */
25844447d351STejun Heo static void mv_print_info(struct ata_host *host)
2585c6fd2807SJeff Garzik {
25864447d351STejun Heo 	struct pci_dev *pdev = to_pci_dev(host->dev);
25874447d351STejun Heo 	struct mv_host_priv *hpriv = host->private_data;
2588c6fd2807SJeff Garzik 	u8 rev_id, scc;
2589c1e4fe71SJeff Garzik 	const char *scc_s, *gen;
2590c6fd2807SJeff Garzik 
2591c6fd2807SJeff Garzik 	/* Use this to determine the HW stepping of the chip so we know
2592c6fd2807SJeff Garzik 	 * what errata to workaround
2593c6fd2807SJeff Garzik 	 */
2594c6fd2807SJeff Garzik 	pci_read_config_byte(pdev, PCI_REVISION_ID, &rev_id);
2595c6fd2807SJeff Garzik 
2596c6fd2807SJeff Garzik 	pci_read_config_byte(pdev, PCI_CLASS_DEVICE, &scc);
2597c6fd2807SJeff Garzik 	if (scc == 0)
2598c6fd2807SJeff Garzik 		scc_s = "SCSI";
2599c6fd2807SJeff Garzik 	else if (scc == 0x01)
2600c6fd2807SJeff Garzik 		scc_s = "RAID";
2601c6fd2807SJeff Garzik 	else
2602c1e4fe71SJeff Garzik 		scc_s = "?";
2603c1e4fe71SJeff Garzik 
2604c1e4fe71SJeff Garzik 	if (IS_GEN_I(hpriv))
2605c1e4fe71SJeff Garzik 		gen = "I";
2606c1e4fe71SJeff Garzik 	else if (IS_GEN_II(hpriv))
2607c1e4fe71SJeff Garzik 		gen = "II";
2608c1e4fe71SJeff Garzik 	else if (IS_GEN_IIE(hpriv))
2609c1e4fe71SJeff Garzik 		gen = "IIE";
2610c1e4fe71SJeff Garzik 	else
2611c1e4fe71SJeff Garzik 		gen = "?";
2612c6fd2807SJeff Garzik 
2613c6fd2807SJeff Garzik 	dev_printk(KERN_INFO, &pdev->dev,
2614c1e4fe71SJeff Garzik 	       "Gen-%s %u slots %u ports %s mode IRQ via %s\n",
2615c1e4fe71SJeff Garzik 	       gen, (unsigned)MV_MAX_Q_DEPTH, host->n_ports,
2616c6fd2807SJeff Garzik 	       scc_s, (MV_HP_FLAG_MSI & hpriv->hp_flags) ? "MSI" : "INTx");
2617c6fd2807SJeff Garzik }
2618c6fd2807SJeff Garzik 
2619c6fd2807SJeff Garzik /**
2620c6fd2807SJeff Garzik  *      mv_init_one - handle a positive probe of a Marvell host
2621c6fd2807SJeff Garzik  *      @pdev: PCI device found
2622c6fd2807SJeff Garzik  *      @ent: PCI device ID entry for the matched host
2623c6fd2807SJeff Garzik  *
2624c6fd2807SJeff Garzik  *      LOCKING:
2625c6fd2807SJeff Garzik  *      Inherited from caller.
2626c6fd2807SJeff Garzik  */
2627c6fd2807SJeff Garzik static int mv_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
2628c6fd2807SJeff Garzik {
2629c6fd2807SJeff Garzik 	static int printed_version = 0;
2630c6fd2807SJeff Garzik 	unsigned int board_idx = (unsigned int)ent->driver_data;
26314447d351STejun Heo 	const struct ata_port_info *ppi[] = { &mv_port_info[board_idx], NULL };
26324447d351STejun Heo 	struct ata_host *host;
26334447d351STejun Heo 	struct mv_host_priv *hpriv;
26344447d351STejun Heo 	int n_ports, rc;
2635c6fd2807SJeff Garzik 
2636c6fd2807SJeff Garzik 	if (!printed_version++)
2637c6fd2807SJeff Garzik 		dev_printk(KERN_INFO, &pdev->dev, "version " DRV_VERSION "\n");
2638c6fd2807SJeff Garzik 
26394447d351STejun Heo 	/* allocate host */
26404447d351STejun Heo 	n_ports = mv_get_hc_count(ppi[0]->flags) * MV_PORTS_PER_HC;
26414447d351STejun Heo 
26424447d351STejun Heo 	host = ata_host_alloc_pinfo(&pdev->dev, ppi, n_ports);
26434447d351STejun Heo 	hpriv = devm_kzalloc(&pdev->dev, sizeof(*hpriv), GFP_KERNEL);
26444447d351STejun Heo 	if (!host || !hpriv)
26454447d351STejun Heo 		return -ENOMEM;
26464447d351STejun Heo 	host->private_data = hpriv;
26474447d351STejun Heo 
26484447d351STejun Heo 	/* acquire resources */
264924dc5f33STejun Heo 	rc = pcim_enable_device(pdev);
265024dc5f33STejun Heo 	if (rc)
2651c6fd2807SJeff Garzik 		return rc;
2652c6fd2807SJeff Garzik 
26530d5ff566STejun Heo 	rc = pcim_iomap_regions(pdev, 1 << MV_PRIMARY_BAR, DRV_NAME);
26540d5ff566STejun Heo 	if (rc == -EBUSY)
265524dc5f33STejun Heo 		pcim_pin_device(pdev);
26560d5ff566STejun Heo 	if (rc)
265724dc5f33STejun Heo 		return rc;
26584447d351STejun Heo 	host->iomap = pcim_iomap_table(pdev);
2659c6fd2807SJeff Garzik 
2660d88184fbSJeff Garzik 	rc = pci_go_64(pdev);
2661d88184fbSJeff Garzik 	if (rc)
2662d88184fbSJeff Garzik 		return rc;
2663d88184fbSJeff Garzik 
2664c6fd2807SJeff Garzik 	/* initialize adapter */
26654447d351STejun Heo 	rc = mv_init_host(host, board_idx);
266624dc5f33STejun Heo 	if (rc)
266724dc5f33STejun Heo 		return rc;
2668c6fd2807SJeff Garzik 
2669c6fd2807SJeff Garzik 	/* Enable interrupts */
26706a59dcf8STejun Heo 	if (msi && pci_enable_msi(pdev))
2671c6fd2807SJeff Garzik 		pci_intx(pdev, 1);
2672c6fd2807SJeff Garzik 
2673c6fd2807SJeff Garzik 	mv_dump_pci_cfg(pdev, 0x68);
26744447d351STejun Heo 	mv_print_info(host);
2675c6fd2807SJeff Garzik 
26764447d351STejun Heo 	pci_set_master(pdev);
26774537deb5SJeff Garzik 	pci_set_mwi(pdev);
26784447d351STejun Heo 	return ata_host_activate(host, pdev->irq, mv_interrupt, IRQF_SHARED,
2679c5d3e45aSJeff Garzik 				 IS_GEN_I(hpriv) ? &mv5_sht : &mv6_sht);
2680c6fd2807SJeff Garzik }
2681c6fd2807SJeff Garzik 
2682c6fd2807SJeff Garzik static int __init mv_init(void)
2683c6fd2807SJeff Garzik {
2684c6fd2807SJeff Garzik 	return pci_register_driver(&mv_pci_driver);
2685c6fd2807SJeff Garzik }
2686c6fd2807SJeff Garzik 
2687c6fd2807SJeff Garzik static void __exit mv_exit(void)
2688c6fd2807SJeff Garzik {
2689c6fd2807SJeff Garzik 	pci_unregister_driver(&mv_pci_driver);
2690c6fd2807SJeff Garzik }
2691c6fd2807SJeff Garzik 
2692c6fd2807SJeff Garzik MODULE_AUTHOR("Brett Russ");
2693c6fd2807SJeff Garzik MODULE_DESCRIPTION("SCSI low-level driver for Marvell SATA controllers");
2694c6fd2807SJeff Garzik MODULE_LICENSE("GPL");
2695c6fd2807SJeff Garzik MODULE_DEVICE_TABLE(pci, mv_pci_tbl);
2696c6fd2807SJeff Garzik MODULE_VERSION(DRV_VERSION);
2697c6fd2807SJeff Garzik 
2698c6fd2807SJeff Garzik module_param(msi, int, 0444);
2699c6fd2807SJeff Garzik MODULE_PARM_DESC(msi, "Enable use of PCI MSI (0=off, 1=on)");
2700c6fd2807SJeff Garzik 
2701c6fd2807SJeff Garzik module_init(mv_init);
2702c6fd2807SJeff Garzik module_exit(mv_exit);
2703