xref: /openbmc/linux/drivers/ata/sata_sil24.c (revision 553c4aa630af7bc885e056d0436e4eb7f238579b)
1c6fd2807SJeff Garzik /*
2c6fd2807SJeff Garzik  * sata_sil24.c - Driver for Silicon Image 3124/3132 SATA-2 controllers
3c6fd2807SJeff Garzik  *
4c6fd2807SJeff Garzik  * Copyright 2005  Tejun Heo
5c6fd2807SJeff Garzik  *
6c6fd2807SJeff Garzik  * Based on preview driver from Silicon Image.
7c6fd2807SJeff Garzik  *
8c6fd2807SJeff Garzik  * This program is free software; you can redistribute it and/or modify it
9c6fd2807SJeff Garzik  * under the terms of the GNU General Public License as published by the
10c6fd2807SJeff Garzik  * Free Software Foundation; either version 2, or (at your option) any
11c6fd2807SJeff Garzik  * later version.
12c6fd2807SJeff Garzik  *
13c6fd2807SJeff Garzik  * This program is distributed in the hope that it will be useful, but
14c6fd2807SJeff Garzik  * WITHOUT ANY WARRANTY; without even the implied warranty of
15c6fd2807SJeff Garzik  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16c6fd2807SJeff Garzik  * General Public License for more details.
17c6fd2807SJeff Garzik  *
18c6fd2807SJeff Garzik  */
19c6fd2807SJeff Garzik 
20c6fd2807SJeff Garzik #include <linux/kernel.h>
21c6fd2807SJeff Garzik #include <linux/module.h>
22c6fd2807SJeff Garzik #include <linux/pci.h>
23c6fd2807SJeff Garzik #include <linux/blkdev.h>
24c6fd2807SJeff Garzik #include <linux/delay.h>
25c6fd2807SJeff Garzik #include <linux/interrupt.h>
26c6fd2807SJeff Garzik #include <linux/dma-mapping.h>
27c6fd2807SJeff Garzik #include <linux/device.h>
28c6fd2807SJeff Garzik #include <scsi/scsi_host.h>
29c6fd2807SJeff Garzik #include <scsi/scsi_cmnd.h>
30c6fd2807SJeff Garzik #include <linux/libata.h>
31c6fd2807SJeff Garzik #include <asm/io.h>
32c6fd2807SJeff Garzik 
33c6fd2807SJeff Garzik #define DRV_NAME	"sata_sil24"
34c6fd2807SJeff Garzik #define DRV_VERSION	"0.3"
35c6fd2807SJeff Garzik 
36c6fd2807SJeff Garzik /*
37c6fd2807SJeff Garzik  * Port request block (PRB) 32 bytes
38c6fd2807SJeff Garzik  */
39c6fd2807SJeff Garzik struct sil24_prb {
40c6fd2807SJeff Garzik 	__le16	ctrl;
41c6fd2807SJeff Garzik 	__le16	prot;
42c6fd2807SJeff Garzik 	__le32	rx_cnt;
43c6fd2807SJeff Garzik 	u8	fis[6 * 4];
44c6fd2807SJeff Garzik };
45c6fd2807SJeff Garzik 
46c6fd2807SJeff Garzik /*
47c6fd2807SJeff Garzik  * Scatter gather entry (SGE) 16 bytes
48c6fd2807SJeff Garzik  */
49c6fd2807SJeff Garzik struct sil24_sge {
50c6fd2807SJeff Garzik 	__le64	addr;
51c6fd2807SJeff Garzik 	__le32	cnt;
52c6fd2807SJeff Garzik 	__le32	flags;
53c6fd2807SJeff Garzik };
54c6fd2807SJeff Garzik 
55c6fd2807SJeff Garzik /*
56c6fd2807SJeff Garzik  * Port multiplier
57c6fd2807SJeff Garzik  */
58c6fd2807SJeff Garzik struct sil24_port_multiplier {
59c6fd2807SJeff Garzik 	__le32	diag;
60c6fd2807SJeff Garzik 	__le32	sactive;
61c6fd2807SJeff Garzik };
62c6fd2807SJeff Garzik 
63c6fd2807SJeff Garzik enum {
64c6fd2807SJeff Garzik 	/*
65c6fd2807SJeff Garzik 	 * Global controller registers (128 bytes @ BAR0)
66c6fd2807SJeff Garzik 	 */
67c6fd2807SJeff Garzik 		/* 32 bit regs */
68c6fd2807SJeff Garzik 	HOST_SLOT_STAT		= 0x00, /* 32 bit slot stat * 4 */
69c6fd2807SJeff Garzik 	HOST_CTRL		= 0x40,
70c6fd2807SJeff Garzik 	HOST_IRQ_STAT		= 0x44,
71c6fd2807SJeff Garzik 	HOST_PHY_CFG		= 0x48,
72c6fd2807SJeff Garzik 	HOST_BIST_CTRL		= 0x50,
73c6fd2807SJeff Garzik 	HOST_BIST_PTRN		= 0x54,
74c6fd2807SJeff Garzik 	HOST_BIST_STAT		= 0x58,
75c6fd2807SJeff Garzik 	HOST_MEM_BIST_STAT	= 0x5c,
76c6fd2807SJeff Garzik 	HOST_FLASH_CMD		= 0x70,
77c6fd2807SJeff Garzik 		/* 8 bit regs */
78c6fd2807SJeff Garzik 	HOST_FLASH_DATA		= 0x74,
79c6fd2807SJeff Garzik 	HOST_TRANSITION_DETECT	= 0x75,
80c6fd2807SJeff Garzik 	HOST_GPIO_CTRL		= 0x76,
81c6fd2807SJeff Garzik 	HOST_I2C_ADDR		= 0x78, /* 32 bit */
82c6fd2807SJeff Garzik 	HOST_I2C_DATA		= 0x7c,
83c6fd2807SJeff Garzik 	HOST_I2C_XFER_CNT	= 0x7e,
84c6fd2807SJeff Garzik 	HOST_I2C_CTRL		= 0x7f,
85c6fd2807SJeff Garzik 
86c6fd2807SJeff Garzik 	/* HOST_SLOT_STAT bits */
87c6fd2807SJeff Garzik 	HOST_SSTAT_ATTN		= (1 << 31),
88c6fd2807SJeff Garzik 
89c6fd2807SJeff Garzik 	/* HOST_CTRL bits */
90c6fd2807SJeff Garzik 	HOST_CTRL_M66EN		= (1 << 16), /* M66EN PCI bus signal */
91c6fd2807SJeff Garzik 	HOST_CTRL_TRDY		= (1 << 17), /* latched PCI TRDY */
92c6fd2807SJeff Garzik 	HOST_CTRL_STOP		= (1 << 18), /* latched PCI STOP */
93c6fd2807SJeff Garzik 	HOST_CTRL_DEVSEL	= (1 << 19), /* latched PCI DEVSEL */
94c6fd2807SJeff Garzik 	HOST_CTRL_REQ64		= (1 << 20), /* latched PCI REQ64 */
95c6fd2807SJeff Garzik 	HOST_CTRL_GLOBAL_RST	= (1 << 31), /* global reset */
96c6fd2807SJeff Garzik 
97c6fd2807SJeff Garzik 	/*
98c6fd2807SJeff Garzik 	 * Port registers
99c6fd2807SJeff Garzik 	 * (8192 bytes @ +0x0000, +0x2000, +0x4000 and +0x6000 @ BAR2)
100c6fd2807SJeff Garzik 	 */
101c6fd2807SJeff Garzik 	PORT_REGS_SIZE		= 0x2000,
102c6fd2807SJeff Garzik 
10328c8f3b4STejun Heo 	PORT_LRAM		= 0x0000, /* 31 LRAM slots and PMP regs */
104c6fd2807SJeff Garzik 	PORT_LRAM_SLOT_SZ	= 0x0080, /* 32 bytes PRB + 2 SGE, ACT... */
105c6fd2807SJeff Garzik 
10628c8f3b4STejun Heo 	PORT_PMP		= 0x0f80, /* 8 bytes PMP * 16 (128 bytes) */
107c0c55908STejun Heo 	PORT_PMP_STATUS		= 0x0000, /* port device status offset */
108c0c55908STejun Heo 	PORT_PMP_QACTIVE	= 0x0004, /* port device QActive offset */
109c0c55908STejun Heo 	PORT_PMP_SIZE		= 0x0008, /* 8 bytes per PMP */
110c0c55908STejun Heo 
111c6fd2807SJeff Garzik 		/* 32 bit regs */
112c6fd2807SJeff Garzik 	PORT_CTRL_STAT		= 0x1000, /* write: ctrl-set, read: stat */
113c6fd2807SJeff Garzik 	PORT_CTRL_CLR		= 0x1004, /* write: ctrl-clear */
114c6fd2807SJeff Garzik 	PORT_IRQ_STAT		= 0x1008, /* high: status, low: interrupt */
115c6fd2807SJeff Garzik 	PORT_IRQ_ENABLE_SET	= 0x1010, /* write: enable-set */
116c6fd2807SJeff Garzik 	PORT_IRQ_ENABLE_CLR	= 0x1014, /* write: enable-clear */
117c6fd2807SJeff Garzik 	PORT_ACTIVATE_UPPER_ADDR= 0x101c,
118c6fd2807SJeff Garzik 	PORT_EXEC_FIFO		= 0x1020, /* command execution fifo */
119c6fd2807SJeff Garzik 	PORT_CMD_ERR		= 0x1024, /* command error number */
120c6fd2807SJeff Garzik 	PORT_FIS_CFG		= 0x1028,
121c6fd2807SJeff Garzik 	PORT_FIFO_THRES		= 0x102c,
122c6fd2807SJeff Garzik 		/* 16 bit regs */
123c6fd2807SJeff Garzik 	PORT_DECODE_ERR_CNT	= 0x1040,
124c6fd2807SJeff Garzik 	PORT_DECODE_ERR_THRESH	= 0x1042,
125c6fd2807SJeff Garzik 	PORT_CRC_ERR_CNT	= 0x1044,
126c6fd2807SJeff Garzik 	PORT_CRC_ERR_THRESH	= 0x1046,
127c6fd2807SJeff Garzik 	PORT_HSHK_ERR_CNT	= 0x1048,
128c6fd2807SJeff Garzik 	PORT_HSHK_ERR_THRESH	= 0x104a,
129c6fd2807SJeff Garzik 		/* 32 bit regs */
130c6fd2807SJeff Garzik 	PORT_PHY_CFG		= 0x1050,
131c6fd2807SJeff Garzik 	PORT_SLOT_STAT		= 0x1800,
132c6fd2807SJeff Garzik 	PORT_CMD_ACTIVATE	= 0x1c00, /* 64 bit cmd activate * 31 (248 bytes) */
133c0c55908STejun Heo 	PORT_CONTEXT		= 0x1e04,
134c6fd2807SJeff Garzik 	PORT_EXEC_DIAG		= 0x1e00, /* 32bit exec diag * 16 (64 bytes, 0-10 used on 3124) */
135c6fd2807SJeff Garzik 	PORT_PSD_DIAG		= 0x1e40, /* 32bit psd diag * 16 (64 bytes, 0-8 used on 3124) */
136c6fd2807SJeff Garzik 	PORT_SCONTROL		= 0x1f00,
137c6fd2807SJeff Garzik 	PORT_SSTATUS		= 0x1f04,
138c6fd2807SJeff Garzik 	PORT_SERROR		= 0x1f08,
139c6fd2807SJeff Garzik 	PORT_SACTIVE		= 0x1f0c,
140c6fd2807SJeff Garzik 
141c6fd2807SJeff Garzik 	/* PORT_CTRL_STAT bits */
142c6fd2807SJeff Garzik 	PORT_CS_PORT_RST	= (1 << 0), /* port reset */
143c6fd2807SJeff Garzik 	PORT_CS_DEV_RST		= (1 << 1), /* device reset */
144c6fd2807SJeff Garzik 	PORT_CS_INIT		= (1 << 2), /* port initialize */
145c6fd2807SJeff Garzik 	PORT_CS_IRQ_WOC		= (1 << 3), /* interrupt write one to clear */
146c6fd2807SJeff Garzik 	PORT_CS_CDB16		= (1 << 5), /* 0=12b cdb, 1=16b cdb */
14728c8f3b4STejun Heo 	PORT_CS_PMP_RESUME	= (1 << 6), /* PMP resume */
148c6fd2807SJeff Garzik 	PORT_CS_32BIT_ACTV	= (1 << 10), /* 32-bit activation */
14928c8f3b4STejun Heo 	PORT_CS_PMP_EN		= (1 << 13), /* port multiplier enable */
150c6fd2807SJeff Garzik 	PORT_CS_RDY		= (1 << 31), /* port ready to accept commands */
151c6fd2807SJeff Garzik 
152c6fd2807SJeff Garzik 	/* PORT_IRQ_STAT/ENABLE_SET/CLR */
153c6fd2807SJeff Garzik 	/* bits[11:0] are masked */
154c6fd2807SJeff Garzik 	PORT_IRQ_COMPLETE	= (1 << 0), /* command(s) completed */
155c6fd2807SJeff Garzik 	PORT_IRQ_ERROR		= (1 << 1), /* command execution error */
156c6fd2807SJeff Garzik 	PORT_IRQ_PORTRDY_CHG	= (1 << 2), /* port ready change */
157c6fd2807SJeff Garzik 	PORT_IRQ_PWR_CHG	= (1 << 3), /* power management change */
158c6fd2807SJeff Garzik 	PORT_IRQ_PHYRDY_CHG	= (1 << 4), /* PHY ready change */
159c6fd2807SJeff Garzik 	PORT_IRQ_COMWAKE	= (1 << 5), /* COMWAKE received */
160c6fd2807SJeff Garzik 	PORT_IRQ_UNK_FIS	= (1 << 6), /* unknown FIS received */
161c6fd2807SJeff Garzik 	PORT_IRQ_DEV_XCHG	= (1 << 7), /* device exchanged */
162c6fd2807SJeff Garzik 	PORT_IRQ_8B10B		= (1 << 8), /* 8b/10b decode error threshold */
163c6fd2807SJeff Garzik 	PORT_IRQ_CRC		= (1 << 9), /* CRC error threshold */
164c6fd2807SJeff Garzik 	PORT_IRQ_HANDSHAKE	= (1 << 10), /* handshake error threshold */
165c6fd2807SJeff Garzik 	PORT_IRQ_SDB_NOTIFY	= (1 << 11), /* SDB notify received */
166c6fd2807SJeff Garzik 
167c6fd2807SJeff Garzik 	DEF_PORT_IRQ		= PORT_IRQ_COMPLETE | PORT_IRQ_ERROR |
168c6fd2807SJeff Garzik 				  PORT_IRQ_PHYRDY_CHG | PORT_IRQ_DEV_XCHG |
169c6fd2807SJeff Garzik 				  PORT_IRQ_UNK_FIS,
170c6fd2807SJeff Garzik 
171c6fd2807SJeff Garzik 	/* bits[27:16] are unmasked (raw) */
172c6fd2807SJeff Garzik 	PORT_IRQ_RAW_SHIFT	= 16,
173c6fd2807SJeff Garzik 	PORT_IRQ_MASKED_MASK	= 0x7ff,
174c6fd2807SJeff Garzik 	PORT_IRQ_RAW_MASK	= (0x7ff << PORT_IRQ_RAW_SHIFT),
175c6fd2807SJeff Garzik 
176c6fd2807SJeff Garzik 	/* ENABLE_SET/CLR specific, intr steering - 2 bit field */
177c6fd2807SJeff Garzik 	PORT_IRQ_STEER_SHIFT	= 30,
178c6fd2807SJeff Garzik 	PORT_IRQ_STEER_MASK	= (3 << PORT_IRQ_STEER_SHIFT),
179c6fd2807SJeff Garzik 
180c6fd2807SJeff Garzik 	/* PORT_CMD_ERR constants */
181c6fd2807SJeff Garzik 	PORT_CERR_DEV		= 1, /* Error bit in D2H Register FIS */
182c6fd2807SJeff Garzik 	PORT_CERR_SDB		= 2, /* Error bit in SDB FIS */
183c6fd2807SJeff Garzik 	PORT_CERR_DATA		= 3, /* Error in data FIS not detected by dev */
184c6fd2807SJeff Garzik 	PORT_CERR_SEND		= 4, /* Initial cmd FIS transmission failure */
185c6fd2807SJeff Garzik 	PORT_CERR_INCONSISTENT	= 5, /* Protocol mismatch */
186c6fd2807SJeff Garzik 	PORT_CERR_DIRECTION	= 6, /* Data direction mismatch */
187c6fd2807SJeff Garzik 	PORT_CERR_UNDERRUN	= 7, /* Ran out of SGEs while writing */
188c6fd2807SJeff Garzik 	PORT_CERR_OVERRUN	= 8, /* Ran out of SGEs while reading */
189c6fd2807SJeff Garzik 	PORT_CERR_PKT_PROT	= 11, /* DIR invalid in 1st PIO setup of ATAPI */
190c6fd2807SJeff Garzik 	PORT_CERR_SGT_BOUNDARY	= 16, /* PLD ecode 00 - SGT not on qword boundary */
191c6fd2807SJeff Garzik 	PORT_CERR_SGT_TGTABRT	= 17, /* PLD ecode 01 - target abort */
192c6fd2807SJeff Garzik 	PORT_CERR_SGT_MSTABRT	= 18, /* PLD ecode 10 - master abort */
193c6fd2807SJeff Garzik 	PORT_CERR_SGT_PCIPERR	= 19, /* PLD ecode 11 - PCI parity err while fetching SGT */
194c6fd2807SJeff Garzik 	PORT_CERR_CMD_BOUNDARY	= 24, /* ctrl[15:13] 001 - PRB not on qword boundary */
195c6fd2807SJeff Garzik 	PORT_CERR_CMD_TGTABRT	= 25, /* ctrl[15:13] 010 - target abort */
196c6fd2807SJeff Garzik 	PORT_CERR_CMD_MSTABRT	= 26, /* ctrl[15:13] 100 - master abort */
197c6fd2807SJeff Garzik 	PORT_CERR_CMD_PCIPERR	= 27, /* ctrl[15:13] 110 - PCI parity err while fetching PRB */
198c6fd2807SJeff Garzik 	PORT_CERR_XFR_UNDEF	= 32, /* PSD ecode 00 - undefined */
199c6fd2807SJeff Garzik 	PORT_CERR_XFR_TGTABRT	= 33, /* PSD ecode 01 - target abort */
200c6fd2807SJeff Garzik 	PORT_CERR_XFR_MSTABRT	= 34, /* PSD ecode 10 - master abort */
201c6fd2807SJeff Garzik 	PORT_CERR_XFR_PCIPERR	= 35, /* PSD ecode 11 - PCI prity err during transfer */
202c6fd2807SJeff Garzik 	PORT_CERR_SENDSERVICE	= 36, /* FIS received while sending service */
203c6fd2807SJeff Garzik 
204c6fd2807SJeff Garzik 	/* bits of PRB control field */
205c6fd2807SJeff Garzik 	PRB_CTRL_PROTOCOL	= (1 << 0), /* override def. ATA protocol */
206c6fd2807SJeff Garzik 	PRB_CTRL_PACKET_READ	= (1 << 4), /* PACKET cmd read */
207c6fd2807SJeff Garzik 	PRB_CTRL_PACKET_WRITE	= (1 << 5), /* PACKET cmd write */
208c6fd2807SJeff Garzik 	PRB_CTRL_NIEN		= (1 << 6), /* Mask completion irq */
209c6fd2807SJeff Garzik 	PRB_CTRL_SRST		= (1 << 7), /* Soft reset request (ign BSY?) */
210c6fd2807SJeff Garzik 
211c6fd2807SJeff Garzik 	/* PRB protocol field */
212c6fd2807SJeff Garzik 	PRB_PROT_PACKET		= (1 << 0),
213c6fd2807SJeff Garzik 	PRB_PROT_TCQ		= (1 << 1),
214c6fd2807SJeff Garzik 	PRB_PROT_NCQ		= (1 << 2),
215c6fd2807SJeff Garzik 	PRB_PROT_READ		= (1 << 3),
216c6fd2807SJeff Garzik 	PRB_PROT_WRITE		= (1 << 4),
217c6fd2807SJeff Garzik 	PRB_PROT_TRANSPARENT	= (1 << 5),
218c6fd2807SJeff Garzik 
219c6fd2807SJeff Garzik 	/*
220c6fd2807SJeff Garzik 	 * Other constants
221c6fd2807SJeff Garzik 	 */
222c6fd2807SJeff Garzik 	SGE_TRM			= (1 << 31), /* Last SGE in chain */
223c6fd2807SJeff Garzik 	SGE_LNK			= (1 << 30), /* linked list
224c6fd2807SJeff Garzik 						Points to SGT, not SGE */
225c6fd2807SJeff Garzik 	SGE_DRD			= (1 << 29), /* discard data read (/dev/null)
226c6fd2807SJeff Garzik 						data address ignored */
227c6fd2807SJeff Garzik 
228c6fd2807SJeff Garzik 	SIL24_MAX_CMDS		= 31,
229c6fd2807SJeff Garzik 
230c6fd2807SJeff Garzik 	/* board id */
231c6fd2807SJeff Garzik 	BID_SIL3124		= 0,
232c6fd2807SJeff Garzik 	BID_SIL3132		= 1,
233c6fd2807SJeff Garzik 	BID_SIL3131		= 2,
234c6fd2807SJeff Garzik 
235c6fd2807SJeff Garzik 	/* host flags */
236c6fd2807SJeff Garzik 	SIL24_COMMON_FLAGS	= ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY |
237c6fd2807SJeff Garzik 				  ATA_FLAG_MMIO | ATA_FLAG_PIO_DMA |
238c6fd2807SJeff Garzik 				  ATA_FLAG_NCQ | ATA_FLAG_SKIP_D2H_BSY,
239c6fd2807SJeff Garzik 	SIL24_FLAG_PCIX_IRQ_WOC	= (1 << 24), /* IRQ loss errata on PCI-X */
240c6fd2807SJeff Garzik 
241c6fd2807SJeff Garzik 	IRQ_STAT_4PORTS		= 0xf,
242c6fd2807SJeff Garzik };
243c6fd2807SJeff Garzik 
244c6fd2807SJeff Garzik struct sil24_ata_block {
245c6fd2807SJeff Garzik 	struct sil24_prb prb;
246c6fd2807SJeff Garzik 	struct sil24_sge sge[LIBATA_MAX_PRD];
247c6fd2807SJeff Garzik };
248c6fd2807SJeff Garzik 
249c6fd2807SJeff Garzik struct sil24_atapi_block {
250c6fd2807SJeff Garzik 	struct sil24_prb prb;
251c6fd2807SJeff Garzik 	u8 cdb[16];
252c6fd2807SJeff Garzik 	struct sil24_sge sge[LIBATA_MAX_PRD - 1];
253c6fd2807SJeff Garzik };
254c6fd2807SJeff Garzik 
255c6fd2807SJeff Garzik union sil24_cmd_block {
256c6fd2807SJeff Garzik 	struct sil24_ata_block ata;
257c6fd2807SJeff Garzik 	struct sil24_atapi_block atapi;
258c6fd2807SJeff Garzik };
259c6fd2807SJeff Garzik 
260c6fd2807SJeff Garzik static struct sil24_cerr_info {
261c6fd2807SJeff Garzik 	unsigned int err_mask, action;
262c6fd2807SJeff Garzik 	const char *desc;
263c6fd2807SJeff Garzik } sil24_cerr_db[] = {
264c6fd2807SJeff Garzik 	[0]			= { AC_ERR_DEV, ATA_EH_REVALIDATE,
265c6fd2807SJeff Garzik 				    "device error" },
266c6fd2807SJeff Garzik 	[PORT_CERR_DEV]		= { AC_ERR_DEV, ATA_EH_REVALIDATE,
267c6fd2807SJeff Garzik 				    "device error via D2H FIS" },
268c6fd2807SJeff Garzik 	[PORT_CERR_SDB]		= { AC_ERR_DEV, ATA_EH_REVALIDATE,
269c6fd2807SJeff Garzik 				    "device error via SDB FIS" },
270c6fd2807SJeff Garzik 	[PORT_CERR_DATA]	= { AC_ERR_ATA_BUS, ATA_EH_SOFTRESET,
271c6fd2807SJeff Garzik 				    "error in data FIS" },
272c6fd2807SJeff Garzik 	[PORT_CERR_SEND]	= { AC_ERR_ATA_BUS, ATA_EH_SOFTRESET,
273c6fd2807SJeff Garzik 				    "failed to transmit command FIS" },
274c6fd2807SJeff Garzik 	[PORT_CERR_INCONSISTENT] = { AC_ERR_HSM, ATA_EH_SOFTRESET,
275c6fd2807SJeff Garzik 				     "protocol mismatch" },
276c6fd2807SJeff Garzik 	[PORT_CERR_DIRECTION]	= { AC_ERR_HSM, ATA_EH_SOFTRESET,
277c6fd2807SJeff Garzik 				    "data directon mismatch" },
278c6fd2807SJeff Garzik 	[PORT_CERR_UNDERRUN]	= { AC_ERR_HSM, ATA_EH_SOFTRESET,
279c6fd2807SJeff Garzik 				    "ran out of SGEs while writing" },
280c6fd2807SJeff Garzik 	[PORT_CERR_OVERRUN]	= { AC_ERR_HSM, ATA_EH_SOFTRESET,
281c6fd2807SJeff Garzik 				    "ran out of SGEs while reading" },
282c6fd2807SJeff Garzik 	[PORT_CERR_PKT_PROT]	= { AC_ERR_HSM, ATA_EH_SOFTRESET,
283c6fd2807SJeff Garzik 				    "invalid data directon for ATAPI CDB" },
284c6fd2807SJeff Garzik 	[PORT_CERR_SGT_BOUNDARY] = { AC_ERR_SYSTEM, ATA_EH_SOFTRESET,
285c6fd2807SJeff Garzik 				     "SGT no on qword boundary" },
286c6fd2807SJeff Garzik 	[PORT_CERR_SGT_TGTABRT]	= { AC_ERR_HOST_BUS, ATA_EH_SOFTRESET,
287c6fd2807SJeff Garzik 				    "PCI target abort while fetching SGT" },
288c6fd2807SJeff Garzik 	[PORT_CERR_SGT_MSTABRT]	= { AC_ERR_HOST_BUS, ATA_EH_SOFTRESET,
289c6fd2807SJeff Garzik 				    "PCI master abort while fetching SGT" },
290c6fd2807SJeff Garzik 	[PORT_CERR_SGT_PCIPERR]	= { AC_ERR_HOST_BUS, ATA_EH_SOFTRESET,
291c6fd2807SJeff Garzik 				    "PCI parity error while fetching SGT" },
292c6fd2807SJeff Garzik 	[PORT_CERR_CMD_BOUNDARY] = { AC_ERR_SYSTEM, ATA_EH_SOFTRESET,
293c6fd2807SJeff Garzik 				     "PRB not on qword boundary" },
294c6fd2807SJeff Garzik 	[PORT_CERR_CMD_TGTABRT]	= { AC_ERR_HOST_BUS, ATA_EH_SOFTRESET,
295c6fd2807SJeff Garzik 				    "PCI target abort while fetching PRB" },
296c6fd2807SJeff Garzik 	[PORT_CERR_CMD_MSTABRT]	= { AC_ERR_HOST_BUS, ATA_EH_SOFTRESET,
297c6fd2807SJeff Garzik 				    "PCI master abort while fetching PRB" },
298c6fd2807SJeff Garzik 	[PORT_CERR_CMD_PCIPERR]	= { AC_ERR_HOST_BUS, ATA_EH_SOFTRESET,
299c6fd2807SJeff Garzik 				    "PCI parity error while fetching PRB" },
300c6fd2807SJeff Garzik 	[PORT_CERR_XFR_UNDEF]	= { AC_ERR_HOST_BUS, ATA_EH_SOFTRESET,
301c6fd2807SJeff Garzik 				    "undefined error while transferring data" },
302c6fd2807SJeff Garzik 	[PORT_CERR_XFR_TGTABRT]	= { AC_ERR_HOST_BUS, ATA_EH_SOFTRESET,
303c6fd2807SJeff Garzik 				    "PCI target abort while transferring data" },
304c6fd2807SJeff Garzik 	[PORT_CERR_XFR_MSTABRT]	= { AC_ERR_HOST_BUS, ATA_EH_SOFTRESET,
305c6fd2807SJeff Garzik 				    "PCI master abort while transferring data" },
306c6fd2807SJeff Garzik 	[PORT_CERR_XFR_PCIPERR]	= { AC_ERR_HOST_BUS, ATA_EH_SOFTRESET,
307c6fd2807SJeff Garzik 				    "PCI parity error while transferring data" },
308c6fd2807SJeff Garzik 	[PORT_CERR_SENDSERVICE]	= { AC_ERR_HSM, ATA_EH_SOFTRESET,
309c6fd2807SJeff Garzik 				    "FIS received while sending service FIS" },
310c6fd2807SJeff Garzik };
311c6fd2807SJeff Garzik 
312c6fd2807SJeff Garzik /*
313c6fd2807SJeff Garzik  * ap->private_data
314c6fd2807SJeff Garzik  *
315c6fd2807SJeff Garzik  * The preview driver always returned 0 for status.  We emulate it
316c6fd2807SJeff Garzik  * here from the previous interrupt.
317c6fd2807SJeff Garzik  */
318c6fd2807SJeff Garzik struct sil24_port_priv {
319c6fd2807SJeff Garzik 	union sil24_cmd_block *cmd_block;	/* 32 cmd blocks */
320c6fd2807SJeff Garzik 	dma_addr_t cmd_block_dma;		/* DMA base addr for them */
321c6fd2807SJeff Garzik 	struct ata_taskfile tf;			/* Cached taskfile registers */
322c6fd2807SJeff Garzik };
323c6fd2807SJeff Garzik 
324cca3974eSJeff Garzik /* ap->host->private_data */
325c6fd2807SJeff Garzik struct sil24_host_priv {
326c6fd2807SJeff Garzik 	void __iomem *host_base;	/* global controller control (128 bytes @BAR0) */
327c6fd2807SJeff Garzik 	void __iomem *port_base;	/* port registers (4 * 8192 bytes @BAR2) */
328c6fd2807SJeff Garzik };
329c6fd2807SJeff Garzik 
330c6fd2807SJeff Garzik static void sil24_dev_config(struct ata_port *ap, struct ata_device *dev);
331c6fd2807SJeff Garzik static u8 sil24_check_status(struct ata_port *ap);
332c6fd2807SJeff Garzik static u32 sil24_scr_read(struct ata_port *ap, unsigned sc_reg);
333c6fd2807SJeff Garzik static void sil24_scr_write(struct ata_port *ap, unsigned sc_reg, u32 val);
334c6fd2807SJeff Garzik static void sil24_tf_read(struct ata_port *ap, struct ata_taskfile *tf);
335c6fd2807SJeff Garzik static void sil24_qc_prep(struct ata_queued_cmd *qc);
336c6fd2807SJeff Garzik static unsigned int sil24_qc_issue(struct ata_queued_cmd *qc);
337c6fd2807SJeff Garzik static void sil24_irq_clear(struct ata_port *ap);
3387d12e780SDavid Howells static irqreturn_t sil24_interrupt(int irq, void *dev_instance);
339c6fd2807SJeff Garzik static void sil24_freeze(struct ata_port *ap);
340c6fd2807SJeff Garzik static void sil24_thaw(struct ata_port *ap);
341c6fd2807SJeff Garzik static void sil24_error_handler(struct ata_port *ap);
342c6fd2807SJeff Garzik static void sil24_post_internal_cmd(struct ata_queued_cmd *qc);
343c6fd2807SJeff Garzik static int sil24_port_start(struct ata_port *ap);
344c6fd2807SJeff Garzik static void sil24_port_stop(struct ata_port *ap);
345cca3974eSJeff Garzik static void sil24_host_stop(struct ata_host *host);
346c6fd2807SJeff Garzik static int sil24_init_one(struct pci_dev *pdev, const struct pci_device_id *ent);
347281d426cSAlexey Dobriyan #ifdef CONFIG_PM
348c6fd2807SJeff Garzik static int sil24_pci_device_resume(struct pci_dev *pdev);
349281d426cSAlexey Dobriyan #endif
350c6fd2807SJeff Garzik 
351c6fd2807SJeff Garzik static const struct pci_device_id sil24_pci_tbl[] = {
35254bb3a94SJeff Garzik 	{ PCI_VDEVICE(CMD, 0x3124), BID_SIL3124 },
35354bb3a94SJeff Garzik 	{ PCI_VDEVICE(INTEL, 0x3124), BID_SIL3124 },
35454bb3a94SJeff Garzik 	{ PCI_VDEVICE(CMD, 0x3132), BID_SIL3132 },
35554bb3a94SJeff Garzik 	{ PCI_VDEVICE(CMD, 0x3131), BID_SIL3131 },
35654bb3a94SJeff Garzik 	{ PCI_VDEVICE(CMD, 0x3531), BID_SIL3131 },
35754bb3a94SJeff Garzik 
358c6fd2807SJeff Garzik 	{ } /* terminate list */
359c6fd2807SJeff Garzik };
360c6fd2807SJeff Garzik 
361c6fd2807SJeff Garzik static struct pci_driver sil24_pci_driver = {
362c6fd2807SJeff Garzik 	.name			= DRV_NAME,
363c6fd2807SJeff Garzik 	.id_table		= sil24_pci_tbl,
364c6fd2807SJeff Garzik 	.probe			= sil24_init_one,
365c6fd2807SJeff Garzik 	.remove			= ata_pci_remove_one, /* safe? */
366281d426cSAlexey Dobriyan #ifdef CONFIG_PM
367c6fd2807SJeff Garzik 	.suspend		= ata_pci_device_suspend,
368c6fd2807SJeff Garzik 	.resume			= sil24_pci_device_resume,
369281d426cSAlexey Dobriyan #endif
370c6fd2807SJeff Garzik };
371c6fd2807SJeff Garzik 
372c6fd2807SJeff Garzik static struct scsi_host_template sil24_sht = {
373c6fd2807SJeff Garzik 	.module			= THIS_MODULE,
374c6fd2807SJeff Garzik 	.name			= DRV_NAME,
375c6fd2807SJeff Garzik 	.ioctl			= ata_scsi_ioctl,
376c6fd2807SJeff Garzik 	.queuecommand		= ata_scsi_queuecmd,
377c6fd2807SJeff Garzik 	.change_queue_depth	= ata_scsi_change_queue_depth,
378c6fd2807SJeff Garzik 	.can_queue		= SIL24_MAX_CMDS,
379c6fd2807SJeff Garzik 	.this_id		= ATA_SHT_THIS_ID,
380c6fd2807SJeff Garzik 	.sg_tablesize		= LIBATA_MAX_PRD,
381c6fd2807SJeff Garzik 	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
382c6fd2807SJeff Garzik 	.emulated		= ATA_SHT_EMULATED,
383c6fd2807SJeff Garzik 	.use_clustering		= ATA_SHT_USE_CLUSTERING,
384c6fd2807SJeff Garzik 	.proc_name		= DRV_NAME,
385c6fd2807SJeff Garzik 	.dma_boundary		= ATA_DMA_BOUNDARY,
386c6fd2807SJeff Garzik 	.slave_configure	= ata_scsi_slave_config,
387c6fd2807SJeff Garzik 	.slave_destroy		= ata_scsi_slave_destroy,
388c6fd2807SJeff Garzik 	.bios_param		= ata_std_bios_param,
389c6fd2807SJeff Garzik 	.suspend		= ata_scsi_device_suspend,
390c6fd2807SJeff Garzik 	.resume			= ata_scsi_device_resume,
391c6fd2807SJeff Garzik };
392c6fd2807SJeff Garzik 
393c6fd2807SJeff Garzik static const struct ata_port_operations sil24_ops = {
394c6fd2807SJeff Garzik 	.port_disable		= ata_port_disable,
395c6fd2807SJeff Garzik 
396c6fd2807SJeff Garzik 	.dev_config		= sil24_dev_config,
397c6fd2807SJeff Garzik 
398c6fd2807SJeff Garzik 	.check_status		= sil24_check_status,
399c6fd2807SJeff Garzik 	.check_altstatus	= sil24_check_status,
400c6fd2807SJeff Garzik 	.dev_select		= ata_noop_dev_select,
401c6fd2807SJeff Garzik 
402c6fd2807SJeff Garzik 	.tf_read		= sil24_tf_read,
403c6fd2807SJeff Garzik 
404c6fd2807SJeff Garzik 	.qc_prep		= sil24_qc_prep,
405c6fd2807SJeff Garzik 	.qc_issue		= sil24_qc_issue,
406c6fd2807SJeff Garzik 
407c6fd2807SJeff Garzik 	.irq_handler		= sil24_interrupt,
408c6fd2807SJeff Garzik 	.irq_clear		= sil24_irq_clear,
409c6fd2807SJeff Garzik 
410c6fd2807SJeff Garzik 	.scr_read		= sil24_scr_read,
411c6fd2807SJeff Garzik 	.scr_write		= sil24_scr_write,
412c6fd2807SJeff Garzik 
413c6fd2807SJeff Garzik 	.freeze			= sil24_freeze,
414c6fd2807SJeff Garzik 	.thaw			= sil24_thaw,
415c6fd2807SJeff Garzik 	.error_handler		= sil24_error_handler,
416c6fd2807SJeff Garzik 	.post_internal_cmd	= sil24_post_internal_cmd,
417c6fd2807SJeff Garzik 
418c6fd2807SJeff Garzik 	.port_start		= sil24_port_start,
419c6fd2807SJeff Garzik 	.port_stop		= sil24_port_stop,
420c6fd2807SJeff Garzik 	.host_stop		= sil24_host_stop,
421c6fd2807SJeff Garzik };
422c6fd2807SJeff Garzik 
423c6fd2807SJeff Garzik /*
424cca3974eSJeff Garzik  * Use bits 30-31 of port_flags to encode available port numbers.
425c6fd2807SJeff Garzik  * Current maxium is 4.
426c6fd2807SJeff Garzik  */
427c6fd2807SJeff Garzik #define SIL24_NPORTS2FLAG(nports)	((((unsigned)(nports) - 1) & 0x3) << 30)
428c6fd2807SJeff Garzik #define SIL24_FLAG2NPORTS(flag)		((((flag) >> 30) & 0x3) + 1)
429c6fd2807SJeff Garzik 
430c6fd2807SJeff Garzik static struct ata_port_info sil24_port_info[] = {
431c6fd2807SJeff Garzik 	/* sil_3124 */
432c6fd2807SJeff Garzik 	{
433c6fd2807SJeff Garzik 		.sht		= &sil24_sht,
434cca3974eSJeff Garzik 		.flags		= SIL24_COMMON_FLAGS | SIL24_NPORTS2FLAG(4) |
435c6fd2807SJeff Garzik 				  SIL24_FLAG_PCIX_IRQ_WOC,
436c6fd2807SJeff Garzik 		.pio_mask	= 0x1f,			/* pio0-4 */
437c6fd2807SJeff Garzik 		.mwdma_mask	= 0x07,			/* mwdma0-2 */
438c6fd2807SJeff Garzik 		.udma_mask	= 0x3f,			/* udma0-5 */
439c6fd2807SJeff Garzik 		.port_ops	= &sil24_ops,
440c6fd2807SJeff Garzik 	},
441c6fd2807SJeff Garzik 	/* sil_3132 */
442c6fd2807SJeff Garzik 	{
443c6fd2807SJeff Garzik 		.sht		= &sil24_sht,
444cca3974eSJeff Garzik 		.flags		= SIL24_COMMON_FLAGS | SIL24_NPORTS2FLAG(2),
445c6fd2807SJeff Garzik 		.pio_mask	= 0x1f,			/* pio0-4 */
446c6fd2807SJeff Garzik 		.mwdma_mask	= 0x07,			/* mwdma0-2 */
447c6fd2807SJeff Garzik 		.udma_mask	= 0x3f,			/* udma0-5 */
448c6fd2807SJeff Garzik 		.port_ops	= &sil24_ops,
449c6fd2807SJeff Garzik 	},
450c6fd2807SJeff Garzik 	/* sil_3131/sil_3531 */
451c6fd2807SJeff Garzik 	{
452c6fd2807SJeff Garzik 		.sht		= &sil24_sht,
453cca3974eSJeff Garzik 		.flags		= SIL24_COMMON_FLAGS | SIL24_NPORTS2FLAG(1),
454c6fd2807SJeff Garzik 		.pio_mask	= 0x1f,			/* pio0-4 */
455c6fd2807SJeff Garzik 		.mwdma_mask	= 0x07,			/* mwdma0-2 */
456c6fd2807SJeff Garzik 		.udma_mask	= 0x3f,			/* udma0-5 */
457c6fd2807SJeff Garzik 		.port_ops	= &sil24_ops,
458c6fd2807SJeff Garzik 	},
459c6fd2807SJeff Garzik };
460c6fd2807SJeff Garzik 
461c6fd2807SJeff Garzik static int sil24_tag(int tag)
462c6fd2807SJeff Garzik {
463c6fd2807SJeff Garzik 	if (unlikely(ata_tag_internal(tag)))
464c6fd2807SJeff Garzik 		return 0;
465c6fd2807SJeff Garzik 	return tag;
466c6fd2807SJeff Garzik }
467c6fd2807SJeff Garzik 
468c6fd2807SJeff Garzik static void sil24_dev_config(struct ata_port *ap, struct ata_device *dev)
469c6fd2807SJeff Garzik {
470c6fd2807SJeff Garzik 	void __iomem *port = (void __iomem *)ap->ioaddr.cmd_addr;
471c6fd2807SJeff Garzik 
472c6fd2807SJeff Garzik 	if (dev->cdb_len == 16)
473c6fd2807SJeff Garzik 		writel(PORT_CS_CDB16, port + PORT_CTRL_STAT);
474c6fd2807SJeff Garzik 	else
475c6fd2807SJeff Garzik 		writel(PORT_CS_CDB16, port + PORT_CTRL_CLR);
476c6fd2807SJeff Garzik }
477c6fd2807SJeff Garzik 
478c6fd2807SJeff Garzik static inline void sil24_update_tf(struct ata_port *ap)
479c6fd2807SJeff Garzik {
480c6fd2807SJeff Garzik 	struct sil24_port_priv *pp = ap->private_data;
481c6fd2807SJeff Garzik 	void __iomem *port = (void __iomem *)ap->ioaddr.cmd_addr;
482c6fd2807SJeff Garzik 	struct sil24_prb __iomem *prb = port;
483c6fd2807SJeff Garzik 	u8 fis[6 * 4];
484c6fd2807SJeff Garzik 
485c6fd2807SJeff Garzik 	memcpy_fromio(fis, prb->fis, 6 * 4);
486c6fd2807SJeff Garzik 	ata_tf_from_fis(fis, &pp->tf);
487c6fd2807SJeff Garzik }
488c6fd2807SJeff Garzik 
489c6fd2807SJeff Garzik static u8 sil24_check_status(struct ata_port *ap)
490c6fd2807SJeff Garzik {
491c6fd2807SJeff Garzik 	struct sil24_port_priv *pp = ap->private_data;
492c6fd2807SJeff Garzik 	return pp->tf.command;
493c6fd2807SJeff Garzik }
494c6fd2807SJeff Garzik 
495c6fd2807SJeff Garzik static int sil24_scr_map[] = {
496c6fd2807SJeff Garzik 	[SCR_CONTROL]	= 0,
497c6fd2807SJeff Garzik 	[SCR_STATUS]	= 1,
498c6fd2807SJeff Garzik 	[SCR_ERROR]	= 2,
499c6fd2807SJeff Garzik 	[SCR_ACTIVE]	= 3,
500c6fd2807SJeff Garzik };
501c6fd2807SJeff Garzik 
502c6fd2807SJeff Garzik static u32 sil24_scr_read(struct ata_port *ap, unsigned sc_reg)
503c6fd2807SJeff Garzik {
504c6fd2807SJeff Garzik 	void __iomem *scr_addr = (void __iomem *)ap->ioaddr.scr_addr;
505c6fd2807SJeff Garzik 	if (sc_reg < ARRAY_SIZE(sil24_scr_map)) {
506c6fd2807SJeff Garzik 		void __iomem *addr;
507c6fd2807SJeff Garzik 		addr = scr_addr + sil24_scr_map[sc_reg] * 4;
508c6fd2807SJeff Garzik 		return readl(scr_addr + sil24_scr_map[sc_reg] * 4);
509c6fd2807SJeff Garzik 	}
510c6fd2807SJeff Garzik 	return 0xffffffffU;
511c6fd2807SJeff Garzik }
512c6fd2807SJeff Garzik 
513c6fd2807SJeff Garzik static void sil24_scr_write(struct ata_port *ap, unsigned sc_reg, u32 val)
514c6fd2807SJeff Garzik {
515c6fd2807SJeff Garzik 	void __iomem *scr_addr = (void __iomem *)ap->ioaddr.scr_addr;
516c6fd2807SJeff Garzik 	if (sc_reg < ARRAY_SIZE(sil24_scr_map)) {
517c6fd2807SJeff Garzik 		void __iomem *addr;
518c6fd2807SJeff Garzik 		addr = scr_addr + sil24_scr_map[sc_reg] * 4;
519c6fd2807SJeff Garzik 		writel(val, scr_addr + sil24_scr_map[sc_reg] * 4);
520c6fd2807SJeff Garzik 	}
521c6fd2807SJeff Garzik }
522c6fd2807SJeff Garzik 
523c6fd2807SJeff Garzik static void sil24_tf_read(struct ata_port *ap, struct ata_taskfile *tf)
524c6fd2807SJeff Garzik {
525c6fd2807SJeff Garzik 	struct sil24_port_priv *pp = ap->private_data;
526c6fd2807SJeff Garzik 	*tf = pp->tf;
527c6fd2807SJeff Garzik }
528c6fd2807SJeff Garzik 
529c6fd2807SJeff Garzik static int sil24_init_port(struct ata_port *ap)
530c6fd2807SJeff Garzik {
531c6fd2807SJeff Garzik 	void __iomem *port = (void __iomem *)ap->ioaddr.cmd_addr;
532c6fd2807SJeff Garzik 	u32 tmp;
533c6fd2807SJeff Garzik 
534c6fd2807SJeff Garzik 	writel(PORT_CS_INIT, port + PORT_CTRL_STAT);
535c6fd2807SJeff Garzik 	ata_wait_register(port + PORT_CTRL_STAT,
536c6fd2807SJeff Garzik 			  PORT_CS_INIT, PORT_CS_INIT, 10, 100);
537c6fd2807SJeff Garzik 	tmp = ata_wait_register(port + PORT_CTRL_STAT,
538c6fd2807SJeff Garzik 				PORT_CS_RDY, 0, 10, 100);
539c6fd2807SJeff Garzik 
540c6fd2807SJeff Garzik 	if ((tmp & (PORT_CS_INIT | PORT_CS_RDY)) != PORT_CS_RDY)
541c6fd2807SJeff Garzik 		return -EIO;
542c6fd2807SJeff Garzik 	return 0;
543c6fd2807SJeff Garzik }
544c6fd2807SJeff Garzik 
545c6fd2807SJeff Garzik static int sil24_softreset(struct ata_port *ap, unsigned int *class)
546c6fd2807SJeff Garzik {
547c6fd2807SJeff Garzik 	void __iomem *port = (void __iomem *)ap->ioaddr.cmd_addr;
548c6fd2807SJeff Garzik 	struct sil24_port_priv *pp = ap->private_data;
549c6fd2807SJeff Garzik 	struct sil24_prb *prb = &pp->cmd_block[0].ata.prb;
550c6fd2807SJeff Garzik 	dma_addr_t paddr = pp->cmd_block_dma;
551c6fd2807SJeff Garzik 	u32 mask, irq_stat;
552c6fd2807SJeff Garzik 	const char *reason;
553c6fd2807SJeff Garzik 
554c6fd2807SJeff Garzik 	DPRINTK("ENTER\n");
555c6fd2807SJeff Garzik 
556c6fd2807SJeff Garzik 	if (ata_port_offline(ap)) {
557c6fd2807SJeff Garzik 		DPRINTK("PHY reports no device\n");
558c6fd2807SJeff Garzik 		*class = ATA_DEV_NONE;
559c6fd2807SJeff Garzik 		goto out;
560c6fd2807SJeff Garzik 	}
561c6fd2807SJeff Garzik 
562c6fd2807SJeff Garzik 	/* put the port into known state */
563c6fd2807SJeff Garzik 	if (sil24_init_port(ap)) {
564c6fd2807SJeff Garzik 		reason ="port not ready";
565c6fd2807SJeff Garzik 		goto err;
566c6fd2807SJeff Garzik 	}
567c6fd2807SJeff Garzik 
568c6fd2807SJeff Garzik 	/* do SRST */
569c6fd2807SJeff Garzik 	prb->ctrl = cpu_to_le16(PRB_CTRL_SRST);
57028c8f3b4STejun Heo 	prb->fis[1] = 0; /* no PMP yet */
571c6fd2807SJeff Garzik 
572c6fd2807SJeff Garzik 	writel((u32)paddr, port + PORT_CMD_ACTIVATE);
573c6fd2807SJeff Garzik 	writel((u64)paddr >> 32, port + PORT_CMD_ACTIVATE + 4);
574c6fd2807SJeff Garzik 
575c6fd2807SJeff Garzik 	mask = (PORT_IRQ_COMPLETE | PORT_IRQ_ERROR) << PORT_IRQ_RAW_SHIFT;
576c6fd2807SJeff Garzik 	irq_stat = ata_wait_register(port + PORT_IRQ_STAT, mask, 0x0,
577c6fd2807SJeff Garzik 				     100, ATA_TMOUT_BOOT / HZ * 1000);
578c6fd2807SJeff Garzik 
579c6fd2807SJeff Garzik 	writel(irq_stat, port + PORT_IRQ_STAT); /* clear IRQs */
580c6fd2807SJeff Garzik 	irq_stat >>= PORT_IRQ_RAW_SHIFT;
581c6fd2807SJeff Garzik 
582c6fd2807SJeff Garzik 	if (!(irq_stat & PORT_IRQ_COMPLETE)) {
583c6fd2807SJeff Garzik 		if (irq_stat & PORT_IRQ_ERROR)
584c6fd2807SJeff Garzik 			reason = "SRST command error";
585c6fd2807SJeff Garzik 		else
586c6fd2807SJeff Garzik 			reason = "timeout";
587c6fd2807SJeff Garzik 		goto err;
588c6fd2807SJeff Garzik 	}
589c6fd2807SJeff Garzik 
590c6fd2807SJeff Garzik 	sil24_update_tf(ap);
591c6fd2807SJeff Garzik 	*class = ata_dev_classify(&pp->tf);
592c6fd2807SJeff Garzik 
593c6fd2807SJeff Garzik 	if (*class == ATA_DEV_UNKNOWN)
594c6fd2807SJeff Garzik 		*class = ATA_DEV_NONE;
595c6fd2807SJeff Garzik 
596c6fd2807SJeff Garzik  out:
597c6fd2807SJeff Garzik 	DPRINTK("EXIT, class=%u\n", *class);
598c6fd2807SJeff Garzik 	return 0;
599c6fd2807SJeff Garzik 
600c6fd2807SJeff Garzik  err:
601c6fd2807SJeff Garzik 	ata_port_printk(ap, KERN_ERR, "softreset failed (%s)\n", reason);
602c6fd2807SJeff Garzik 	return -EIO;
603c6fd2807SJeff Garzik }
604c6fd2807SJeff Garzik 
605c6fd2807SJeff Garzik static int sil24_hardreset(struct ata_port *ap, unsigned int *class)
606c6fd2807SJeff Garzik {
607c6fd2807SJeff Garzik 	void __iomem *port = (void __iomem *)ap->ioaddr.cmd_addr;
608c6fd2807SJeff Garzik 	const char *reason;
609c6fd2807SJeff Garzik 	int tout_msec, rc;
610c6fd2807SJeff Garzik 	u32 tmp;
611c6fd2807SJeff Garzik 
612c6fd2807SJeff Garzik 	/* sil24 does the right thing(tm) without any protection */
613c6fd2807SJeff Garzik 	sata_set_spd(ap);
614c6fd2807SJeff Garzik 
615c6fd2807SJeff Garzik 	tout_msec = 100;
616c6fd2807SJeff Garzik 	if (ata_port_online(ap))
617c6fd2807SJeff Garzik 		tout_msec = 5000;
618c6fd2807SJeff Garzik 
619c6fd2807SJeff Garzik 	writel(PORT_CS_DEV_RST, port + PORT_CTRL_STAT);
620c6fd2807SJeff Garzik 	tmp = ata_wait_register(port + PORT_CTRL_STAT,
621c6fd2807SJeff Garzik 				PORT_CS_DEV_RST, PORT_CS_DEV_RST, 10, tout_msec);
622c6fd2807SJeff Garzik 
623c6fd2807SJeff Garzik 	/* SStatus oscillates between zero and valid status after
624c6fd2807SJeff Garzik 	 * DEV_RST, debounce it.
625c6fd2807SJeff Garzik 	 */
626c6fd2807SJeff Garzik 	rc = sata_phy_debounce(ap, sata_deb_timing_long);
627c6fd2807SJeff Garzik 	if (rc) {
628c6fd2807SJeff Garzik 		reason = "PHY debouncing failed";
629c6fd2807SJeff Garzik 		goto err;
630c6fd2807SJeff Garzik 	}
631c6fd2807SJeff Garzik 
632c6fd2807SJeff Garzik 	if (tmp & PORT_CS_DEV_RST) {
633c6fd2807SJeff Garzik 		if (ata_port_offline(ap))
634c6fd2807SJeff Garzik 			return 0;
635c6fd2807SJeff Garzik 		reason = "link not ready";
636c6fd2807SJeff Garzik 		goto err;
637c6fd2807SJeff Garzik 	}
638c6fd2807SJeff Garzik 
639c6fd2807SJeff Garzik 	/* Sil24 doesn't store signature FIS after hardreset, so we
640c6fd2807SJeff Garzik 	 * can't wait for BSY to clear.  Some devices take a long time
641c6fd2807SJeff Garzik 	 * to get ready and those devices will choke if we don't wait
642c6fd2807SJeff Garzik 	 * for BSY clearance here.  Tell libata to perform follow-up
643c6fd2807SJeff Garzik 	 * softreset.
644c6fd2807SJeff Garzik 	 */
645c6fd2807SJeff Garzik 	return -EAGAIN;
646c6fd2807SJeff Garzik 
647c6fd2807SJeff Garzik  err:
648c6fd2807SJeff Garzik 	ata_port_printk(ap, KERN_ERR, "hardreset failed (%s)\n", reason);
649c6fd2807SJeff Garzik 	return -EIO;
650c6fd2807SJeff Garzik }
651c6fd2807SJeff Garzik 
652c6fd2807SJeff Garzik static inline void sil24_fill_sg(struct ata_queued_cmd *qc,
653c6fd2807SJeff Garzik 				 struct sil24_sge *sge)
654c6fd2807SJeff Garzik {
655c6fd2807SJeff Garzik 	struct scatterlist *sg;
656c6fd2807SJeff Garzik 	unsigned int idx = 0;
657c6fd2807SJeff Garzik 
658c6fd2807SJeff Garzik 	ata_for_each_sg(sg, qc) {
659c6fd2807SJeff Garzik 		sge->addr = cpu_to_le64(sg_dma_address(sg));
660c6fd2807SJeff Garzik 		sge->cnt = cpu_to_le32(sg_dma_len(sg));
661c6fd2807SJeff Garzik 		if (ata_sg_is_last(sg, qc))
662c6fd2807SJeff Garzik 			sge->flags = cpu_to_le32(SGE_TRM);
663c6fd2807SJeff Garzik 		else
664c6fd2807SJeff Garzik 			sge->flags = 0;
665c6fd2807SJeff Garzik 
666c6fd2807SJeff Garzik 		sge++;
667c6fd2807SJeff Garzik 		idx++;
668c6fd2807SJeff Garzik 	}
669c6fd2807SJeff Garzik }
670c6fd2807SJeff Garzik 
671c6fd2807SJeff Garzik static void sil24_qc_prep(struct ata_queued_cmd *qc)
672c6fd2807SJeff Garzik {
673c6fd2807SJeff Garzik 	struct ata_port *ap = qc->ap;
674c6fd2807SJeff Garzik 	struct sil24_port_priv *pp = ap->private_data;
675c6fd2807SJeff Garzik 	union sil24_cmd_block *cb;
676c6fd2807SJeff Garzik 	struct sil24_prb *prb;
677c6fd2807SJeff Garzik 	struct sil24_sge *sge;
678c6fd2807SJeff Garzik 	u16 ctrl = 0;
679c6fd2807SJeff Garzik 
680c6fd2807SJeff Garzik 	cb = &pp->cmd_block[sil24_tag(qc->tag)];
681c6fd2807SJeff Garzik 
682c6fd2807SJeff Garzik 	switch (qc->tf.protocol) {
683c6fd2807SJeff Garzik 	case ATA_PROT_PIO:
684c6fd2807SJeff Garzik 	case ATA_PROT_DMA:
685c6fd2807SJeff Garzik 	case ATA_PROT_NCQ:
686c6fd2807SJeff Garzik 	case ATA_PROT_NODATA:
687c6fd2807SJeff Garzik 		prb = &cb->ata.prb;
688c6fd2807SJeff Garzik 		sge = cb->ata.sge;
689c6fd2807SJeff Garzik 		break;
690c6fd2807SJeff Garzik 
691c6fd2807SJeff Garzik 	case ATA_PROT_ATAPI:
692c6fd2807SJeff Garzik 	case ATA_PROT_ATAPI_DMA:
693c6fd2807SJeff Garzik 	case ATA_PROT_ATAPI_NODATA:
694c6fd2807SJeff Garzik 		prb = &cb->atapi.prb;
695c6fd2807SJeff Garzik 		sge = cb->atapi.sge;
696c6fd2807SJeff Garzik 		memset(cb->atapi.cdb, 0, 32);
697c6fd2807SJeff Garzik 		memcpy(cb->atapi.cdb, qc->cdb, qc->dev->cdb_len);
698c6fd2807SJeff Garzik 
699c6fd2807SJeff Garzik 		if (qc->tf.protocol != ATA_PROT_ATAPI_NODATA) {
700c6fd2807SJeff Garzik 			if (qc->tf.flags & ATA_TFLAG_WRITE)
701c6fd2807SJeff Garzik 				ctrl = PRB_CTRL_PACKET_WRITE;
702c6fd2807SJeff Garzik 			else
703c6fd2807SJeff Garzik 				ctrl = PRB_CTRL_PACKET_READ;
704c6fd2807SJeff Garzik 		}
705c6fd2807SJeff Garzik 		break;
706c6fd2807SJeff Garzik 
707c6fd2807SJeff Garzik 	default:
708c6fd2807SJeff Garzik 		prb = NULL;	/* shut up, gcc */
709c6fd2807SJeff Garzik 		sge = NULL;
710c6fd2807SJeff Garzik 		BUG();
711c6fd2807SJeff Garzik 	}
712c6fd2807SJeff Garzik 
713c6fd2807SJeff Garzik 	prb->ctrl = cpu_to_le16(ctrl);
714c6fd2807SJeff Garzik 	ata_tf_to_fis(&qc->tf, prb->fis, 0);
715c6fd2807SJeff Garzik 
716c6fd2807SJeff Garzik 	if (qc->flags & ATA_QCFLAG_DMAMAP)
717c6fd2807SJeff Garzik 		sil24_fill_sg(qc, sge);
718c6fd2807SJeff Garzik }
719c6fd2807SJeff Garzik 
720c6fd2807SJeff Garzik static unsigned int sil24_qc_issue(struct ata_queued_cmd *qc)
721c6fd2807SJeff Garzik {
722c6fd2807SJeff Garzik 	struct ata_port *ap = qc->ap;
723c6fd2807SJeff Garzik 	struct sil24_port_priv *pp = ap->private_data;
724c6fd2807SJeff Garzik 	void __iomem *port = (void __iomem *)ap->ioaddr.cmd_addr;
725c6fd2807SJeff Garzik 	unsigned int tag = sil24_tag(qc->tag);
726c6fd2807SJeff Garzik 	dma_addr_t paddr;
727c6fd2807SJeff Garzik 	void __iomem *activate;
728c6fd2807SJeff Garzik 
729c6fd2807SJeff Garzik 	paddr = pp->cmd_block_dma + tag * sizeof(*pp->cmd_block);
730c6fd2807SJeff Garzik 	activate = port + PORT_CMD_ACTIVATE + tag * 8;
731c6fd2807SJeff Garzik 
732c6fd2807SJeff Garzik 	writel((u32)paddr, activate);
733c6fd2807SJeff Garzik 	writel((u64)paddr >> 32, activate + 4);
734c6fd2807SJeff Garzik 
735c6fd2807SJeff Garzik 	return 0;
736c6fd2807SJeff Garzik }
737c6fd2807SJeff Garzik 
738c6fd2807SJeff Garzik static void sil24_irq_clear(struct ata_port *ap)
739c6fd2807SJeff Garzik {
740c6fd2807SJeff Garzik 	/* unused */
741c6fd2807SJeff Garzik }
742c6fd2807SJeff Garzik 
743c6fd2807SJeff Garzik static void sil24_freeze(struct ata_port *ap)
744c6fd2807SJeff Garzik {
745c6fd2807SJeff Garzik 	void __iomem *port = (void __iomem *)ap->ioaddr.cmd_addr;
746c6fd2807SJeff Garzik 
747c6fd2807SJeff Garzik 	/* Port-wide IRQ mask in HOST_CTRL doesn't really work, clear
748c6fd2807SJeff Garzik 	 * PORT_IRQ_ENABLE instead.
749c6fd2807SJeff Garzik 	 */
750c6fd2807SJeff Garzik 	writel(0xffff, port + PORT_IRQ_ENABLE_CLR);
751c6fd2807SJeff Garzik }
752c6fd2807SJeff Garzik 
753c6fd2807SJeff Garzik static void sil24_thaw(struct ata_port *ap)
754c6fd2807SJeff Garzik {
755c6fd2807SJeff Garzik 	void __iomem *port = (void __iomem *)ap->ioaddr.cmd_addr;
756c6fd2807SJeff Garzik 	u32 tmp;
757c6fd2807SJeff Garzik 
758c6fd2807SJeff Garzik 	/* clear IRQ */
759c6fd2807SJeff Garzik 	tmp = readl(port + PORT_IRQ_STAT);
760c6fd2807SJeff Garzik 	writel(tmp, port + PORT_IRQ_STAT);
761c6fd2807SJeff Garzik 
762c6fd2807SJeff Garzik 	/* turn IRQ back on */
763c6fd2807SJeff Garzik 	writel(DEF_PORT_IRQ, port + PORT_IRQ_ENABLE_SET);
764c6fd2807SJeff Garzik }
765c6fd2807SJeff Garzik 
766c6fd2807SJeff Garzik static void sil24_error_intr(struct ata_port *ap)
767c6fd2807SJeff Garzik {
768c6fd2807SJeff Garzik 	void __iomem *port = (void __iomem *)ap->ioaddr.cmd_addr;
769c6fd2807SJeff Garzik 	struct ata_eh_info *ehi = &ap->eh_info;
770c6fd2807SJeff Garzik 	int freeze = 0;
771c6fd2807SJeff Garzik 	u32 irq_stat;
772c6fd2807SJeff Garzik 
773c6fd2807SJeff Garzik 	/* on error, we need to clear IRQ explicitly */
774c6fd2807SJeff Garzik 	irq_stat = readl(port + PORT_IRQ_STAT);
775c6fd2807SJeff Garzik 	writel(irq_stat, port + PORT_IRQ_STAT);
776c6fd2807SJeff Garzik 
777c6fd2807SJeff Garzik 	/* first, analyze and record host port events */
778c6fd2807SJeff Garzik 	ata_ehi_clear_desc(ehi);
779c6fd2807SJeff Garzik 
780c6fd2807SJeff Garzik 	ata_ehi_push_desc(ehi, "irq_stat 0x%08x", irq_stat);
781c6fd2807SJeff Garzik 
782c6fd2807SJeff Garzik 	if (irq_stat & (PORT_IRQ_PHYRDY_CHG | PORT_IRQ_DEV_XCHG)) {
783c6fd2807SJeff Garzik 		ata_ehi_hotplugged(ehi);
784c6fd2807SJeff Garzik 		ata_ehi_push_desc(ehi, ", %s",
785c6fd2807SJeff Garzik 			       irq_stat & PORT_IRQ_PHYRDY_CHG ?
786c6fd2807SJeff Garzik 			       "PHY RDY changed" : "device exchanged");
787c6fd2807SJeff Garzik 		freeze = 1;
788c6fd2807SJeff Garzik 	}
789c6fd2807SJeff Garzik 
790c6fd2807SJeff Garzik 	if (irq_stat & PORT_IRQ_UNK_FIS) {
791c6fd2807SJeff Garzik 		ehi->err_mask |= AC_ERR_HSM;
792c6fd2807SJeff Garzik 		ehi->action |= ATA_EH_SOFTRESET;
793c6fd2807SJeff Garzik 		ata_ehi_push_desc(ehi , ", unknown FIS");
794c6fd2807SJeff Garzik 		freeze = 1;
795c6fd2807SJeff Garzik 	}
796c6fd2807SJeff Garzik 
797c6fd2807SJeff Garzik 	/* deal with command error */
798c6fd2807SJeff Garzik 	if (irq_stat & PORT_IRQ_ERROR) {
799c6fd2807SJeff Garzik 		struct sil24_cerr_info *ci = NULL;
800c6fd2807SJeff Garzik 		unsigned int err_mask = 0, action = 0;
801c6fd2807SJeff Garzik 		struct ata_queued_cmd *qc;
802c6fd2807SJeff Garzik 		u32 cerr;
803c6fd2807SJeff Garzik 
804c6fd2807SJeff Garzik 		/* analyze CMD_ERR */
805c6fd2807SJeff Garzik 		cerr = readl(port + PORT_CMD_ERR);
806c6fd2807SJeff Garzik 		if (cerr < ARRAY_SIZE(sil24_cerr_db))
807c6fd2807SJeff Garzik 			ci = &sil24_cerr_db[cerr];
808c6fd2807SJeff Garzik 
809c6fd2807SJeff Garzik 		if (ci && ci->desc) {
810c6fd2807SJeff Garzik 			err_mask |= ci->err_mask;
811c6fd2807SJeff Garzik 			action |= ci->action;
812c6fd2807SJeff Garzik 			ata_ehi_push_desc(ehi, ", %s", ci->desc);
813c6fd2807SJeff Garzik 		} else {
814c6fd2807SJeff Garzik 			err_mask |= AC_ERR_OTHER;
815c6fd2807SJeff Garzik 			action |= ATA_EH_SOFTRESET;
816c6fd2807SJeff Garzik 			ata_ehi_push_desc(ehi, ", unknown command error %d",
817c6fd2807SJeff Garzik 					  cerr);
818c6fd2807SJeff Garzik 		}
819c6fd2807SJeff Garzik 
820c6fd2807SJeff Garzik 		/* record error info */
821c6fd2807SJeff Garzik 		qc = ata_qc_from_tag(ap, ap->active_tag);
822c6fd2807SJeff Garzik 		if (qc) {
823c6fd2807SJeff Garzik 			sil24_update_tf(ap);
824c6fd2807SJeff Garzik 			qc->err_mask |= err_mask;
825c6fd2807SJeff Garzik 		} else
826c6fd2807SJeff Garzik 			ehi->err_mask |= err_mask;
827c6fd2807SJeff Garzik 
828c6fd2807SJeff Garzik 		ehi->action |= action;
829c6fd2807SJeff Garzik 	}
830c6fd2807SJeff Garzik 
831c6fd2807SJeff Garzik 	/* freeze or abort */
832c6fd2807SJeff Garzik 	if (freeze)
833c6fd2807SJeff Garzik 		ata_port_freeze(ap);
834c6fd2807SJeff Garzik 	else
835c6fd2807SJeff Garzik 		ata_port_abort(ap);
836c6fd2807SJeff Garzik }
837c6fd2807SJeff Garzik 
838c6fd2807SJeff Garzik static void sil24_finish_qc(struct ata_queued_cmd *qc)
839c6fd2807SJeff Garzik {
840c6fd2807SJeff Garzik 	if (qc->flags & ATA_QCFLAG_RESULT_TF)
841c6fd2807SJeff Garzik 		sil24_update_tf(qc->ap);
842c6fd2807SJeff Garzik }
843c6fd2807SJeff Garzik 
844c6fd2807SJeff Garzik static inline void sil24_host_intr(struct ata_port *ap)
845c6fd2807SJeff Garzik {
846c6fd2807SJeff Garzik 	void __iomem *port = (void __iomem *)ap->ioaddr.cmd_addr;
847c6fd2807SJeff Garzik 	u32 slot_stat, qc_active;
848c6fd2807SJeff Garzik 	int rc;
849c6fd2807SJeff Garzik 
850c6fd2807SJeff Garzik 	slot_stat = readl(port + PORT_SLOT_STAT);
851c6fd2807SJeff Garzik 
852c6fd2807SJeff Garzik 	if (unlikely(slot_stat & HOST_SSTAT_ATTN)) {
853c6fd2807SJeff Garzik 		sil24_error_intr(ap);
854c6fd2807SJeff Garzik 		return;
855c6fd2807SJeff Garzik 	}
856c6fd2807SJeff Garzik 
857c6fd2807SJeff Garzik 	if (ap->flags & SIL24_FLAG_PCIX_IRQ_WOC)
858c6fd2807SJeff Garzik 		writel(PORT_IRQ_COMPLETE, port + PORT_IRQ_STAT);
859c6fd2807SJeff Garzik 
860c6fd2807SJeff Garzik 	qc_active = slot_stat & ~HOST_SSTAT_ATTN;
861c6fd2807SJeff Garzik 	rc = ata_qc_complete_multiple(ap, qc_active, sil24_finish_qc);
862c6fd2807SJeff Garzik 	if (rc > 0)
863c6fd2807SJeff Garzik 		return;
864c6fd2807SJeff Garzik 	if (rc < 0) {
865c6fd2807SJeff Garzik 		struct ata_eh_info *ehi = &ap->eh_info;
866c6fd2807SJeff Garzik 		ehi->err_mask |= AC_ERR_HSM;
867c6fd2807SJeff Garzik 		ehi->action |= ATA_EH_SOFTRESET;
868c6fd2807SJeff Garzik 		ata_port_freeze(ap);
869c6fd2807SJeff Garzik 		return;
870c6fd2807SJeff Garzik 	}
871c6fd2807SJeff Garzik 
872c6fd2807SJeff Garzik 	if (ata_ratelimit())
873c6fd2807SJeff Garzik 		ata_port_printk(ap, KERN_INFO, "spurious interrupt "
874c6fd2807SJeff Garzik 			"(slot_stat 0x%x active_tag %d sactive 0x%x)\n",
875c6fd2807SJeff Garzik 			slot_stat, ap->active_tag, ap->sactive);
876c6fd2807SJeff Garzik }
877c6fd2807SJeff Garzik 
8787d12e780SDavid Howells static irqreturn_t sil24_interrupt(int irq, void *dev_instance)
879c6fd2807SJeff Garzik {
880cca3974eSJeff Garzik 	struct ata_host *host = dev_instance;
881cca3974eSJeff Garzik 	struct sil24_host_priv *hpriv = host->private_data;
882c6fd2807SJeff Garzik 	unsigned handled = 0;
883c6fd2807SJeff Garzik 	u32 status;
884c6fd2807SJeff Garzik 	int i;
885c6fd2807SJeff Garzik 
886c6fd2807SJeff Garzik 	status = readl(hpriv->host_base + HOST_IRQ_STAT);
887c6fd2807SJeff Garzik 
888c6fd2807SJeff Garzik 	if (status == 0xffffffff) {
889c6fd2807SJeff Garzik 		printk(KERN_ERR DRV_NAME ": IRQ status == 0xffffffff, "
890c6fd2807SJeff Garzik 		       "PCI fault or device removal?\n");
891c6fd2807SJeff Garzik 		goto out;
892c6fd2807SJeff Garzik 	}
893c6fd2807SJeff Garzik 
894c6fd2807SJeff Garzik 	if (!(status & IRQ_STAT_4PORTS))
895c6fd2807SJeff Garzik 		goto out;
896c6fd2807SJeff Garzik 
897cca3974eSJeff Garzik 	spin_lock(&host->lock);
898c6fd2807SJeff Garzik 
899cca3974eSJeff Garzik 	for (i = 0; i < host->n_ports; i++)
900c6fd2807SJeff Garzik 		if (status & (1 << i)) {
901cca3974eSJeff Garzik 			struct ata_port *ap = host->ports[i];
902c6fd2807SJeff Garzik 			if (ap && !(ap->flags & ATA_FLAG_DISABLED)) {
903cca3974eSJeff Garzik 				sil24_host_intr(host->ports[i]);
904c6fd2807SJeff Garzik 				handled++;
905c6fd2807SJeff Garzik 			} else
906c6fd2807SJeff Garzik 				printk(KERN_ERR DRV_NAME
907c6fd2807SJeff Garzik 				       ": interrupt from disabled port %d\n", i);
908c6fd2807SJeff Garzik 		}
909c6fd2807SJeff Garzik 
910cca3974eSJeff Garzik 	spin_unlock(&host->lock);
911c6fd2807SJeff Garzik  out:
912c6fd2807SJeff Garzik 	return IRQ_RETVAL(handled);
913c6fd2807SJeff Garzik }
914c6fd2807SJeff Garzik 
915c6fd2807SJeff Garzik static void sil24_error_handler(struct ata_port *ap)
916c6fd2807SJeff Garzik {
917c6fd2807SJeff Garzik 	struct ata_eh_context *ehc = &ap->eh_context;
918c6fd2807SJeff Garzik 
919c6fd2807SJeff Garzik 	if (sil24_init_port(ap)) {
920c6fd2807SJeff Garzik 		ata_eh_freeze_port(ap);
921c6fd2807SJeff Garzik 		ehc->i.action |= ATA_EH_HARDRESET;
922c6fd2807SJeff Garzik 	}
923c6fd2807SJeff Garzik 
924c6fd2807SJeff Garzik 	/* perform recovery */
925c6fd2807SJeff Garzik 	ata_do_eh(ap, ata_std_prereset, sil24_softreset, sil24_hardreset,
926c6fd2807SJeff Garzik 		  ata_std_postreset);
927c6fd2807SJeff Garzik }
928c6fd2807SJeff Garzik 
929c6fd2807SJeff Garzik static void sil24_post_internal_cmd(struct ata_queued_cmd *qc)
930c6fd2807SJeff Garzik {
931c6fd2807SJeff Garzik 	struct ata_port *ap = qc->ap;
932c6fd2807SJeff Garzik 
933c6fd2807SJeff Garzik 	if (qc->flags & ATA_QCFLAG_FAILED)
934c6fd2807SJeff Garzik 		qc->err_mask |= AC_ERR_OTHER;
935c6fd2807SJeff Garzik 
936c6fd2807SJeff Garzik 	/* make DMA engine forget about the failed command */
937c6fd2807SJeff Garzik 	if (qc->err_mask)
938c6fd2807SJeff Garzik 		sil24_init_port(ap);
939c6fd2807SJeff Garzik }
940c6fd2807SJeff Garzik 
941c6fd2807SJeff Garzik static inline void sil24_cblk_free(struct sil24_port_priv *pp, struct device *dev)
942c6fd2807SJeff Garzik {
943c6fd2807SJeff Garzik 	const size_t cb_size = sizeof(*pp->cmd_block) * SIL24_MAX_CMDS;
944c6fd2807SJeff Garzik 
945c6fd2807SJeff Garzik 	dma_free_coherent(dev, cb_size, pp->cmd_block, pp->cmd_block_dma);
946c6fd2807SJeff Garzik }
947c6fd2807SJeff Garzik 
948c6fd2807SJeff Garzik static int sil24_port_start(struct ata_port *ap)
949c6fd2807SJeff Garzik {
950cca3974eSJeff Garzik 	struct device *dev = ap->host->dev;
951c6fd2807SJeff Garzik 	struct sil24_port_priv *pp;
952c6fd2807SJeff Garzik 	union sil24_cmd_block *cb;
953c6fd2807SJeff Garzik 	size_t cb_size = sizeof(*cb) * SIL24_MAX_CMDS;
954c6fd2807SJeff Garzik 	dma_addr_t cb_dma;
955c6fd2807SJeff Garzik 	int rc = -ENOMEM;
956c6fd2807SJeff Garzik 
957c6fd2807SJeff Garzik 	pp = kzalloc(sizeof(*pp), GFP_KERNEL);
958c6fd2807SJeff Garzik 	if (!pp)
959c6fd2807SJeff Garzik 		goto err_out;
960c6fd2807SJeff Garzik 
961c6fd2807SJeff Garzik 	pp->tf.command = ATA_DRDY;
962c6fd2807SJeff Garzik 
963c6fd2807SJeff Garzik 	cb = dma_alloc_coherent(dev, cb_size, &cb_dma, GFP_KERNEL);
964c6fd2807SJeff Garzik 	if (!cb)
965c6fd2807SJeff Garzik 		goto err_out_pp;
966c6fd2807SJeff Garzik 	memset(cb, 0, cb_size);
967c6fd2807SJeff Garzik 
968c6fd2807SJeff Garzik 	rc = ata_pad_alloc(ap, dev);
969c6fd2807SJeff Garzik 	if (rc)
970c6fd2807SJeff Garzik 		goto err_out_pad;
971c6fd2807SJeff Garzik 
972c6fd2807SJeff Garzik 	pp->cmd_block = cb;
973c6fd2807SJeff Garzik 	pp->cmd_block_dma = cb_dma;
974c6fd2807SJeff Garzik 
975c6fd2807SJeff Garzik 	ap->private_data = pp;
976c6fd2807SJeff Garzik 
977c6fd2807SJeff Garzik 	return 0;
978c6fd2807SJeff Garzik 
979c6fd2807SJeff Garzik err_out_pad:
980c6fd2807SJeff Garzik 	sil24_cblk_free(pp, dev);
981c6fd2807SJeff Garzik err_out_pp:
982c6fd2807SJeff Garzik 	kfree(pp);
983c6fd2807SJeff Garzik err_out:
984c6fd2807SJeff Garzik 	return rc;
985c6fd2807SJeff Garzik }
986c6fd2807SJeff Garzik 
987c6fd2807SJeff Garzik static void sil24_port_stop(struct ata_port *ap)
988c6fd2807SJeff Garzik {
989cca3974eSJeff Garzik 	struct device *dev = ap->host->dev;
990c6fd2807SJeff Garzik 	struct sil24_port_priv *pp = ap->private_data;
991c6fd2807SJeff Garzik 
992c6fd2807SJeff Garzik 	sil24_cblk_free(pp, dev);
993c6fd2807SJeff Garzik 	ata_pad_free(ap, dev);
994c6fd2807SJeff Garzik 	kfree(pp);
995c6fd2807SJeff Garzik }
996c6fd2807SJeff Garzik 
997cca3974eSJeff Garzik static void sil24_host_stop(struct ata_host *host)
998c6fd2807SJeff Garzik {
999cca3974eSJeff Garzik 	struct sil24_host_priv *hpriv = host->private_data;
1000cca3974eSJeff Garzik 	struct pci_dev *pdev = to_pci_dev(host->dev);
1001c6fd2807SJeff Garzik 
1002c6fd2807SJeff Garzik 	pci_iounmap(pdev, hpriv->host_base);
1003c6fd2807SJeff Garzik 	pci_iounmap(pdev, hpriv->port_base);
1004c6fd2807SJeff Garzik 	kfree(hpriv);
1005c6fd2807SJeff Garzik }
1006c6fd2807SJeff Garzik 
1007c6fd2807SJeff Garzik static void sil24_init_controller(struct pci_dev *pdev, int n_ports,
1008cca3974eSJeff Garzik 				  unsigned long port_flags,
1009c6fd2807SJeff Garzik 				  void __iomem *host_base,
1010c6fd2807SJeff Garzik 				  void __iomem *port_base)
1011c6fd2807SJeff Garzik {
1012c6fd2807SJeff Garzik 	u32 tmp;
1013c6fd2807SJeff Garzik 	int i;
1014c6fd2807SJeff Garzik 
1015c6fd2807SJeff Garzik 	/* GPIO off */
1016c6fd2807SJeff Garzik 	writel(0, host_base + HOST_FLASH_CMD);
1017c6fd2807SJeff Garzik 
1018c6fd2807SJeff Garzik 	/* clear global reset & mask interrupts during initialization */
1019c6fd2807SJeff Garzik 	writel(0, host_base + HOST_CTRL);
1020c6fd2807SJeff Garzik 
1021c6fd2807SJeff Garzik 	/* init ports */
1022c6fd2807SJeff Garzik 	for (i = 0; i < n_ports; i++) {
1023c6fd2807SJeff Garzik 		void __iomem *port = port_base + i * PORT_REGS_SIZE;
1024c6fd2807SJeff Garzik 
1025c6fd2807SJeff Garzik 		/* Initial PHY setting */
1026c6fd2807SJeff Garzik 		writel(0x20c, port + PORT_PHY_CFG);
1027c6fd2807SJeff Garzik 
1028c6fd2807SJeff Garzik 		/* Clear port RST */
1029c6fd2807SJeff Garzik 		tmp = readl(port + PORT_CTRL_STAT);
1030c6fd2807SJeff Garzik 		if (tmp & PORT_CS_PORT_RST) {
1031c6fd2807SJeff Garzik 			writel(PORT_CS_PORT_RST, port + PORT_CTRL_CLR);
1032c6fd2807SJeff Garzik 			tmp = ata_wait_register(port + PORT_CTRL_STAT,
1033c6fd2807SJeff Garzik 						PORT_CS_PORT_RST,
1034c6fd2807SJeff Garzik 						PORT_CS_PORT_RST, 10, 100);
1035c6fd2807SJeff Garzik 			if (tmp & PORT_CS_PORT_RST)
1036c6fd2807SJeff Garzik 				dev_printk(KERN_ERR, &pdev->dev,
1037c6fd2807SJeff Garzik 				           "failed to clear port RST\n");
1038c6fd2807SJeff Garzik 		}
1039c6fd2807SJeff Garzik 
1040c6fd2807SJeff Garzik 		/* Configure IRQ WoC */
1041cca3974eSJeff Garzik 		if (port_flags & SIL24_FLAG_PCIX_IRQ_WOC)
1042c6fd2807SJeff Garzik 			writel(PORT_CS_IRQ_WOC, port + PORT_CTRL_STAT);
1043c6fd2807SJeff Garzik 		else
1044c6fd2807SJeff Garzik 			writel(PORT_CS_IRQ_WOC, port + PORT_CTRL_CLR);
1045c6fd2807SJeff Garzik 
1046c6fd2807SJeff Garzik 		/* Zero error counters. */
1047c6fd2807SJeff Garzik 		writel(0x8000, port + PORT_DECODE_ERR_THRESH);
1048c6fd2807SJeff Garzik 		writel(0x8000, port + PORT_CRC_ERR_THRESH);
1049c6fd2807SJeff Garzik 		writel(0x8000, port + PORT_HSHK_ERR_THRESH);
1050c6fd2807SJeff Garzik 		writel(0x0000, port + PORT_DECODE_ERR_CNT);
1051c6fd2807SJeff Garzik 		writel(0x0000, port + PORT_CRC_ERR_CNT);
1052c6fd2807SJeff Garzik 		writel(0x0000, port + PORT_HSHK_ERR_CNT);
1053c6fd2807SJeff Garzik 
1054c6fd2807SJeff Garzik 		/* Always use 64bit activation */
1055c6fd2807SJeff Garzik 		writel(PORT_CS_32BIT_ACTV, port + PORT_CTRL_CLR);
1056c6fd2807SJeff Garzik 
1057c6fd2807SJeff Garzik 		/* Clear port multiplier enable and resume bits */
105828c8f3b4STejun Heo 		writel(PORT_CS_PMP_EN | PORT_CS_PMP_RESUME,
105928c8f3b4STejun Heo 		       port + PORT_CTRL_CLR);
1060c6fd2807SJeff Garzik 	}
1061c6fd2807SJeff Garzik 
1062c6fd2807SJeff Garzik 	/* Turn on interrupts */
1063c6fd2807SJeff Garzik 	writel(IRQ_STAT_4PORTS, host_base + HOST_CTRL);
1064c6fd2807SJeff Garzik }
1065c6fd2807SJeff Garzik 
1066c6fd2807SJeff Garzik static int sil24_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
1067c6fd2807SJeff Garzik {
1068c6fd2807SJeff Garzik 	static int printed_version = 0;
1069c6fd2807SJeff Garzik 	unsigned int board_id = (unsigned int)ent->driver_data;
1070c6fd2807SJeff Garzik 	struct ata_port_info *pinfo = &sil24_port_info[board_id];
1071c6fd2807SJeff Garzik 	struct ata_probe_ent *probe_ent = NULL;
1072c6fd2807SJeff Garzik 	struct sil24_host_priv *hpriv = NULL;
1073c6fd2807SJeff Garzik 	void __iomem *host_base = NULL;
1074c6fd2807SJeff Garzik 	void __iomem *port_base = NULL;
1075c6fd2807SJeff Garzik 	int i, rc;
1076c6fd2807SJeff Garzik 	u32 tmp;
1077c6fd2807SJeff Garzik 
1078c6fd2807SJeff Garzik 	if (!printed_version++)
1079c6fd2807SJeff Garzik 		dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
1080c6fd2807SJeff Garzik 
1081c6fd2807SJeff Garzik 	rc = pci_enable_device(pdev);
1082c6fd2807SJeff Garzik 	if (rc)
1083c6fd2807SJeff Garzik 		return rc;
1084c6fd2807SJeff Garzik 
1085c6fd2807SJeff Garzik 	rc = pci_request_regions(pdev, DRV_NAME);
1086c6fd2807SJeff Garzik 	if (rc)
1087c6fd2807SJeff Garzik 		goto out_disable;
1088c6fd2807SJeff Garzik 
1089c6fd2807SJeff Garzik 	rc = -ENOMEM;
1090c6fd2807SJeff Garzik 	/* map mmio registers */
1091c6fd2807SJeff Garzik 	host_base = pci_iomap(pdev, 0, 0);
1092c6fd2807SJeff Garzik 	if (!host_base)
1093c6fd2807SJeff Garzik 		goto out_free;
1094c6fd2807SJeff Garzik 	port_base = pci_iomap(pdev, 2, 0);
1095c6fd2807SJeff Garzik 	if (!port_base)
1096c6fd2807SJeff Garzik 		goto out_free;
1097c6fd2807SJeff Garzik 
1098c6fd2807SJeff Garzik 	/* allocate & init probe_ent and hpriv */
1099c6fd2807SJeff Garzik 	probe_ent = kzalloc(sizeof(*probe_ent), GFP_KERNEL);
1100c6fd2807SJeff Garzik 	if (!probe_ent)
1101c6fd2807SJeff Garzik 		goto out_free;
1102c6fd2807SJeff Garzik 
1103c6fd2807SJeff Garzik 	hpriv = kzalloc(sizeof(*hpriv), GFP_KERNEL);
1104c6fd2807SJeff Garzik 	if (!hpriv)
1105c6fd2807SJeff Garzik 		goto out_free;
1106c6fd2807SJeff Garzik 
1107c6fd2807SJeff Garzik 	probe_ent->dev = pci_dev_to_dev(pdev);
1108c6fd2807SJeff Garzik 	INIT_LIST_HEAD(&probe_ent->node);
1109c6fd2807SJeff Garzik 
1110c6fd2807SJeff Garzik 	probe_ent->sht		= pinfo->sht;
1111cca3974eSJeff Garzik 	probe_ent->port_flags	= pinfo->flags;
1112c6fd2807SJeff Garzik 	probe_ent->pio_mask	= pinfo->pio_mask;
1113c6fd2807SJeff Garzik 	probe_ent->mwdma_mask	= pinfo->mwdma_mask;
1114c6fd2807SJeff Garzik 	probe_ent->udma_mask	= pinfo->udma_mask;
1115c6fd2807SJeff Garzik 	probe_ent->port_ops	= pinfo->port_ops;
1116cca3974eSJeff Garzik 	probe_ent->n_ports	= SIL24_FLAG2NPORTS(pinfo->flags);
1117c6fd2807SJeff Garzik 
1118c6fd2807SJeff Garzik 	probe_ent->irq = pdev->irq;
1119c6fd2807SJeff Garzik 	probe_ent->irq_flags = IRQF_SHARED;
1120c6fd2807SJeff Garzik 	probe_ent->private_data = hpriv;
1121c6fd2807SJeff Garzik 
1122c6fd2807SJeff Garzik 	hpriv->host_base = host_base;
1123c6fd2807SJeff Garzik 	hpriv->port_base = port_base;
1124c6fd2807SJeff Garzik 
1125c6fd2807SJeff Garzik 	/*
1126c6fd2807SJeff Garzik 	 * Configure the device
1127c6fd2807SJeff Garzik 	 */
1128c6fd2807SJeff Garzik 	if (!pci_set_dma_mask(pdev, DMA_64BIT_MASK)) {
1129c6fd2807SJeff Garzik 		rc = pci_set_consistent_dma_mask(pdev, DMA_64BIT_MASK);
1130c6fd2807SJeff Garzik 		if (rc) {
1131c6fd2807SJeff Garzik 			rc = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
1132c6fd2807SJeff Garzik 			if (rc) {
1133c6fd2807SJeff Garzik 				dev_printk(KERN_ERR, &pdev->dev,
1134c6fd2807SJeff Garzik 					   "64-bit DMA enable failed\n");
1135c6fd2807SJeff Garzik 				goto out_free;
1136c6fd2807SJeff Garzik 			}
1137c6fd2807SJeff Garzik 		}
1138c6fd2807SJeff Garzik 	} else {
1139c6fd2807SJeff Garzik 		rc = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
1140c6fd2807SJeff Garzik 		if (rc) {
1141c6fd2807SJeff Garzik 			dev_printk(KERN_ERR, &pdev->dev,
1142c6fd2807SJeff Garzik 				   "32-bit DMA enable failed\n");
1143c6fd2807SJeff Garzik 			goto out_free;
1144c6fd2807SJeff Garzik 		}
1145c6fd2807SJeff Garzik 		rc = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
1146c6fd2807SJeff Garzik 		if (rc) {
1147c6fd2807SJeff Garzik 			dev_printk(KERN_ERR, &pdev->dev,
1148c6fd2807SJeff Garzik 				   "32-bit consistent DMA enable failed\n");
1149c6fd2807SJeff Garzik 			goto out_free;
1150c6fd2807SJeff Garzik 		}
1151c6fd2807SJeff Garzik 	}
1152c6fd2807SJeff Garzik 
1153c6fd2807SJeff Garzik 	/* Apply workaround for completion IRQ loss on PCI-X errata */
1154cca3974eSJeff Garzik 	if (probe_ent->port_flags & SIL24_FLAG_PCIX_IRQ_WOC) {
1155c6fd2807SJeff Garzik 		tmp = readl(host_base + HOST_CTRL);
1156c6fd2807SJeff Garzik 		if (tmp & (HOST_CTRL_TRDY | HOST_CTRL_STOP | HOST_CTRL_DEVSEL))
1157c6fd2807SJeff Garzik 			dev_printk(KERN_INFO, &pdev->dev,
1158c6fd2807SJeff Garzik 				   "Applying completion IRQ loss on PCI-X "
1159c6fd2807SJeff Garzik 				   "errata fix\n");
1160c6fd2807SJeff Garzik 		else
1161cca3974eSJeff Garzik 			probe_ent->port_flags &= ~SIL24_FLAG_PCIX_IRQ_WOC;
1162c6fd2807SJeff Garzik 	}
1163c6fd2807SJeff Garzik 
1164c6fd2807SJeff Garzik 	for (i = 0; i < probe_ent->n_ports; i++) {
1165c6fd2807SJeff Garzik 		unsigned long portu =
1166c6fd2807SJeff Garzik 			(unsigned long)port_base + i * PORT_REGS_SIZE;
1167c6fd2807SJeff Garzik 
1168c6fd2807SJeff Garzik 		probe_ent->port[i].cmd_addr = portu;
1169c6fd2807SJeff Garzik 		probe_ent->port[i].scr_addr = portu + PORT_SCONTROL;
1170c6fd2807SJeff Garzik 
1171c6fd2807SJeff Garzik 		ata_std_ports(&probe_ent->port[i]);
1172c6fd2807SJeff Garzik 	}
1173c6fd2807SJeff Garzik 
1174cca3974eSJeff Garzik 	sil24_init_controller(pdev, probe_ent->n_ports, probe_ent->port_flags,
1175c6fd2807SJeff Garzik 			      host_base, port_base);
1176c6fd2807SJeff Garzik 
1177c6fd2807SJeff Garzik 	pci_set_master(pdev);
1178c6fd2807SJeff Garzik 
1179c6fd2807SJeff Garzik 	/* FIXME: check ata_device_add return value */
1180c6fd2807SJeff Garzik 	ata_device_add(probe_ent);
1181c6fd2807SJeff Garzik 
1182c6fd2807SJeff Garzik 	kfree(probe_ent);
1183c6fd2807SJeff Garzik 	return 0;
1184c6fd2807SJeff Garzik 
1185c6fd2807SJeff Garzik  out_free:
1186c6fd2807SJeff Garzik 	if (host_base)
1187c6fd2807SJeff Garzik 		pci_iounmap(pdev, host_base);
1188c6fd2807SJeff Garzik 	if (port_base)
1189c6fd2807SJeff Garzik 		pci_iounmap(pdev, port_base);
1190c6fd2807SJeff Garzik 	kfree(probe_ent);
1191c6fd2807SJeff Garzik 	kfree(hpriv);
1192c6fd2807SJeff Garzik 	pci_release_regions(pdev);
1193c6fd2807SJeff Garzik  out_disable:
1194c6fd2807SJeff Garzik 	pci_disable_device(pdev);
1195c6fd2807SJeff Garzik 	return rc;
1196c6fd2807SJeff Garzik }
1197c6fd2807SJeff Garzik 
1198281d426cSAlexey Dobriyan #ifdef CONFIG_PM
1199c6fd2807SJeff Garzik static int sil24_pci_device_resume(struct pci_dev *pdev)
1200c6fd2807SJeff Garzik {
1201cca3974eSJeff Garzik 	struct ata_host *host = dev_get_drvdata(&pdev->dev);
1202cca3974eSJeff Garzik 	struct sil24_host_priv *hpriv = host->private_data;
1203*553c4aa6STejun Heo 	int rc;
1204c6fd2807SJeff Garzik 
1205*553c4aa6STejun Heo 	rc = ata_pci_device_do_resume(pdev);
1206*553c4aa6STejun Heo 	if (rc)
1207*553c4aa6STejun Heo 		return rc;
1208c6fd2807SJeff Garzik 
1209c6fd2807SJeff Garzik 	if (pdev->dev.power.power_state.event == PM_EVENT_SUSPEND)
1210c6fd2807SJeff Garzik 		writel(HOST_CTRL_GLOBAL_RST, hpriv->host_base + HOST_CTRL);
1211c6fd2807SJeff Garzik 
1212cca3974eSJeff Garzik 	sil24_init_controller(pdev, host->n_ports, host->ports[0]->flags,
1213c6fd2807SJeff Garzik 			      hpriv->host_base, hpriv->port_base);
1214c6fd2807SJeff Garzik 
1215cca3974eSJeff Garzik 	ata_host_resume(host);
1216c6fd2807SJeff Garzik 
1217c6fd2807SJeff Garzik 	return 0;
1218c6fd2807SJeff Garzik }
1219281d426cSAlexey Dobriyan #endif
1220c6fd2807SJeff Garzik 
1221c6fd2807SJeff Garzik static int __init sil24_init(void)
1222c6fd2807SJeff Garzik {
1223c6fd2807SJeff Garzik 	return pci_register_driver(&sil24_pci_driver);
1224c6fd2807SJeff Garzik }
1225c6fd2807SJeff Garzik 
1226c6fd2807SJeff Garzik static void __exit sil24_exit(void)
1227c6fd2807SJeff Garzik {
1228c6fd2807SJeff Garzik 	pci_unregister_driver(&sil24_pci_driver);
1229c6fd2807SJeff Garzik }
1230c6fd2807SJeff Garzik 
1231c6fd2807SJeff Garzik MODULE_AUTHOR("Tejun Heo");
1232c6fd2807SJeff Garzik MODULE_DESCRIPTION("Silicon Image 3124/3132 SATA low-level driver");
1233c6fd2807SJeff Garzik MODULE_LICENSE("GPL");
1234c6fd2807SJeff Garzik MODULE_DEVICE_TABLE(pci, sil24_pci_tbl);
1235c6fd2807SJeff Garzik 
1236c6fd2807SJeff Garzik module_init(sil24_init);
1237c6fd2807SJeff Garzik module_exit(sil24_exit);
1238