xref: /openbmc/linux/drivers/ata/sata_mv.c (revision ea8b4db97aa41a66c05daa4055a1974692ccd52d)
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),
304ee9ccdf7SJeff Garzik 	MV_HP_GEN_I		= (1 << 6),
305ee9ccdf7SJeff Garzik 	MV_HP_GEN_II		= (1 << 7),
306ee9ccdf7SJeff 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 
314ee9ccdf7SJeff Garzik #define IS_GEN_I(hpriv) ((hpriv)->hp_flags & MV_HP_GEN_I)
315ee9ccdf7SJeff 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 
1408ee9ccdf7SJeff 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 	int early_5080;
1769c6fd2807SJeff Garzik 
177044c10138SAuke Kok 	early_5080 = (pdev->device == 0x5080) && (pdev->revision == 0);
1771c6fd2807SJeff Garzik 
1772c6fd2807SJeff Garzik 	if (!early_5080) {
1773c6fd2807SJeff Garzik 		u32 tmp = readl(mmio + MV_PCI_EXP_ROM_BAR_CTL);
1774c6fd2807SJeff Garzik 		tmp |= (1 << 0);
1775c6fd2807SJeff Garzik 		writel(tmp, mmio + MV_PCI_EXP_ROM_BAR_CTL);
1776c6fd2807SJeff Garzik 	}
1777c6fd2807SJeff Garzik 
1778c6fd2807SJeff Garzik 	mv_reset_pci_bus(pdev, mmio);
1779c6fd2807SJeff Garzik }
1780c6fd2807SJeff Garzik 
1781c6fd2807SJeff Garzik static void mv5_reset_flash(struct mv_host_priv *hpriv, void __iomem *mmio)
1782c6fd2807SJeff Garzik {
1783c6fd2807SJeff Garzik 	writel(0x0fcfffff, mmio + MV_FLASH_CTL);
1784c6fd2807SJeff Garzik }
1785c6fd2807SJeff Garzik 
1786c6fd2807SJeff Garzik static void mv5_read_preamp(struct mv_host_priv *hpriv, int idx,
1787c6fd2807SJeff Garzik 			   void __iomem *mmio)
1788c6fd2807SJeff Garzik {
1789c6fd2807SJeff Garzik 	void __iomem *phy_mmio = mv5_phy_base(mmio, idx);
1790c6fd2807SJeff Garzik 	u32 tmp;
1791c6fd2807SJeff Garzik 
1792c6fd2807SJeff Garzik 	tmp = readl(phy_mmio + MV5_PHY_MODE);
1793c6fd2807SJeff Garzik 
1794c6fd2807SJeff Garzik 	hpriv->signal[idx].pre = tmp & 0x1800;	/* bits 12:11 */
1795c6fd2807SJeff Garzik 	hpriv->signal[idx].amps = tmp & 0xe0;	/* bits 7:5 */
1796c6fd2807SJeff Garzik }
1797c6fd2807SJeff Garzik 
1798c6fd2807SJeff Garzik static void mv5_enable_leds(struct mv_host_priv *hpriv, void __iomem *mmio)
1799c6fd2807SJeff Garzik {
1800c6fd2807SJeff Garzik 	u32 tmp;
1801c6fd2807SJeff Garzik 
1802c6fd2807SJeff Garzik 	writel(0, mmio + MV_GPIO_PORT_CTL);
1803c6fd2807SJeff Garzik 
1804c6fd2807SJeff Garzik 	/* FIXME: handle MV_HP_ERRATA_50XXB2 errata */
1805c6fd2807SJeff Garzik 
1806c6fd2807SJeff Garzik 	tmp = readl(mmio + MV_PCI_EXP_ROM_BAR_CTL);
1807c6fd2807SJeff Garzik 	tmp |= ~(1 << 0);
1808c6fd2807SJeff Garzik 	writel(tmp, mmio + MV_PCI_EXP_ROM_BAR_CTL);
1809c6fd2807SJeff Garzik }
1810c6fd2807SJeff Garzik 
1811c6fd2807SJeff Garzik static void mv5_phy_errata(struct mv_host_priv *hpriv, void __iomem *mmio,
1812c6fd2807SJeff Garzik 			   unsigned int port)
1813c6fd2807SJeff Garzik {
1814c6fd2807SJeff Garzik 	void __iomem *phy_mmio = mv5_phy_base(mmio, port);
1815c6fd2807SJeff Garzik 	const u32 mask = (1<<12) | (1<<11) | (1<<7) | (1<<6) | (1<<5);
1816c6fd2807SJeff Garzik 	u32 tmp;
1817c6fd2807SJeff Garzik 	int fix_apm_sq = (hpriv->hp_flags & MV_HP_ERRATA_50XXB0);
1818c6fd2807SJeff Garzik 
1819c6fd2807SJeff Garzik 	if (fix_apm_sq) {
1820c6fd2807SJeff Garzik 		tmp = readl(phy_mmio + MV5_LT_MODE);
1821c6fd2807SJeff Garzik 		tmp |= (1 << 19);
1822c6fd2807SJeff Garzik 		writel(tmp, phy_mmio + MV5_LT_MODE);
1823c6fd2807SJeff Garzik 
1824c6fd2807SJeff Garzik 		tmp = readl(phy_mmio + MV5_PHY_CTL);
1825c6fd2807SJeff Garzik 		tmp &= ~0x3;
1826c6fd2807SJeff Garzik 		tmp |= 0x1;
1827c6fd2807SJeff Garzik 		writel(tmp, phy_mmio + MV5_PHY_CTL);
1828c6fd2807SJeff Garzik 	}
1829c6fd2807SJeff Garzik 
1830c6fd2807SJeff Garzik 	tmp = readl(phy_mmio + MV5_PHY_MODE);
1831c6fd2807SJeff Garzik 	tmp &= ~mask;
1832c6fd2807SJeff Garzik 	tmp |= hpriv->signal[port].pre;
1833c6fd2807SJeff Garzik 	tmp |= hpriv->signal[port].amps;
1834c6fd2807SJeff Garzik 	writel(tmp, phy_mmio + MV5_PHY_MODE);
1835c6fd2807SJeff Garzik }
1836c6fd2807SJeff Garzik 
1837c6fd2807SJeff Garzik 
1838c6fd2807SJeff Garzik #undef ZERO
1839c6fd2807SJeff Garzik #define ZERO(reg) writel(0, port_mmio + (reg))
1840c6fd2807SJeff Garzik static void mv5_reset_hc_port(struct mv_host_priv *hpriv, void __iomem *mmio,
1841c6fd2807SJeff Garzik 			     unsigned int port)
1842c6fd2807SJeff Garzik {
1843c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_port_base(mmio, port);
1844c6fd2807SJeff Garzik 
1845c6fd2807SJeff Garzik 	writelfl(EDMA_DS, port_mmio + EDMA_CMD_OFS);
1846c6fd2807SJeff Garzik 
1847c6fd2807SJeff Garzik 	mv_channel_reset(hpriv, mmio, port);
1848c6fd2807SJeff Garzik 
1849c6fd2807SJeff Garzik 	ZERO(0x028);	/* command */
1850c6fd2807SJeff Garzik 	writel(0x11f, port_mmio + EDMA_CFG_OFS);
1851c6fd2807SJeff Garzik 	ZERO(0x004);	/* timer */
1852c6fd2807SJeff Garzik 	ZERO(0x008);	/* irq err cause */
1853c6fd2807SJeff Garzik 	ZERO(0x00c);	/* irq err mask */
1854c6fd2807SJeff Garzik 	ZERO(0x010);	/* rq bah */
1855c6fd2807SJeff Garzik 	ZERO(0x014);	/* rq inp */
1856c6fd2807SJeff Garzik 	ZERO(0x018);	/* rq outp */
1857c6fd2807SJeff Garzik 	ZERO(0x01c);	/* respq bah */
1858c6fd2807SJeff Garzik 	ZERO(0x024);	/* respq outp */
1859c6fd2807SJeff Garzik 	ZERO(0x020);	/* respq inp */
1860c6fd2807SJeff Garzik 	ZERO(0x02c);	/* test control */
1861c6fd2807SJeff Garzik 	writel(0xbc, port_mmio + EDMA_IORDY_TMOUT);
1862c6fd2807SJeff Garzik }
1863c6fd2807SJeff Garzik #undef ZERO
1864c6fd2807SJeff Garzik 
1865c6fd2807SJeff Garzik #define ZERO(reg) writel(0, hc_mmio + (reg))
1866c6fd2807SJeff Garzik static void mv5_reset_one_hc(struct mv_host_priv *hpriv, void __iomem *mmio,
1867c6fd2807SJeff Garzik 			unsigned int hc)
1868c6fd2807SJeff Garzik {
1869c6fd2807SJeff Garzik 	void __iomem *hc_mmio = mv_hc_base(mmio, hc);
1870c6fd2807SJeff Garzik 	u32 tmp;
1871c6fd2807SJeff Garzik 
1872c6fd2807SJeff Garzik 	ZERO(0x00c);
1873c6fd2807SJeff Garzik 	ZERO(0x010);
1874c6fd2807SJeff Garzik 	ZERO(0x014);
1875c6fd2807SJeff Garzik 	ZERO(0x018);
1876c6fd2807SJeff Garzik 
1877c6fd2807SJeff Garzik 	tmp = readl(hc_mmio + 0x20);
1878c6fd2807SJeff Garzik 	tmp &= 0x1c1c1c1c;
1879c6fd2807SJeff Garzik 	tmp |= 0x03030303;
1880c6fd2807SJeff Garzik 	writel(tmp, hc_mmio + 0x20);
1881c6fd2807SJeff Garzik }
1882c6fd2807SJeff Garzik #undef ZERO
1883c6fd2807SJeff Garzik 
1884c6fd2807SJeff Garzik static int mv5_reset_hc(struct mv_host_priv *hpriv, void __iomem *mmio,
1885c6fd2807SJeff Garzik 			unsigned int n_hc)
1886c6fd2807SJeff Garzik {
1887c6fd2807SJeff Garzik 	unsigned int hc, port;
1888c6fd2807SJeff Garzik 
1889c6fd2807SJeff Garzik 	for (hc = 0; hc < n_hc; hc++) {
1890c6fd2807SJeff Garzik 		for (port = 0; port < MV_PORTS_PER_HC; port++)
1891c6fd2807SJeff Garzik 			mv5_reset_hc_port(hpriv, mmio,
1892c6fd2807SJeff Garzik 					  (hc * MV_PORTS_PER_HC) + port);
1893c6fd2807SJeff Garzik 
1894c6fd2807SJeff Garzik 		mv5_reset_one_hc(hpriv, mmio, hc);
1895c6fd2807SJeff Garzik 	}
1896c6fd2807SJeff Garzik 
1897c6fd2807SJeff Garzik 	return 0;
1898c6fd2807SJeff Garzik }
1899c6fd2807SJeff Garzik 
1900c6fd2807SJeff Garzik #undef ZERO
1901c6fd2807SJeff Garzik #define ZERO(reg) writel(0, mmio + (reg))
1902c6fd2807SJeff Garzik static void mv_reset_pci_bus(struct pci_dev *pdev, void __iomem *mmio)
1903c6fd2807SJeff Garzik {
1904c6fd2807SJeff Garzik 	u32 tmp;
1905c6fd2807SJeff Garzik 
1906c6fd2807SJeff Garzik 	tmp = readl(mmio + MV_PCI_MODE);
1907c6fd2807SJeff Garzik 	tmp &= 0xff00ffff;
1908c6fd2807SJeff Garzik 	writel(tmp, mmio + MV_PCI_MODE);
1909c6fd2807SJeff Garzik 
1910c6fd2807SJeff Garzik 	ZERO(MV_PCI_DISC_TIMER);
1911c6fd2807SJeff Garzik 	ZERO(MV_PCI_MSI_TRIGGER);
1912c6fd2807SJeff Garzik 	writel(0x000100ff, mmio + MV_PCI_XBAR_TMOUT);
1913c6fd2807SJeff Garzik 	ZERO(HC_MAIN_IRQ_MASK_OFS);
1914c6fd2807SJeff Garzik 	ZERO(MV_PCI_SERR_MASK);
1915c6fd2807SJeff Garzik 	ZERO(PCI_IRQ_CAUSE_OFS);
1916c6fd2807SJeff Garzik 	ZERO(PCI_IRQ_MASK_OFS);
1917c6fd2807SJeff Garzik 	ZERO(MV_PCI_ERR_LOW_ADDRESS);
1918c6fd2807SJeff Garzik 	ZERO(MV_PCI_ERR_HIGH_ADDRESS);
1919c6fd2807SJeff Garzik 	ZERO(MV_PCI_ERR_ATTRIBUTE);
1920c6fd2807SJeff Garzik 	ZERO(MV_PCI_ERR_COMMAND);
1921c6fd2807SJeff Garzik }
1922c6fd2807SJeff Garzik #undef ZERO
1923c6fd2807SJeff Garzik 
1924c6fd2807SJeff Garzik static void mv6_reset_flash(struct mv_host_priv *hpriv, void __iomem *mmio)
1925c6fd2807SJeff Garzik {
1926c6fd2807SJeff Garzik 	u32 tmp;
1927c6fd2807SJeff Garzik 
1928c6fd2807SJeff Garzik 	mv5_reset_flash(hpriv, mmio);
1929c6fd2807SJeff Garzik 
1930c6fd2807SJeff Garzik 	tmp = readl(mmio + MV_GPIO_PORT_CTL);
1931c6fd2807SJeff Garzik 	tmp &= 0x3;
1932c6fd2807SJeff Garzik 	tmp |= (1 << 5) | (1 << 6);
1933c6fd2807SJeff Garzik 	writel(tmp, mmio + MV_GPIO_PORT_CTL);
1934c6fd2807SJeff Garzik }
1935c6fd2807SJeff Garzik 
1936c6fd2807SJeff Garzik /**
1937c6fd2807SJeff Garzik  *      mv6_reset_hc - Perform the 6xxx global soft reset
1938c6fd2807SJeff Garzik  *      @mmio: base address of the HBA
1939c6fd2807SJeff Garzik  *
1940c6fd2807SJeff Garzik  *      This routine only applies to 6xxx parts.
1941c6fd2807SJeff Garzik  *
1942c6fd2807SJeff Garzik  *      LOCKING:
1943c6fd2807SJeff Garzik  *      Inherited from caller.
1944c6fd2807SJeff Garzik  */
1945c6fd2807SJeff Garzik static int mv6_reset_hc(struct mv_host_priv *hpriv, void __iomem *mmio,
1946c6fd2807SJeff Garzik 			unsigned int n_hc)
1947c6fd2807SJeff Garzik {
1948c6fd2807SJeff Garzik 	void __iomem *reg = mmio + PCI_MAIN_CMD_STS_OFS;
1949c6fd2807SJeff Garzik 	int i, rc = 0;
1950c6fd2807SJeff Garzik 	u32 t;
1951c6fd2807SJeff Garzik 
1952c6fd2807SJeff Garzik 	/* Following procedure defined in PCI "main command and status
1953c6fd2807SJeff Garzik 	 * register" table.
1954c6fd2807SJeff Garzik 	 */
1955c6fd2807SJeff Garzik 	t = readl(reg);
1956c6fd2807SJeff Garzik 	writel(t | STOP_PCI_MASTER, reg);
1957c6fd2807SJeff Garzik 
1958c6fd2807SJeff Garzik 	for (i = 0; i < 1000; i++) {
1959c6fd2807SJeff Garzik 		udelay(1);
1960c6fd2807SJeff Garzik 		t = readl(reg);
1961c6fd2807SJeff Garzik 		if (PCI_MASTER_EMPTY & t) {
1962c6fd2807SJeff Garzik 			break;
1963c6fd2807SJeff Garzik 		}
1964c6fd2807SJeff Garzik 	}
1965c6fd2807SJeff Garzik 	if (!(PCI_MASTER_EMPTY & t)) {
1966c6fd2807SJeff Garzik 		printk(KERN_ERR DRV_NAME ": PCI master won't flush\n");
1967c6fd2807SJeff Garzik 		rc = 1;
1968c6fd2807SJeff Garzik 		goto done;
1969c6fd2807SJeff Garzik 	}
1970c6fd2807SJeff Garzik 
1971c6fd2807SJeff Garzik 	/* set reset */
1972c6fd2807SJeff Garzik 	i = 5;
1973c6fd2807SJeff Garzik 	do {
1974c6fd2807SJeff Garzik 		writel(t | GLOB_SFT_RST, reg);
1975c6fd2807SJeff Garzik 		t = readl(reg);
1976c6fd2807SJeff Garzik 		udelay(1);
1977c6fd2807SJeff Garzik 	} while (!(GLOB_SFT_RST & t) && (i-- > 0));
1978c6fd2807SJeff Garzik 
1979c6fd2807SJeff Garzik 	if (!(GLOB_SFT_RST & t)) {
1980c6fd2807SJeff Garzik 		printk(KERN_ERR DRV_NAME ": can't set global reset\n");
1981c6fd2807SJeff Garzik 		rc = 1;
1982c6fd2807SJeff Garzik 		goto done;
1983c6fd2807SJeff Garzik 	}
1984c6fd2807SJeff Garzik 
1985c6fd2807SJeff Garzik 	/* clear reset and *reenable the PCI master* (not mentioned in spec) */
1986c6fd2807SJeff Garzik 	i = 5;
1987c6fd2807SJeff Garzik 	do {
1988c6fd2807SJeff Garzik 		writel(t & ~(GLOB_SFT_RST | STOP_PCI_MASTER), reg);
1989c6fd2807SJeff Garzik 		t = readl(reg);
1990c6fd2807SJeff Garzik 		udelay(1);
1991c6fd2807SJeff Garzik 	} while ((GLOB_SFT_RST & t) && (i-- > 0));
1992c6fd2807SJeff Garzik 
1993c6fd2807SJeff Garzik 	if (GLOB_SFT_RST & t) {
1994c6fd2807SJeff Garzik 		printk(KERN_ERR DRV_NAME ": can't clear global reset\n");
1995c6fd2807SJeff Garzik 		rc = 1;
1996c6fd2807SJeff Garzik 	}
1997c6fd2807SJeff Garzik done:
1998c6fd2807SJeff Garzik 	return rc;
1999c6fd2807SJeff Garzik }
2000c6fd2807SJeff Garzik 
2001c6fd2807SJeff Garzik static void mv6_read_preamp(struct mv_host_priv *hpriv, int idx,
2002c6fd2807SJeff Garzik 			   void __iomem *mmio)
2003c6fd2807SJeff Garzik {
2004c6fd2807SJeff Garzik 	void __iomem *port_mmio;
2005c6fd2807SJeff Garzik 	u32 tmp;
2006c6fd2807SJeff Garzik 
2007c6fd2807SJeff Garzik 	tmp = readl(mmio + MV_RESET_CFG);
2008c6fd2807SJeff Garzik 	if ((tmp & (1 << 0)) == 0) {
2009c6fd2807SJeff Garzik 		hpriv->signal[idx].amps = 0x7 << 8;
2010c6fd2807SJeff Garzik 		hpriv->signal[idx].pre = 0x1 << 5;
2011c6fd2807SJeff Garzik 		return;
2012c6fd2807SJeff Garzik 	}
2013c6fd2807SJeff Garzik 
2014c6fd2807SJeff Garzik 	port_mmio = mv_port_base(mmio, idx);
2015c6fd2807SJeff Garzik 	tmp = readl(port_mmio + PHY_MODE2);
2016c6fd2807SJeff Garzik 
2017c6fd2807SJeff Garzik 	hpriv->signal[idx].amps = tmp & 0x700;	/* bits 10:8 */
2018c6fd2807SJeff Garzik 	hpriv->signal[idx].pre = tmp & 0xe0;	/* bits 7:5 */
2019c6fd2807SJeff Garzik }
2020c6fd2807SJeff Garzik 
2021c6fd2807SJeff Garzik static void mv6_enable_leds(struct mv_host_priv *hpriv, void __iomem *mmio)
2022c6fd2807SJeff Garzik {
2023c6fd2807SJeff Garzik 	writel(0x00000060, mmio + MV_GPIO_PORT_CTL);
2024c6fd2807SJeff Garzik }
2025c6fd2807SJeff Garzik 
2026c6fd2807SJeff Garzik static void mv6_phy_errata(struct mv_host_priv *hpriv, void __iomem *mmio,
2027c6fd2807SJeff Garzik 			   unsigned int port)
2028c6fd2807SJeff Garzik {
2029c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_port_base(mmio, port);
2030c6fd2807SJeff Garzik 
2031c6fd2807SJeff Garzik 	u32 hp_flags = hpriv->hp_flags;
2032c6fd2807SJeff Garzik 	int fix_phy_mode2 =
2033c6fd2807SJeff Garzik 		hp_flags & (MV_HP_ERRATA_60X1B2 | MV_HP_ERRATA_60X1C0);
2034c6fd2807SJeff Garzik 	int fix_phy_mode4 =
2035c6fd2807SJeff Garzik 		hp_flags & (MV_HP_ERRATA_60X1B2 | MV_HP_ERRATA_60X1C0);
2036c6fd2807SJeff Garzik 	u32 m2, tmp;
2037c6fd2807SJeff Garzik 
2038c6fd2807SJeff Garzik 	if (fix_phy_mode2) {
2039c6fd2807SJeff Garzik 		m2 = readl(port_mmio + PHY_MODE2);
2040c6fd2807SJeff Garzik 		m2 &= ~(1 << 16);
2041c6fd2807SJeff Garzik 		m2 |= (1 << 31);
2042c6fd2807SJeff Garzik 		writel(m2, port_mmio + PHY_MODE2);
2043c6fd2807SJeff Garzik 
2044c6fd2807SJeff Garzik 		udelay(200);
2045c6fd2807SJeff Garzik 
2046c6fd2807SJeff Garzik 		m2 = readl(port_mmio + PHY_MODE2);
2047c6fd2807SJeff Garzik 		m2 &= ~((1 << 16) | (1 << 31));
2048c6fd2807SJeff Garzik 		writel(m2, port_mmio + PHY_MODE2);
2049c6fd2807SJeff Garzik 
2050c6fd2807SJeff Garzik 		udelay(200);
2051c6fd2807SJeff Garzik 	}
2052c6fd2807SJeff Garzik 
2053c6fd2807SJeff Garzik 	/* who knows what this magic does */
2054c6fd2807SJeff Garzik 	tmp = readl(port_mmio + PHY_MODE3);
2055c6fd2807SJeff Garzik 	tmp &= ~0x7F800000;
2056c6fd2807SJeff Garzik 	tmp |= 0x2A800000;
2057c6fd2807SJeff Garzik 	writel(tmp, port_mmio + PHY_MODE3);
2058c6fd2807SJeff Garzik 
2059c6fd2807SJeff Garzik 	if (fix_phy_mode4) {
2060c6fd2807SJeff Garzik 		u32 m4;
2061c6fd2807SJeff Garzik 
2062c6fd2807SJeff Garzik 		m4 = readl(port_mmio + PHY_MODE4);
2063c6fd2807SJeff Garzik 
2064c6fd2807SJeff Garzik 		if (hp_flags & MV_HP_ERRATA_60X1B2)
2065c6fd2807SJeff Garzik 			tmp = readl(port_mmio + 0x310);
2066c6fd2807SJeff Garzik 
2067c6fd2807SJeff Garzik 		m4 = (m4 & ~(1 << 1)) | (1 << 0);
2068c6fd2807SJeff Garzik 
2069c6fd2807SJeff Garzik 		writel(m4, port_mmio + PHY_MODE4);
2070c6fd2807SJeff Garzik 
2071c6fd2807SJeff Garzik 		if (hp_flags & MV_HP_ERRATA_60X1B2)
2072c6fd2807SJeff Garzik 			writel(tmp, port_mmio + 0x310);
2073c6fd2807SJeff Garzik 	}
2074c6fd2807SJeff Garzik 
2075c6fd2807SJeff Garzik 	/* Revert values of pre-emphasis and signal amps to the saved ones */
2076c6fd2807SJeff Garzik 	m2 = readl(port_mmio + PHY_MODE2);
2077c6fd2807SJeff Garzik 
2078c6fd2807SJeff Garzik 	m2 &= ~MV_M2_PREAMP_MASK;
2079c6fd2807SJeff Garzik 	m2 |= hpriv->signal[port].amps;
2080c6fd2807SJeff Garzik 	m2 |= hpriv->signal[port].pre;
2081c6fd2807SJeff Garzik 	m2 &= ~(1 << 16);
2082c6fd2807SJeff Garzik 
2083c6fd2807SJeff Garzik 	/* according to mvSata 3.6.1, some IIE values are fixed */
2084c6fd2807SJeff Garzik 	if (IS_GEN_IIE(hpriv)) {
2085c6fd2807SJeff Garzik 		m2 &= ~0xC30FF01F;
2086c6fd2807SJeff Garzik 		m2 |= 0x0000900F;
2087c6fd2807SJeff Garzik 	}
2088c6fd2807SJeff Garzik 
2089c6fd2807SJeff Garzik 	writel(m2, port_mmio + PHY_MODE2);
2090c6fd2807SJeff Garzik }
2091c6fd2807SJeff Garzik 
2092c6fd2807SJeff Garzik static void mv_channel_reset(struct mv_host_priv *hpriv, void __iomem *mmio,
2093c6fd2807SJeff Garzik 			     unsigned int port_no)
2094c6fd2807SJeff Garzik {
2095c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_port_base(mmio, port_no);
2096c6fd2807SJeff Garzik 
2097c6fd2807SJeff Garzik 	writelfl(ATA_RST, port_mmio + EDMA_CMD_OFS);
2098c6fd2807SJeff Garzik 
2099ee9ccdf7SJeff Garzik 	if (IS_GEN_II(hpriv)) {
2100c6fd2807SJeff Garzik 		u32 ifctl = readl(port_mmio + SATA_INTERFACE_CTL);
2101c6fd2807SJeff Garzik 		ifctl |= (1 << 7);		/* enable gen2i speed */
2102c6fd2807SJeff Garzik 		ifctl = (ifctl & 0xfff) | 0x9b1000; /* from chip spec */
2103c6fd2807SJeff Garzik 		writelfl(ifctl, port_mmio + SATA_INTERFACE_CTL);
2104c6fd2807SJeff Garzik 	}
2105c6fd2807SJeff Garzik 
2106c6fd2807SJeff Garzik 	udelay(25);		/* allow reset propagation */
2107c6fd2807SJeff Garzik 
2108c6fd2807SJeff Garzik 	/* Spec never mentions clearing the bit.  Marvell's driver does
2109c6fd2807SJeff Garzik 	 * clear the bit, however.
2110c6fd2807SJeff Garzik 	 */
2111c6fd2807SJeff Garzik 	writelfl(0, port_mmio + EDMA_CMD_OFS);
2112c6fd2807SJeff Garzik 
2113c6fd2807SJeff Garzik 	hpriv->ops->phy_errata(hpriv, mmio, port_no);
2114c6fd2807SJeff Garzik 
2115ee9ccdf7SJeff Garzik 	if (IS_GEN_I(hpriv))
2116c6fd2807SJeff Garzik 		mdelay(1);
2117c6fd2807SJeff Garzik }
2118c6fd2807SJeff Garzik 
2119c6fd2807SJeff Garzik /**
2120bdd4dddeSJeff Garzik  *      mv_phy_reset - Perform eDMA reset followed by COMRESET
2121c6fd2807SJeff Garzik  *      @ap: ATA channel to manipulate
2122c6fd2807SJeff Garzik  *
2123c6fd2807SJeff Garzik  *      Part of this is taken from __sata_phy_reset and modified to
2124c6fd2807SJeff Garzik  *      not sleep since this routine gets called from interrupt level.
2125c6fd2807SJeff Garzik  *
2126c6fd2807SJeff Garzik  *      LOCKING:
2127c6fd2807SJeff Garzik  *      Inherited from caller.  This is coded to safe to call at
2128c6fd2807SJeff Garzik  *      interrupt level, i.e. it does not sleep.
2129c6fd2807SJeff Garzik  */
2130bdd4dddeSJeff Garzik static void mv_phy_reset(struct ata_port *ap, unsigned int *class,
2131bdd4dddeSJeff Garzik 			 unsigned long deadline)
2132c6fd2807SJeff Garzik {
2133c6fd2807SJeff Garzik 	struct mv_port_priv *pp	= ap->private_data;
2134cca3974eSJeff Garzik 	struct mv_host_priv *hpriv = ap->host->private_data;
2135c6fd2807SJeff Garzik 	void __iomem *port_mmio = mv_ap_base(ap);
2136c6fd2807SJeff Garzik 	int retry = 5;
2137c6fd2807SJeff Garzik 	u32 sstatus;
2138c6fd2807SJeff Garzik 
2139c6fd2807SJeff Garzik 	VPRINTK("ENTER, port %u, mmio 0x%p\n", ap->port_no, port_mmio);
2140c6fd2807SJeff Garzik 
2141c6fd2807SJeff Garzik 	DPRINTK("S-regs after ATA_RST: SStat 0x%08x SErr 0x%08x "
2142c6fd2807SJeff Garzik 		"SCtrl 0x%08x\n", mv_scr_read(ap, SCR_STATUS),
2143c6fd2807SJeff Garzik 		mv_scr_read(ap, SCR_ERROR), mv_scr_read(ap, SCR_CONTROL));
2144c6fd2807SJeff Garzik 
2145c6fd2807SJeff Garzik 	/* Issue COMRESET via SControl */
2146c6fd2807SJeff Garzik comreset_retry:
2147c6fd2807SJeff Garzik 	sata_scr_write_flush(ap, SCR_CONTROL, 0x301);
2148bdd4dddeSJeff Garzik 	msleep(1);
2149c6fd2807SJeff Garzik 
2150c6fd2807SJeff Garzik 	sata_scr_write_flush(ap, SCR_CONTROL, 0x300);
2151bdd4dddeSJeff Garzik 	msleep(20);
2152c6fd2807SJeff Garzik 
2153c6fd2807SJeff Garzik 	do {
2154c6fd2807SJeff Garzik 		sata_scr_read(ap, SCR_STATUS, &sstatus);
2155dd1dc802SJeff Garzik 		if (((sstatus & 0x3) == 3) || ((sstatus & 0x3) == 0))
2156c6fd2807SJeff Garzik 			break;
2157c6fd2807SJeff Garzik 
2158bdd4dddeSJeff Garzik 		msleep(1);
2159c5d3e45aSJeff Garzik 	} while (time_before(jiffies, deadline));
2160c6fd2807SJeff Garzik 
2161c6fd2807SJeff Garzik 	/* work around errata */
2162ee9ccdf7SJeff Garzik 	if (IS_GEN_II(hpriv) &&
2163c6fd2807SJeff Garzik 	    (sstatus != 0x0) && (sstatus != 0x113) && (sstatus != 0x123) &&
2164c6fd2807SJeff Garzik 	    (retry-- > 0))
2165c6fd2807SJeff Garzik 		goto comreset_retry;
2166c6fd2807SJeff Garzik 
2167c6fd2807SJeff Garzik 	DPRINTK("S-regs after PHY wake: SStat 0x%08x SErr 0x%08x "
2168c6fd2807SJeff Garzik 		"SCtrl 0x%08x\n", mv_scr_read(ap, SCR_STATUS),
2169c6fd2807SJeff Garzik 		mv_scr_read(ap, SCR_ERROR), mv_scr_read(ap, SCR_CONTROL));
2170c6fd2807SJeff Garzik 
2171bdd4dddeSJeff Garzik 	if (ata_port_offline(ap)) {
2172bdd4dddeSJeff Garzik 		*class = ATA_DEV_NONE;
2173c6fd2807SJeff Garzik 		return;
2174c6fd2807SJeff Garzik 	}
2175c6fd2807SJeff Garzik 
2176c6fd2807SJeff Garzik 	/* even after SStatus reflects that device is ready,
2177c6fd2807SJeff Garzik 	 * it seems to take a while for link to be fully
2178c6fd2807SJeff Garzik 	 * established (and thus Status no longer 0x80/0x7F),
2179c6fd2807SJeff Garzik 	 * so we poll a bit for that, here.
2180c6fd2807SJeff Garzik 	 */
2181c6fd2807SJeff Garzik 	retry = 20;
2182c6fd2807SJeff Garzik 	while (1) {
2183c6fd2807SJeff Garzik 		u8 drv_stat = ata_check_status(ap);
2184c6fd2807SJeff Garzik 		if ((drv_stat != 0x80) && (drv_stat != 0x7f))
2185c6fd2807SJeff Garzik 			break;
2186bdd4dddeSJeff Garzik 		msleep(500);
2187c6fd2807SJeff Garzik 		if (retry-- <= 0)
2188c6fd2807SJeff Garzik 			break;
2189bdd4dddeSJeff Garzik 		if (time_after(jiffies, deadline))
2190bdd4dddeSJeff Garzik 			break;
2191c6fd2807SJeff Garzik 	}
2192c6fd2807SJeff Garzik 
2193bdd4dddeSJeff Garzik 	/* FIXME: if we passed the deadline, the following
2194bdd4dddeSJeff Garzik 	 * code probably produces an invalid result
2195bdd4dddeSJeff Garzik 	 */
2196c6fd2807SJeff Garzik 
2197bdd4dddeSJeff Garzik 	/* finally, read device signature from TF registers */
2198bdd4dddeSJeff Garzik 	*class = ata_dev_try_classify(ap, 0, NULL);
2199c6fd2807SJeff Garzik 
2200c6fd2807SJeff Garzik 	writelfl(0, port_mmio + EDMA_ERR_IRQ_CAUSE_OFS);
2201c6fd2807SJeff Garzik 
2202bdd4dddeSJeff Garzik 	WARN_ON(pp->pp_flags & MV_PP_FLAG_EDMA_EN);
2203c6fd2807SJeff Garzik 
2204c6fd2807SJeff Garzik 	VPRINTK("EXIT\n");
2205c6fd2807SJeff Garzik }
2206c6fd2807SJeff Garzik 
2207bdd4dddeSJeff Garzik static int mv_prereset(struct ata_port *ap, unsigned long deadline)
2208c6fd2807SJeff Garzik {
2209bdd4dddeSJeff Garzik 	struct mv_port_priv *pp	= ap->private_data;
2210bdd4dddeSJeff Garzik 	struct ata_eh_context *ehc = &ap->eh_context;
2211bdd4dddeSJeff Garzik 	int rc;
2212bdd4dddeSJeff Garzik 
2213bdd4dddeSJeff Garzik 	rc = mv_stop_dma(ap);
2214bdd4dddeSJeff Garzik 	if (rc)
2215bdd4dddeSJeff Garzik 		ehc->i.action |= ATA_EH_HARDRESET;
2216bdd4dddeSJeff Garzik 
2217bdd4dddeSJeff Garzik 	if (!(pp->pp_flags & MV_PP_FLAG_HAD_A_RESET)) {
2218bdd4dddeSJeff Garzik 		pp->pp_flags |= MV_PP_FLAG_HAD_A_RESET;
2219bdd4dddeSJeff Garzik 		ehc->i.action |= ATA_EH_HARDRESET;
2220c6fd2807SJeff Garzik 	}
2221c6fd2807SJeff Garzik 
2222bdd4dddeSJeff Garzik 	/* if we're about to do hardreset, nothing more to do */
2223bdd4dddeSJeff Garzik 	if (ehc->i.action & ATA_EH_HARDRESET)
2224bdd4dddeSJeff Garzik 		return 0;
2225bdd4dddeSJeff Garzik 
2226bdd4dddeSJeff Garzik 	if (ata_port_online(ap))
2227bdd4dddeSJeff Garzik 		rc = ata_wait_ready(ap, deadline);
2228bdd4dddeSJeff Garzik 	else
2229bdd4dddeSJeff Garzik 		rc = -ENODEV;
2230bdd4dddeSJeff Garzik 
2231bdd4dddeSJeff Garzik 	return rc;
2232bdd4dddeSJeff Garzik }
2233bdd4dddeSJeff Garzik 
2234bdd4dddeSJeff Garzik static int mv_hardreset(struct ata_port *ap, unsigned int *class,
2235bdd4dddeSJeff Garzik 			unsigned long deadline)
2236bdd4dddeSJeff Garzik {
2237bdd4dddeSJeff Garzik 	struct mv_host_priv *hpriv = ap->host->private_data;
2238bdd4dddeSJeff Garzik 	void __iomem *mmio = ap->host->iomap[MV_PRIMARY_BAR];
2239bdd4dddeSJeff Garzik 
2240bdd4dddeSJeff Garzik 	mv_stop_dma(ap);
2241bdd4dddeSJeff Garzik 
2242bdd4dddeSJeff Garzik 	mv_channel_reset(hpriv, mmio, ap->port_no);
2243bdd4dddeSJeff Garzik 
2244bdd4dddeSJeff Garzik 	mv_phy_reset(ap, class, deadline);
2245bdd4dddeSJeff Garzik 
2246bdd4dddeSJeff Garzik 	return 0;
2247bdd4dddeSJeff Garzik }
2248bdd4dddeSJeff Garzik 
2249bdd4dddeSJeff Garzik static void mv_postreset(struct ata_port *ap, unsigned int *classes)
2250bdd4dddeSJeff Garzik {
2251bdd4dddeSJeff Garzik 	u32 serr;
2252bdd4dddeSJeff Garzik 
2253bdd4dddeSJeff Garzik 	/* print link status */
2254bdd4dddeSJeff Garzik 	sata_print_link_status(ap);
2255bdd4dddeSJeff Garzik 
2256bdd4dddeSJeff Garzik 	/* clear SError */
2257bdd4dddeSJeff Garzik 	sata_scr_read(ap, SCR_ERROR, &serr);
2258bdd4dddeSJeff Garzik 	sata_scr_write_flush(ap, SCR_ERROR, serr);
2259bdd4dddeSJeff Garzik 
2260bdd4dddeSJeff Garzik 	/* bail out if no device is present */
2261bdd4dddeSJeff Garzik 	if (classes[0] == ATA_DEV_NONE && classes[1] == ATA_DEV_NONE) {
2262bdd4dddeSJeff Garzik 		DPRINTK("EXIT, no device\n");
2263bdd4dddeSJeff Garzik 		return;
2264bdd4dddeSJeff Garzik 	}
2265bdd4dddeSJeff Garzik 
2266bdd4dddeSJeff Garzik 	/* set up device control */
2267bdd4dddeSJeff Garzik 	iowrite8(ap->ctl, ap->ioaddr.ctl_addr);
2268bdd4dddeSJeff Garzik }
2269bdd4dddeSJeff Garzik 
2270bdd4dddeSJeff Garzik static void mv_error_handler(struct ata_port *ap)
2271bdd4dddeSJeff Garzik {
2272bdd4dddeSJeff Garzik 	ata_do_eh(ap, mv_prereset, ata_std_softreset,
2273bdd4dddeSJeff Garzik 		  mv_hardreset, mv_postreset);
2274bdd4dddeSJeff Garzik }
2275bdd4dddeSJeff Garzik 
2276bdd4dddeSJeff Garzik static void mv_post_int_cmd(struct ata_queued_cmd *qc)
2277bdd4dddeSJeff Garzik {
2278bdd4dddeSJeff Garzik 	mv_stop_dma(qc->ap);
2279bdd4dddeSJeff Garzik }
2280bdd4dddeSJeff Garzik 
2281bdd4dddeSJeff Garzik static void mv_eh_freeze(struct ata_port *ap)
2282c6fd2807SJeff Garzik {
22830d5ff566STejun Heo 	void __iomem *mmio = ap->host->iomap[MV_PRIMARY_BAR];
2284bdd4dddeSJeff Garzik 	unsigned int hc = (ap->port_no > 3) ? 1 : 0;
2285bdd4dddeSJeff Garzik 	u32 tmp, mask;
2286bdd4dddeSJeff Garzik 	unsigned int shift;
2287c6fd2807SJeff Garzik 
2288bdd4dddeSJeff Garzik 	/* FIXME: handle coalescing completion events properly */
2289c6fd2807SJeff Garzik 
2290bdd4dddeSJeff Garzik 	shift = ap->port_no * 2;
2291bdd4dddeSJeff Garzik 	if (hc > 0)
2292bdd4dddeSJeff Garzik 		shift++;
2293c6fd2807SJeff Garzik 
2294bdd4dddeSJeff Garzik 	mask = 0x3 << shift;
2295c6fd2807SJeff Garzik 
2296bdd4dddeSJeff Garzik 	/* disable assertion of portN err, done events */
2297bdd4dddeSJeff Garzik 	tmp = readl(mmio + HC_MAIN_IRQ_MASK_OFS);
2298bdd4dddeSJeff Garzik 	writelfl(tmp & ~mask, mmio + HC_MAIN_IRQ_MASK_OFS);
2299c6fd2807SJeff Garzik }
2300bdd4dddeSJeff Garzik 
2301bdd4dddeSJeff Garzik static void mv_eh_thaw(struct ata_port *ap)
2302bdd4dddeSJeff Garzik {
2303bdd4dddeSJeff Garzik 	void __iomem *mmio = ap->host->iomap[MV_PRIMARY_BAR];
2304bdd4dddeSJeff Garzik 	unsigned int hc = (ap->port_no > 3) ? 1 : 0;
2305bdd4dddeSJeff Garzik 	void __iomem *hc_mmio = mv_hc_base(mmio, hc);
2306bdd4dddeSJeff Garzik 	void __iomem *port_mmio = mv_ap_base(ap);
2307bdd4dddeSJeff Garzik 	u32 tmp, mask, hc_irq_cause;
2308bdd4dddeSJeff Garzik 	unsigned int shift, hc_port_no = ap->port_no;
2309bdd4dddeSJeff Garzik 
2310bdd4dddeSJeff Garzik 	/* FIXME: handle coalescing completion events properly */
2311bdd4dddeSJeff Garzik 
2312bdd4dddeSJeff Garzik 	shift = ap->port_no * 2;
2313bdd4dddeSJeff Garzik 	if (hc > 0) {
2314bdd4dddeSJeff Garzik 		shift++;
2315bdd4dddeSJeff Garzik 		hc_port_no -= 4;
2316bdd4dddeSJeff Garzik 	}
2317bdd4dddeSJeff Garzik 
2318bdd4dddeSJeff Garzik 	mask = 0x3 << shift;
2319bdd4dddeSJeff Garzik 
2320bdd4dddeSJeff Garzik 	/* clear EDMA errors on this port */
2321bdd4dddeSJeff Garzik 	writel(0, port_mmio + EDMA_ERR_IRQ_CAUSE_OFS);
2322bdd4dddeSJeff Garzik 
2323bdd4dddeSJeff Garzik 	/* clear pending irq events */
2324bdd4dddeSJeff Garzik 	hc_irq_cause = readl(hc_mmio + HC_IRQ_CAUSE_OFS);
2325bdd4dddeSJeff Garzik 	hc_irq_cause &= ~(1 << hc_port_no);	/* clear CRPB-done */
2326bdd4dddeSJeff Garzik 	hc_irq_cause &= ~(1 << (hc_port_no + 8)); /* clear Device int */
2327bdd4dddeSJeff Garzik 	writel(hc_irq_cause, hc_mmio + HC_IRQ_CAUSE_OFS);
2328bdd4dddeSJeff Garzik 
2329bdd4dddeSJeff Garzik 	/* enable assertion of portN err, done events */
2330bdd4dddeSJeff Garzik 	tmp = readl(mmio + HC_MAIN_IRQ_MASK_OFS);
2331bdd4dddeSJeff Garzik 	writelfl(tmp | mask, mmio + HC_MAIN_IRQ_MASK_OFS);
2332c6fd2807SJeff Garzik }
2333c6fd2807SJeff Garzik 
2334c6fd2807SJeff Garzik /**
2335c6fd2807SJeff Garzik  *      mv_port_init - Perform some early initialization on a single port.
2336c6fd2807SJeff Garzik  *      @port: libata data structure storing shadow register addresses
2337c6fd2807SJeff Garzik  *      @port_mmio: base address of the port
2338c6fd2807SJeff Garzik  *
2339c6fd2807SJeff Garzik  *      Initialize shadow register mmio addresses, clear outstanding
2340c6fd2807SJeff Garzik  *      interrupts on the port, and unmask interrupts for the future
2341c6fd2807SJeff Garzik  *      start of the port.
2342c6fd2807SJeff Garzik  *
2343c6fd2807SJeff Garzik  *      LOCKING:
2344c6fd2807SJeff Garzik  *      Inherited from caller.
2345c6fd2807SJeff Garzik  */
2346c6fd2807SJeff Garzik static void mv_port_init(struct ata_ioports *port,  void __iomem *port_mmio)
2347c6fd2807SJeff Garzik {
23480d5ff566STejun Heo 	void __iomem *shd_base = port_mmio + SHD_BLK_OFS;
2349c6fd2807SJeff Garzik 	unsigned serr_ofs;
2350c6fd2807SJeff Garzik 
2351c6fd2807SJeff Garzik 	/* PIO related setup
2352c6fd2807SJeff Garzik 	 */
2353c6fd2807SJeff Garzik 	port->data_addr = shd_base + (sizeof(u32) * ATA_REG_DATA);
2354c6fd2807SJeff Garzik 	port->error_addr =
2355c6fd2807SJeff Garzik 		port->feature_addr = shd_base + (sizeof(u32) * ATA_REG_ERR);
2356c6fd2807SJeff Garzik 	port->nsect_addr = shd_base + (sizeof(u32) * ATA_REG_NSECT);
2357c6fd2807SJeff Garzik 	port->lbal_addr = shd_base + (sizeof(u32) * ATA_REG_LBAL);
2358c6fd2807SJeff Garzik 	port->lbam_addr = shd_base + (sizeof(u32) * ATA_REG_LBAM);
2359c6fd2807SJeff Garzik 	port->lbah_addr = shd_base + (sizeof(u32) * ATA_REG_LBAH);
2360c6fd2807SJeff Garzik 	port->device_addr = shd_base + (sizeof(u32) * ATA_REG_DEVICE);
2361c6fd2807SJeff Garzik 	port->status_addr =
2362c6fd2807SJeff Garzik 		port->command_addr = shd_base + (sizeof(u32) * ATA_REG_STATUS);
2363c6fd2807SJeff Garzik 	/* special case: control/altstatus doesn't have ATA_REG_ address */
2364c6fd2807SJeff Garzik 	port->altstatus_addr = port->ctl_addr = shd_base + SHD_CTL_AST_OFS;
2365c6fd2807SJeff Garzik 
2366c6fd2807SJeff Garzik 	/* unused: */
23678d9db2d2SRandy Dunlap 	port->cmd_addr = port->bmdma_addr = port->scr_addr = NULL;
2368c6fd2807SJeff Garzik 
2369c6fd2807SJeff Garzik 	/* Clear any currently outstanding port interrupt conditions */
2370c6fd2807SJeff Garzik 	serr_ofs = mv_scr_offset(SCR_ERROR);
2371c6fd2807SJeff Garzik 	writelfl(readl(port_mmio + serr_ofs), port_mmio + serr_ofs);
2372c6fd2807SJeff Garzik 	writelfl(0, port_mmio + EDMA_ERR_IRQ_CAUSE_OFS);
2373c6fd2807SJeff Garzik 
2374c6fd2807SJeff Garzik 	/* unmask all EDMA error interrupts */
2375c6fd2807SJeff Garzik 	writelfl(~0, port_mmio + EDMA_ERR_IRQ_MASK_OFS);
2376c6fd2807SJeff Garzik 
2377c6fd2807SJeff Garzik 	VPRINTK("EDMA cfg=0x%08x EDMA IRQ err cause/mask=0x%08x/0x%08x\n",
2378c6fd2807SJeff Garzik 		readl(port_mmio + EDMA_CFG_OFS),
2379c6fd2807SJeff Garzik 		readl(port_mmio + EDMA_ERR_IRQ_CAUSE_OFS),
2380c6fd2807SJeff Garzik 		readl(port_mmio + EDMA_ERR_IRQ_MASK_OFS));
2381c6fd2807SJeff Garzik }
2382c6fd2807SJeff Garzik 
23834447d351STejun Heo static int mv_chip_id(struct ata_host *host, unsigned int board_idx)
2384c6fd2807SJeff Garzik {
23854447d351STejun Heo 	struct pci_dev *pdev = to_pci_dev(host->dev);
23864447d351STejun Heo 	struct mv_host_priv *hpriv = host->private_data;
2387c6fd2807SJeff Garzik 	u32 hp_flags = hpriv->hp_flags;
2388c6fd2807SJeff Garzik 
2389c6fd2807SJeff Garzik 	switch(board_idx) {
2390c6fd2807SJeff Garzik 	case chip_5080:
2391c6fd2807SJeff Garzik 		hpriv->ops = &mv5xxx_ops;
2392ee9ccdf7SJeff Garzik 		hp_flags |= MV_HP_GEN_I;
2393c6fd2807SJeff Garzik 
239444c10138SAuke Kok 		switch (pdev->revision) {
2395c6fd2807SJeff Garzik 		case 0x1:
2396c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB0;
2397c6fd2807SJeff Garzik 			break;
2398c6fd2807SJeff Garzik 		case 0x3:
2399c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB2;
2400c6fd2807SJeff Garzik 			break;
2401c6fd2807SJeff Garzik 		default:
2402c6fd2807SJeff Garzik 			dev_printk(KERN_WARNING, &pdev->dev,
2403c6fd2807SJeff Garzik 			   "Applying 50XXB2 workarounds to unknown rev\n");
2404c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB2;
2405c6fd2807SJeff Garzik 			break;
2406c6fd2807SJeff Garzik 		}
2407c6fd2807SJeff Garzik 		break;
2408c6fd2807SJeff Garzik 
2409c6fd2807SJeff Garzik 	case chip_504x:
2410c6fd2807SJeff Garzik 	case chip_508x:
2411c6fd2807SJeff Garzik 		hpriv->ops = &mv5xxx_ops;
2412ee9ccdf7SJeff Garzik 		hp_flags |= MV_HP_GEN_I;
2413c6fd2807SJeff Garzik 
241444c10138SAuke Kok 		switch (pdev->revision) {
2415c6fd2807SJeff Garzik 		case 0x0:
2416c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB0;
2417c6fd2807SJeff Garzik 			break;
2418c6fd2807SJeff Garzik 		case 0x3:
2419c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB2;
2420c6fd2807SJeff Garzik 			break;
2421c6fd2807SJeff Garzik 		default:
2422c6fd2807SJeff Garzik 			dev_printk(KERN_WARNING, &pdev->dev,
2423c6fd2807SJeff Garzik 			   "Applying B2 workarounds to unknown rev\n");
2424c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_50XXB2;
2425c6fd2807SJeff Garzik 			break;
2426c6fd2807SJeff Garzik 		}
2427c6fd2807SJeff Garzik 		break;
2428c6fd2807SJeff Garzik 
2429c6fd2807SJeff Garzik 	case chip_604x:
2430c6fd2807SJeff Garzik 	case chip_608x:
2431c6fd2807SJeff Garzik 		hpriv->ops = &mv6xxx_ops;
2432ee9ccdf7SJeff Garzik 		hp_flags |= MV_HP_GEN_II;
2433c6fd2807SJeff Garzik 
243444c10138SAuke Kok 		switch (pdev->revision) {
2435c6fd2807SJeff Garzik 		case 0x7:
2436c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_60X1B2;
2437c6fd2807SJeff Garzik 			break;
2438c6fd2807SJeff Garzik 		case 0x9:
2439c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_60X1C0;
2440c6fd2807SJeff Garzik 			break;
2441c6fd2807SJeff Garzik 		default:
2442c6fd2807SJeff Garzik 			dev_printk(KERN_WARNING, &pdev->dev,
2443c6fd2807SJeff Garzik 				   "Applying B2 workarounds to unknown rev\n");
2444c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_60X1B2;
2445c6fd2807SJeff Garzik 			break;
2446c6fd2807SJeff Garzik 		}
2447c6fd2807SJeff Garzik 		break;
2448c6fd2807SJeff Garzik 
2449c6fd2807SJeff Garzik 	case chip_7042:
2450c6fd2807SJeff Garzik 	case chip_6042:
2451c6fd2807SJeff Garzik 		hpriv->ops = &mv6xxx_ops;
2452c6fd2807SJeff Garzik 		hp_flags |= MV_HP_GEN_IIE;
2453c6fd2807SJeff Garzik 
245444c10138SAuke Kok 		switch (pdev->revision) {
2455c6fd2807SJeff Garzik 		case 0x0:
2456c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_XX42A0;
2457c6fd2807SJeff Garzik 			break;
2458c6fd2807SJeff Garzik 		case 0x1:
2459c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_60X1C0;
2460c6fd2807SJeff Garzik 			break;
2461c6fd2807SJeff Garzik 		default:
2462c6fd2807SJeff Garzik 			dev_printk(KERN_WARNING, &pdev->dev,
2463c6fd2807SJeff Garzik 			   "Applying 60X1C0 workarounds to unknown rev\n");
2464c6fd2807SJeff Garzik 			hp_flags |= MV_HP_ERRATA_60X1C0;
2465c6fd2807SJeff Garzik 			break;
2466c6fd2807SJeff Garzik 		}
2467c6fd2807SJeff Garzik 		break;
2468c6fd2807SJeff Garzik 
2469c6fd2807SJeff Garzik 	default:
2470c6fd2807SJeff Garzik 		printk(KERN_ERR DRV_NAME ": BUG: invalid board index %u\n", board_idx);
2471c6fd2807SJeff Garzik 		return 1;
2472c6fd2807SJeff Garzik 	}
2473c6fd2807SJeff Garzik 
2474c6fd2807SJeff Garzik 	hpriv->hp_flags = hp_flags;
2475c6fd2807SJeff Garzik 
2476c6fd2807SJeff Garzik 	return 0;
2477c6fd2807SJeff Garzik }
2478c6fd2807SJeff Garzik 
2479c6fd2807SJeff Garzik /**
2480c6fd2807SJeff Garzik  *      mv_init_host - Perform some early initialization of the host.
24814447d351STejun Heo  *	@host: ATA host to initialize
24824447d351STejun Heo  *      @board_idx: controller index
2483c6fd2807SJeff Garzik  *
2484c6fd2807SJeff Garzik  *      If possible, do an early global reset of the host.  Then do
2485c6fd2807SJeff Garzik  *      our port init and clear/unmask all/relevant host interrupts.
2486c6fd2807SJeff Garzik  *
2487c6fd2807SJeff Garzik  *      LOCKING:
2488c6fd2807SJeff Garzik  *      Inherited from caller.
2489c6fd2807SJeff Garzik  */
24904447d351STejun Heo static int mv_init_host(struct ata_host *host, unsigned int board_idx)
2491c6fd2807SJeff Garzik {
2492c6fd2807SJeff Garzik 	int rc = 0, n_hc, port, hc;
24934447d351STejun Heo 	struct pci_dev *pdev = to_pci_dev(host->dev);
24944447d351STejun Heo 	void __iomem *mmio = host->iomap[MV_PRIMARY_BAR];
24954447d351STejun Heo 	struct mv_host_priv *hpriv = host->private_data;
2496c6fd2807SJeff Garzik 
2497c6fd2807SJeff Garzik 	/* global interrupt mask */
2498c6fd2807SJeff Garzik 	writel(0, mmio + HC_MAIN_IRQ_MASK_OFS);
2499c6fd2807SJeff Garzik 
25004447d351STejun Heo 	rc = mv_chip_id(host, board_idx);
2501c6fd2807SJeff Garzik 	if (rc)
2502c6fd2807SJeff Garzik 		goto done;
2503c6fd2807SJeff Garzik 
25044447d351STejun Heo 	n_hc = mv_get_hc_count(host->ports[0]->flags);
2505c6fd2807SJeff Garzik 
25064447d351STejun Heo 	for (port = 0; port < host->n_ports; port++)
2507c6fd2807SJeff Garzik 		hpriv->ops->read_preamp(hpriv, port, mmio);
2508c6fd2807SJeff Garzik 
2509c6fd2807SJeff Garzik 	rc = hpriv->ops->reset_hc(hpriv, mmio, n_hc);
2510c6fd2807SJeff Garzik 	if (rc)
2511c6fd2807SJeff Garzik 		goto done;
2512c6fd2807SJeff Garzik 
2513c6fd2807SJeff Garzik 	hpriv->ops->reset_flash(hpriv, mmio);
2514c6fd2807SJeff Garzik 	hpriv->ops->reset_bus(pdev, mmio);
2515c6fd2807SJeff Garzik 	hpriv->ops->enable_leds(hpriv, mmio);
2516c6fd2807SJeff Garzik 
25174447d351STejun Heo 	for (port = 0; port < host->n_ports; port++) {
2518ee9ccdf7SJeff Garzik 		if (IS_GEN_II(hpriv)) {
2519c6fd2807SJeff Garzik 			void __iomem *port_mmio = mv_port_base(mmio, port);
2520c6fd2807SJeff Garzik 
2521c6fd2807SJeff Garzik 			u32 ifctl = readl(port_mmio + SATA_INTERFACE_CTL);
2522c6fd2807SJeff Garzik 			ifctl |= (1 << 7);		/* enable gen2i speed */
2523c6fd2807SJeff Garzik 			ifctl = (ifctl & 0xfff) | 0x9b1000; /* from chip spec */
2524c6fd2807SJeff Garzik 			writelfl(ifctl, port_mmio + SATA_INTERFACE_CTL);
2525c6fd2807SJeff Garzik 		}
2526c6fd2807SJeff Garzik 
2527c6fd2807SJeff Garzik 		hpriv->ops->phy_errata(hpriv, mmio, port);
2528c6fd2807SJeff Garzik 	}
2529c6fd2807SJeff Garzik 
25304447d351STejun Heo 	for (port = 0; port < host->n_ports; port++) {
2531c6fd2807SJeff Garzik 		void __iomem *port_mmio = mv_port_base(mmio, port);
25324447d351STejun Heo 		mv_port_init(&host->ports[port]->ioaddr, port_mmio);
2533c6fd2807SJeff Garzik 	}
2534c6fd2807SJeff Garzik 
2535c6fd2807SJeff Garzik 	for (hc = 0; hc < n_hc; hc++) {
2536c6fd2807SJeff Garzik 		void __iomem *hc_mmio = mv_hc_base(mmio, hc);
2537c6fd2807SJeff Garzik 
2538c6fd2807SJeff Garzik 		VPRINTK("HC%i: HC config=0x%08x HC IRQ cause "
2539c6fd2807SJeff Garzik 			"(before clear)=0x%08x\n", hc,
2540c6fd2807SJeff Garzik 			readl(hc_mmio + HC_CFG_OFS),
2541c6fd2807SJeff Garzik 			readl(hc_mmio + HC_IRQ_CAUSE_OFS));
2542c6fd2807SJeff Garzik 
2543c6fd2807SJeff Garzik 		/* Clear any currently outstanding hc interrupt conditions */
2544c6fd2807SJeff Garzik 		writelfl(0, hc_mmio + HC_IRQ_CAUSE_OFS);
2545c6fd2807SJeff Garzik 	}
2546c6fd2807SJeff Garzik 
2547c6fd2807SJeff Garzik 	/* Clear any currently outstanding host interrupt conditions */
2548c6fd2807SJeff Garzik 	writelfl(0, mmio + PCI_IRQ_CAUSE_OFS);
2549c6fd2807SJeff Garzik 
2550c6fd2807SJeff Garzik 	/* and unmask interrupt generation for host regs */
2551c6fd2807SJeff Garzik 	writelfl(PCI_UNMASK_ALL_IRQS, mmio + PCI_IRQ_MASK_OFS);
2552fb621e2fSJeff Garzik 
2553ee9ccdf7SJeff Garzik 	if (IS_GEN_I(hpriv))
2554fb621e2fSJeff Garzik 		writelfl(~HC_MAIN_MASKED_IRQS_5, mmio + HC_MAIN_IRQ_MASK_OFS);
2555fb621e2fSJeff Garzik 	else
2556c6fd2807SJeff Garzik 		writelfl(~HC_MAIN_MASKED_IRQS, mmio + HC_MAIN_IRQ_MASK_OFS);
2557c6fd2807SJeff Garzik 
2558c6fd2807SJeff Garzik 	VPRINTK("HC MAIN IRQ cause/mask=0x%08x/0x%08x "
2559c6fd2807SJeff Garzik 		"PCI int cause/mask=0x%08x/0x%08x\n",
2560c6fd2807SJeff Garzik 		readl(mmio + HC_MAIN_IRQ_CAUSE_OFS),
2561c6fd2807SJeff Garzik 		readl(mmio + HC_MAIN_IRQ_MASK_OFS),
2562c6fd2807SJeff Garzik 		readl(mmio + PCI_IRQ_CAUSE_OFS),
2563c6fd2807SJeff Garzik 		readl(mmio + PCI_IRQ_MASK_OFS));
2564c6fd2807SJeff Garzik 
2565c6fd2807SJeff Garzik done:
2566c6fd2807SJeff Garzik 	return rc;
2567c6fd2807SJeff Garzik }
2568c6fd2807SJeff Garzik 
2569c6fd2807SJeff Garzik /**
2570c6fd2807SJeff Garzik  *      mv_print_info - Dump key info to kernel log for perusal.
25714447d351STejun Heo  *      @host: ATA host to print info about
2572c6fd2807SJeff Garzik  *
2573c6fd2807SJeff Garzik  *      FIXME: complete this.
2574c6fd2807SJeff Garzik  *
2575c6fd2807SJeff Garzik  *      LOCKING:
2576c6fd2807SJeff Garzik  *      Inherited from caller.
2577c6fd2807SJeff Garzik  */
25784447d351STejun Heo static void mv_print_info(struct ata_host *host)
2579c6fd2807SJeff Garzik {
25804447d351STejun Heo 	struct pci_dev *pdev = to_pci_dev(host->dev);
25814447d351STejun Heo 	struct mv_host_priv *hpriv = host->private_data;
258244c10138SAuke Kok 	u8 scc;
2583c1e4fe71SJeff Garzik 	const char *scc_s, *gen;
2584c6fd2807SJeff Garzik 
2585c6fd2807SJeff Garzik 	/* Use this to determine the HW stepping of the chip so we know
2586c6fd2807SJeff Garzik 	 * what errata to workaround
2587c6fd2807SJeff Garzik 	 */
2588c6fd2807SJeff Garzik 	pci_read_config_byte(pdev, PCI_CLASS_DEVICE, &scc);
2589c6fd2807SJeff Garzik 	if (scc == 0)
2590c6fd2807SJeff Garzik 		scc_s = "SCSI";
2591c6fd2807SJeff Garzik 	else if (scc == 0x01)
2592c6fd2807SJeff Garzik 		scc_s = "RAID";
2593c6fd2807SJeff Garzik 	else
2594c1e4fe71SJeff Garzik 		scc_s = "?";
2595c1e4fe71SJeff Garzik 
2596c1e4fe71SJeff Garzik 	if (IS_GEN_I(hpriv))
2597c1e4fe71SJeff Garzik 		gen = "I";
2598c1e4fe71SJeff Garzik 	else if (IS_GEN_II(hpriv))
2599c1e4fe71SJeff Garzik 		gen = "II";
2600c1e4fe71SJeff Garzik 	else if (IS_GEN_IIE(hpriv))
2601c1e4fe71SJeff Garzik 		gen = "IIE";
2602c1e4fe71SJeff Garzik 	else
2603c1e4fe71SJeff Garzik 		gen = "?";
2604c6fd2807SJeff Garzik 
2605c6fd2807SJeff Garzik 	dev_printk(KERN_INFO, &pdev->dev,
2606c1e4fe71SJeff Garzik 	       "Gen-%s %u slots %u ports %s mode IRQ via %s\n",
2607c1e4fe71SJeff Garzik 	       gen, (unsigned)MV_MAX_Q_DEPTH, host->n_ports,
2608c6fd2807SJeff Garzik 	       scc_s, (MV_HP_FLAG_MSI & hpriv->hp_flags) ? "MSI" : "INTx");
2609c6fd2807SJeff Garzik }
2610c6fd2807SJeff Garzik 
2611c6fd2807SJeff Garzik /**
2612c6fd2807SJeff Garzik  *      mv_init_one - handle a positive probe of a Marvell host
2613c6fd2807SJeff Garzik  *      @pdev: PCI device found
2614c6fd2807SJeff Garzik  *      @ent: PCI device ID entry for the matched host
2615c6fd2807SJeff Garzik  *
2616c6fd2807SJeff Garzik  *      LOCKING:
2617c6fd2807SJeff Garzik  *      Inherited from caller.
2618c6fd2807SJeff Garzik  */
2619c6fd2807SJeff Garzik static int mv_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
2620c6fd2807SJeff Garzik {
2621c6fd2807SJeff Garzik 	static int printed_version = 0;
2622c6fd2807SJeff Garzik 	unsigned int board_idx = (unsigned int)ent->driver_data;
26234447d351STejun Heo 	const struct ata_port_info *ppi[] = { &mv_port_info[board_idx], NULL };
26244447d351STejun Heo 	struct ata_host *host;
26254447d351STejun Heo 	struct mv_host_priv *hpriv;
26264447d351STejun Heo 	int n_ports, rc;
2627c6fd2807SJeff Garzik 
2628c6fd2807SJeff Garzik 	if (!printed_version++)
2629c6fd2807SJeff Garzik 		dev_printk(KERN_INFO, &pdev->dev, "version " DRV_VERSION "\n");
2630c6fd2807SJeff Garzik 
26314447d351STejun Heo 	/* allocate host */
26324447d351STejun Heo 	n_ports = mv_get_hc_count(ppi[0]->flags) * MV_PORTS_PER_HC;
26334447d351STejun Heo 
26344447d351STejun Heo 	host = ata_host_alloc_pinfo(&pdev->dev, ppi, n_ports);
26354447d351STejun Heo 	hpriv = devm_kzalloc(&pdev->dev, sizeof(*hpriv), GFP_KERNEL);
26364447d351STejun Heo 	if (!host || !hpriv)
26374447d351STejun Heo 		return -ENOMEM;
26384447d351STejun Heo 	host->private_data = hpriv;
26394447d351STejun Heo 
26404447d351STejun Heo 	/* acquire resources */
264124dc5f33STejun Heo 	rc = pcim_enable_device(pdev);
264224dc5f33STejun Heo 	if (rc)
2643c6fd2807SJeff Garzik 		return rc;
2644c6fd2807SJeff Garzik 
26450d5ff566STejun Heo 	rc = pcim_iomap_regions(pdev, 1 << MV_PRIMARY_BAR, DRV_NAME);
26460d5ff566STejun Heo 	if (rc == -EBUSY)
264724dc5f33STejun Heo 		pcim_pin_device(pdev);
26480d5ff566STejun Heo 	if (rc)
264924dc5f33STejun Heo 		return rc;
26504447d351STejun Heo 	host->iomap = pcim_iomap_table(pdev);
2651c6fd2807SJeff Garzik 
2652d88184fbSJeff Garzik 	rc = pci_go_64(pdev);
2653d88184fbSJeff Garzik 	if (rc)
2654d88184fbSJeff Garzik 		return rc;
2655d88184fbSJeff Garzik 
2656c6fd2807SJeff Garzik 	/* initialize adapter */
26574447d351STejun Heo 	rc = mv_init_host(host, board_idx);
265824dc5f33STejun Heo 	if (rc)
265924dc5f33STejun Heo 		return rc;
2660c6fd2807SJeff Garzik 
2661c6fd2807SJeff Garzik 	/* Enable interrupts */
26626a59dcf8STejun Heo 	if (msi && pci_enable_msi(pdev))
2663c6fd2807SJeff Garzik 		pci_intx(pdev, 1);
2664c6fd2807SJeff Garzik 
2665c6fd2807SJeff Garzik 	mv_dump_pci_cfg(pdev, 0x68);
26664447d351STejun Heo 	mv_print_info(host);
2667c6fd2807SJeff Garzik 
26684447d351STejun Heo 	pci_set_master(pdev);
2669*ea8b4db9SJeff Garzik 	pci_try_set_mwi(pdev);
26704447d351STejun Heo 	return ata_host_activate(host, pdev->irq, mv_interrupt, IRQF_SHARED,
2671c5d3e45aSJeff Garzik 				 IS_GEN_I(hpriv) ? &mv5_sht : &mv6_sht);
2672c6fd2807SJeff Garzik }
2673c6fd2807SJeff Garzik 
2674c6fd2807SJeff Garzik static int __init mv_init(void)
2675c6fd2807SJeff Garzik {
2676c6fd2807SJeff Garzik 	return pci_register_driver(&mv_pci_driver);
2677c6fd2807SJeff Garzik }
2678c6fd2807SJeff Garzik 
2679c6fd2807SJeff Garzik static void __exit mv_exit(void)
2680c6fd2807SJeff Garzik {
2681c6fd2807SJeff Garzik 	pci_unregister_driver(&mv_pci_driver);
2682c6fd2807SJeff Garzik }
2683c6fd2807SJeff Garzik 
2684c6fd2807SJeff Garzik MODULE_AUTHOR("Brett Russ");
2685c6fd2807SJeff Garzik MODULE_DESCRIPTION("SCSI low-level driver for Marvell SATA controllers");
2686c6fd2807SJeff Garzik MODULE_LICENSE("GPL");
2687c6fd2807SJeff Garzik MODULE_DEVICE_TABLE(pci, mv_pci_tbl);
2688c6fd2807SJeff Garzik MODULE_VERSION(DRV_VERSION);
2689c6fd2807SJeff Garzik 
2690c6fd2807SJeff Garzik module_param(msi, int, 0444);
2691c6fd2807SJeff Garzik MODULE_PARM_DESC(msi, "Enable use of PCI MSI (0=off, 1=on)");
2692c6fd2807SJeff Garzik 
2693c6fd2807SJeff Garzik module_init(mv_init);
2694c6fd2807SJeff Garzik module_exit(mv_exit);
2695