libata: misc updates for AN
[safe/jmp/linux-2.6] / drivers / ata / ahci.c
1 /*
2  *  ahci.c - AHCI SATA support
3  *
4  *  Maintained by:  Jeff Garzik <jgarzik@pobox.com>
5  *                  Please ALWAYS copy linux-ide@vger.kernel.org
6  *                  on emails.
7  *
8  *  Copyright 2004-2005 Red Hat, Inc.
9  *
10  *
11  *  This program is free software; you can redistribute it and/or modify
12  *  it under the terms of the GNU General Public License as published by
13  *  the Free Software Foundation; either version 2, or (at your option)
14  *  any later version.
15  *
16  *  This program is distributed in the hope that it will be useful,
17  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
18  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
19  *  GNU General Public License for more details.
20  *
21  *  You should have received a copy of the GNU General Public License
22  *  along with this program; see the file COPYING.  If not, write to
23  *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
24  *
25  *
26  * libata documentation is available via 'make {ps|pdf}docs',
27  * as Documentation/DocBook/libata.*
28  *
29  * AHCI hardware documentation:
30  * http://www.intel.com/technology/serialata/pdf/rev1_0.pdf
31  * http://www.intel.com/technology/serialata/pdf/rev1_1.pdf
32  *
33  */
34
35 #include <linux/kernel.h>
36 #include <linux/module.h>
37 #include <linux/pci.h>
38 #include <linux/init.h>
39 #include <linux/blkdev.h>
40 #include <linux/delay.h>
41 #include <linux/interrupt.h>
42 #include <linux/dma-mapping.h>
43 #include <linux/device.h>
44 #include <scsi/scsi_host.h>
45 #include <scsi/scsi_cmnd.h>
46 #include <linux/libata.h>
47
48 #define DRV_NAME        "ahci"
49 #define DRV_VERSION     "2.3"
50
51
52 enum {
53         AHCI_PCI_BAR            = 5,
54         AHCI_MAX_PORTS          = 32,
55         AHCI_MAX_SG             = 168, /* hardware max is 64K */
56         AHCI_DMA_BOUNDARY       = 0xffffffff,
57         AHCI_USE_CLUSTERING     = 1,
58         AHCI_MAX_CMDS           = 32,
59         AHCI_CMD_SZ             = 32,
60         AHCI_CMD_SLOT_SZ        = AHCI_MAX_CMDS * AHCI_CMD_SZ,
61         AHCI_RX_FIS_SZ          = 256,
62         AHCI_CMD_TBL_CDB        = 0x40,
63         AHCI_CMD_TBL_HDR_SZ     = 0x80,
64         AHCI_CMD_TBL_SZ         = AHCI_CMD_TBL_HDR_SZ + (AHCI_MAX_SG * 16),
65         AHCI_CMD_TBL_AR_SZ      = AHCI_CMD_TBL_SZ * AHCI_MAX_CMDS,
66         AHCI_PORT_PRIV_DMA_SZ   = AHCI_CMD_SLOT_SZ + AHCI_CMD_TBL_AR_SZ +
67                                   AHCI_RX_FIS_SZ,
68         AHCI_IRQ_ON_SG          = (1 << 31),
69         AHCI_CMD_ATAPI          = (1 << 5),
70         AHCI_CMD_WRITE          = (1 << 6),
71         AHCI_CMD_PREFETCH       = (1 << 7),
72         AHCI_CMD_RESET          = (1 << 8),
73         AHCI_CMD_CLR_BUSY       = (1 << 10),
74
75         RX_FIS_D2H_REG          = 0x40, /* offset of D2H Register FIS data */
76         RX_FIS_SDB              = 0x58, /* offset of SDB FIS data */
77         RX_FIS_UNK              = 0x60, /* offset of Unknown FIS data */
78
79         board_ahci              = 0,
80         board_ahci_vt8251       = 1,
81         board_ahci_ign_iferr    = 2,
82         board_ahci_sb600        = 3,
83         board_ahci_mv           = 4,
84
85         /* global controller registers */
86         HOST_CAP                = 0x00, /* host capabilities */
87         HOST_CTL                = 0x04, /* global host control */
88         HOST_IRQ_STAT           = 0x08, /* interrupt status */
89         HOST_PORTS_IMPL         = 0x0c, /* bitmap of implemented ports */
90         HOST_VERSION            = 0x10, /* AHCI spec. version compliancy */
91
92         /* HOST_CTL bits */
93         HOST_RESET              = (1 << 0),  /* reset controller; self-clear */
94         HOST_IRQ_EN             = (1 << 1),  /* global IRQ enable */
95         HOST_AHCI_EN            = (1 << 31), /* AHCI enabled */
96
97         /* HOST_CAP bits */
98         HOST_CAP_SSC            = (1 << 14), /* Slumber capable */
99         HOST_CAP_CLO            = (1 << 24), /* Command List Override support */
100         HOST_CAP_SSS            = (1 << 27), /* Staggered Spin-up */
101         HOST_CAP_SNTF           = (1 << 29), /* SNotification register */
102         HOST_CAP_NCQ            = (1 << 30), /* Native Command Queueing */
103         HOST_CAP_64             = (1 << 31), /* PCI DAC (64-bit DMA) support */
104
105         /* registers for each SATA port */
106         PORT_LST_ADDR           = 0x00, /* command list DMA addr */
107         PORT_LST_ADDR_HI        = 0x04, /* command list DMA addr hi */
108         PORT_FIS_ADDR           = 0x08, /* FIS rx buf addr */
109         PORT_FIS_ADDR_HI        = 0x0c, /* FIS rx buf addr hi */
110         PORT_IRQ_STAT           = 0x10, /* interrupt status */
111         PORT_IRQ_MASK           = 0x14, /* interrupt enable/disable mask */
112         PORT_CMD                = 0x18, /* port command */
113         PORT_TFDATA             = 0x20, /* taskfile data */
114         PORT_SIG                = 0x24, /* device TF signature */
115         PORT_CMD_ISSUE          = 0x38, /* command issue */
116         PORT_SCR_STAT           = 0x28, /* SATA phy register: SStatus */
117         PORT_SCR_CTL            = 0x2c, /* SATA phy register: SControl */
118         PORT_SCR_ERR            = 0x30, /* SATA phy register: SError */
119         PORT_SCR_ACT            = 0x34, /* SATA phy register: SActive */
120         PORT_SCR_NTF            = 0x3c, /* SATA phy register: SNotification */
121
122         /* PORT_IRQ_{STAT,MASK} bits */
123         PORT_IRQ_COLD_PRES      = (1 << 31), /* cold presence detect */
124         PORT_IRQ_TF_ERR         = (1 << 30), /* task file error */
125         PORT_IRQ_HBUS_ERR       = (1 << 29), /* host bus fatal error */
126         PORT_IRQ_HBUS_DATA_ERR  = (1 << 28), /* host bus data error */
127         PORT_IRQ_IF_ERR         = (1 << 27), /* interface fatal error */
128         PORT_IRQ_IF_NONFATAL    = (1 << 26), /* interface non-fatal error */
129         PORT_IRQ_OVERFLOW       = (1 << 24), /* xfer exhausted available S/G */
130         PORT_IRQ_BAD_PMP        = (1 << 23), /* incorrect port multiplier */
131
132         PORT_IRQ_PHYRDY         = (1 << 22), /* PhyRdy changed */
133         PORT_IRQ_DEV_ILCK       = (1 << 7), /* device interlock */
134         PORT_IRQ_CONNECT        = (1 << 6), /* port connect change status */
135         PORT_IRQ_SG_DONE        = (1 << 5), /* descriptor processed */
136         PORT_IRQ_UNK_FIS        = (1 << 4), /* unknown FIS rx'd */
137         PORT_IRQ_SDB_FIS        = (1 << 3), /* Set Device Bits FIS rx'd */
138         PORT_IRQ_DMAS_FIS       = (1 << 2), /* DMA Setup FIS rx'd */
139         PORT_IRQ_PIOS_FIS       = (1 << 1), /* PIO Setup FIS rx'd */
140         PORT_IRQ_D2H_REG_FIS    = (1 << 0), /* D2H Register FIS rx'd */
141
142         PORT_IRQ_FREEZE         = PORT_IRQ_HBUS_ERR |
143                                   PORT_IRQ_IF_ERR |
144                                   PORT_IRQ_CONNECT |
145                                   PORT_IRQ_PHYRDY |
146                                   PORT_IRQ_UNK_FIS,
147         PORT_IRQ_ERROR          = PORT_IRQ_FREEZE |
148                                   PORT_IRQ_TF_ERR |
149                                   PORT_IRQ_HBUS_DATA_ERR,
150         DEF_PORT_IRQ            = PORT_IRQ_ERROR | PORT_IRQ_SG_DONE |
151                                   PORT_IRQ_SDB_FIS | PORT_IRQ_DMAS_FIS |
152                                   PORT_IRQ_PIOS_FIS | PORT_IRQ_D2H_REG_FIS,
153
154         /* PORT_CMD bits */
155         PORT_CMD_ATAPI          = (1 << 24), /* Device is ATAPI */
156         PORT_CMD_LIST_ON        = (1 << 15), /* cmd list DMA engine running */
157         PORT_CMD_FIS_ON         = (1 << 14), /* FIS DMA engine running */
158         PORT_CMD_FIS_RX         = (1 << 4), /* Enable FIS receive DMA engine */
159         PORT_CMD_CLO            = (1 << 3), /* Command list override */
160         PORT_CMD_POWER_ON       = (1 << 2), /* Power up device */
161         PORT_CMD_SPIN_UP        = (1 << 1), /* Spin up device */
162         PORT_CMD_START          = (1 << 0), /* Enable port DMA engine */
163
164         PORT_CMD_ICC_MASK       = (0xf << 28), /* i/f ICC state mask */
165         PORT_CMD_ICC_ACTIVE     = (0x1 << 28), /* Put i/f in active state */
166         PORT_CMD_ICC_PARTIAL    = (0x2 << 28), /* Put i/f in partial state */
167         PORT_CMD_ICC_SLUMBER    = (0x6 << 28), /* Put i/f in slumber state */
168
169         /* ap->flags bits */
170         AHCI_FLAG_NO_NCQ                = (1 << 24),
171         AHCI_FLAG_IGN_IRQ_IF_ERR        = (1 << 25), /* ignore IRQ_IF_ERR */
172         AHCI_FLAG_IGN_SERR_INTERNAL     = (1 << 27), /* ignore SERR_INTERNAL */
173         AHCI_FLAG_32BIT_ONLY            = (1 << 28), /* force 32bit */
174         AHCI_FLAG_MV_PATA               = (1 << 29), /* PATA port */
175         AHCI_FLAG_NO_MSI                = (1 << 30), /* no PCI MSI */
176         AHCI_FLAG_NO_HOTPLUG            = (1 << 31), /* ignore PxSERR.DIAG.N */
177
178         AHCI_FLAG_COMMON                = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY |
179                                           ATA_FLAG_MMIO | ATA_FLAG_PIO_DMA |
180                                           ATA_FLAG_ACPI_SATA | ATA_FLAG_AN,
181         AHCI_LFLAG_COMMON               = ATA_LFLAG_SKIP_D2H_BSY,
182 };
183
184 struct ahci_cmd_hdr {
185         u32                     opts;
186         u32                     status;
187         u32                     tbl_addr;
188         u32                     tbl_addr_hi;
189         u32                     reserved[4];
190 };
191
192 struct ahci_sg {
193         u32                     addr;
194         u32                     addr_hi;
195         u32                     reserved;
196         u32                     flags_size;
197 };
198
199 struct ahci_host_priv {
200         u32                     cap;            /* cap to use */
201         u32                     port_map;       /* port map to use */
202         u32                     saved_cap;      /* saved initial cap */
203         u32                     saved_port_map; /* saved initial port_map */
204 };
205
206 struct ahci_port_priv {
207         struct ahci_cmd_hdr     *cmd_slot;
208         dma_addr_t              cmd_slot_dma;
209         void                    *cmd_tbl;
210         dma_addr_t              cmd_tbl_dma;
211         void                    *rx_fis;
212         dma_addr_t              rx_fis_dma;
213         /* for NCQ spurious interrupt analysis */
214         unsigned int            ncq_saw_d2h:1;
215         unsigned int            ncq_saw_dmas:1;
216         unsigned int            ncq_saw_sdb:1;
217         u32                     intr_mask;      /* interrupts to enable */
218 };
219
220 static int ahci_scr_read(struct ata_port *ap, unsigned int sc_reg, u32 *val);
221 static int ahci_scr_write(struct ata_port *ap, unsigned int sc_reg, u32 val);
222 static int ahci_init_one (struct pci_dev *pdev, const struct pci_device_id *ent);
223 static unsigned int ahci_qc_issue(struct ata_queued_cmd *qc);
224 static void ahci_irq_clear(struct ata_port *ap);
225 static int ahci_port_start(struct ata_port *ap);
226 static void ahci_port_stop(struct ata_port *ap);
227 static void ahci_tf_read(struct ata_port *ap, struct ata_taskfile *tf);
228 static void ahci_qc_prep(struct ata_queued_cmd *qc);
229 static u8 ahci_check_status(struct ata_port *ap);
230 static void ahci_freeze(struct ata_port *ap);
231 static void ahci_thaw(struct ata_port *ap);
232 static void ahci_error_handler(struct ata_port *ap);
233 static void ahci_vt8251_error_handler(struct ata_port *ap);
234 static void ahci_post_internal_cmd(struct ata_queued_cmd *qc);
235 static int ahci_port_resume(struct ata_port *ap);
236 static unsigned int ahci_fill_sg(struct ata_queued_cmd *qc, void *cmd_tbl);
237 static void ahci_fill_cmd_slot(struct ahci_port_priv *pp, unsigned int tag,
238                                u32 opts);
239 #ifdef CONFIG_PM
240 static int ahci_port_suspend(struct ata_port *ap, pm_message_t mesg);
241 static int ahci_pci_device_suspend(struct pci_dev *pdev, pm_message_t mesg);
242 static int ahci_pci_device_resume(struct pci_dev *pdev);
243 #endif
244
245 static struct scsi_host_template ahci_sht = {
246         .module                 = THIS_MODULE,
247         .name                   = DRV_NAME,
248         .ioctl                  = ata_scsi_ioctl,
249         .queuecommand           = ata_scsi_queuecmd,
250         .change_queue_depth     = ata_scsi_change_queue_depth,
251         .can_queue              = AHCI_MAX_CMDS - 1,
252         .this_id                = ATA_SHT_THIS_ID,
253         .sg_tablesize           = AHCI_MAX_SG,
254         .cmd_per_lun            = ATA_SHT_CMD_PER_LUN,
255         .emulated               = ATA_SHT_EMULATED,
256         .use_clustering         = AHCI_USE_CLUSTERING,
257         .proc_name              = DRV_NAME,
258         .dma_boundary           = AHCI_DMA_BOUNDARY,
259         .slave_configure        = ata_scsi_slave_config,
260         .slave_destroy          = ata_scsi_slave_destroy,
261         .bios_param             = ata_std_bios_param,
262 };
263
264 static const struct ata_port_operations ahci_ops = {
265         .check_status           = ahci_check_status,
266         .check_altstatus        = ahci_check_status,
267         .dev_select             = ata_noop_dev_select,
268
269         .tf_read                = ahci_tf_read,
270
271         .qc_prep                = ahci_qc_prep,
272         .qc_issue               = ahci_qc_issue,
273
274         .irq_clear              = ahci_irq_clear,
275
276         .scr_read               = ahci_scr_read,
277         .scr_write              = ahci_scr_write,
278
279         .freeze                 = ahci_freeze,
280         .thaw                   = ahci_thaw,
281
282         .error_handler          = ahci_error_handler,
283         .post_internal_cmd      = ahci_post_internal_cmd,
284
285 #ifdef CONFIG_PM
286         .port_suspend           = ahci_port_suspend,
287         .port_resume            = ahci_port_resume,
288 #endif
289
290         .port_start             = ahci_port_start,
291         .port_stop              = ahci_port_stop,
292 };
293
294 static const struct ata_port_operations ahci_vt8251_ops = {
295         .check_status           = ahci_check_status,
296         .check_altstatus        = ahci_check_status,
297         .dev_select             = ata_noop_dev_select,
298
299         .tf_read                = ahci_tf_read,
300
301         .qc_prep                = ahci_qc_prep,
302         .qc_issue               = ahci_qc_issue,
303
304         .irq_clear              = ahci_irq_clear,
305
306         .scr_read               = ahci_scr_read,
307         .scr_write              = ahci_scr_write,
308
309         .freeze                 = ahci_freeze,
310         .thaw                   = ahci_thaw,
311
312         .error_handler          = ahci_vt8251_error_handler,
313         .post_internal_cmd      = ahci_post_internal_cmd,
314
315 #ifdef CONFIG_PM
316         .port_suspend           = ahci_port_suspend,
317         .port_resume            = ahci_port_resume,
318 #endif
319
320         .port_start             = ahci_port_start,
321         .port_stop              = ahci_port_stop,
322 };
323
324 static const struct ata_port_info ahci_port_info[] = {
325         /* board_ahci */
326         {
327                 .flags          = AHCI_FLAG_COMMON,
328                 .link_flags     = AHCI_LFLAG_COMMON,
329                 .pio_mask       = 0x1f, /* pio0-4 */
330                 .udma_mask      = ATA_UDMA6,
331                 .port_ops       = &ahci_ops,
332         },
333         /* board_ahci_vt8251 */
334         {
335                 .flags          = AHCI_FLAG_COMMON | AHCI_FLAG_NO_NCQ,
336                 .link_flags     = AHCI_LFLAG_COMMON | ATA_LFLAG_HRST_TO_RESUME,
337                 .pio_mask       = 0x1f, /* pio0-4 */
338                 .udma_mask      = ATA_UDMA6,
339                 .port_ops       = &ahci_vt8251_ops,
340         },
341         /* board_ahci_ign_iferr */
342         {
343                 .flags          = AHCI_FLAG_COMMON | AHCI_FLAG_IGN_IRQ_IF_ERR,
344                 .link_flags     = AHCI_LFLAG_COMMON,
345                 .pio_mask       = 0x1f, /* pio0-4 */
346                 .udma_mask      = ATA_UDMA6,
347                 .port_ops       = &ahci_ops,
348         },
349         /* board_ahci_sb600 */
350         {
351                 .flags          = AHCI_FLAG_COMMON |
352                                   AHCI_FLAG_IGN_SERR_INTERNAL |
353                                   AHCI_FLAG_32BIT_ONLY,
354                 .link_flags     = AHCI_LFLAG_COMMON,
355                 .pio_mask       = 0x1f, /* pio0-4 */
356                 .udma_mask      = ATA_UDMA6,
357                 .port_ops       = &ahci_ops,
358         },
359         /* board_ahci_mv */
360         {
361                 .sht            = &ahci_sht,
362                 .flags          = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY |
363                                   ATA_FLAG_MMIO | ATA_FLAG_PIO_DMA |
364                                   AHCI_FLAG_NO_NCQ | AHCI_FLAG_NO_MSI |
365                                   AHCI_FLAG_MV_PATA,
366                 .link_flags     = AHCI_LFLAG_COMMON,
367                 .pio_mask       = 0x1f, /* pio0-4 */
368                 .udma_mask      = ATA_UDMA6,
369                 .port_ops       = &ahci_ops,
370         },
371 };
372
373 static const struct pci_device_id ahci_pci_tbl[] = {
374         /* Intel */
375         { PCI_VDEVICE(INTEL, 0x2652), board_ahci }, /* ICH6 */
376         { PCI_VDEVICE(INTEL, 0x2653), board_ahci }, /* ICH6M */
377         { PCI_VDEVICE(INTEL, 0x27c1), board_ahci }, /* ICH7 */
378         { PCI_VDEVICE(INTEL, 0x27c5), board_ahci }, /* ICH7M */
379         { PCI_VDEVICE(INTEL, 0x27c3), board_ahci }, /* ICH7R */
380         { PCI_VDEVICE(AL, 0x5288), board_ahci_ign_iferr }, /* ULi M5288 */
381         { PCI_VDEVICE(INTEL, 0x2681), board_ahci }, /* ESB2 */
382         { PCI_VDEVICE(INTEL, 0x2682), board_ahci }, /* ESB2 */
383         { PCI_VDEVICE(INTEL, 0x2683), board_ahci }, /* ESB2 */
384         { PCI_VDEVICE(INTEL, 0x27c6), board_ahci }, /* ICH7-M DH */
385         { PCI_VDEVICE(INTEL, 0x2821), board_ahci }, /* ICH8 */
386         { PCI_VDEVICE(INTEL, 0x2822), board_ahci }, /* ICH8 */
387         { PCI_VDEVICE(INTEL, 0x2824), board_ahci }, /* ICH8 */
388         { PCI_VDEVICE(INTEL, 0x2829), board_ahci }, /* ICH8M */
389         { PCI_VDEVICE(INTEL, 0x282a), board_ahci }, /* ICH8M */
390         { PCI_VDEVICE(INTEL, 0x2922), board_ahci }, /* ICH9 */
391         { PCI_VDEVICE(INTEL, 0x2923), board_ahci }, /* ICH9 */
392         { PCI_VDEVICE(INTEL, 0x2924), board_ahci }, /* ICH9 */
393         { PCI_VDEVICE(INTEL, 0x2925), board_ahci }, /* ICH9 */
394         { PCI_VDEVICE(INTEL, 0x2927), board_ahci }, /* ICH9 */
395         { PCI_VDEVICE(INTEL, 0x2929), board_ahci }, /* ICH9M */
396         { PCI_VDEVICE(INTEL, 0x292a), board_ahci }, /* ICH9M */
397         { PCI_VDEVICE(INTEL, 0x292b), board_ahci }, /* ICH9M */
398         { PCI_VDEVICE(INTEL, 0x292c), board_ahci }, /* ICH9M */
399         { PCI_VDEVICE(INTEL, 0x292f), board_ahci }, /* ICH9M */
400         { PCI_VDEVICE(INTEL, 0x294d), board_ahci }, /* ICH9 */
401         { PCI_VDEVICE(INTEL, 0x294e), board_ahci }, /* ICH9M */
402         { PCI_VDEVICE(INTEL, 0x502a), board_ahci }, /* Tolapai */
403         { PCI_VDEVICE(INTEL, 0x502b), board_ahci }, /* Tolapai */
404
405         /* JMicron 360/1/3/5/6, match class to avoid IDE function */
406         { PCI_VENDOR_ID_JMICRON, PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID,
407           PCI_CLASS_STORAGE_SATA_AHCI, 0xffffff, board_ahci_ign_iferr },
408
409         /* ATI */
410         { PCI_VDEVICE(ATI, 0x4380), board_ahci_sb600 }, /* ATI SB600 */
411         { PCI_VDEVICE(ATI, 0x4390), board_ahci_sb600 }, /* ATI SB700/800 */
412         { PCI_VDEVICE(ATI, 0x4391), board_ahci_sb600 }, /* ATI SB700/800 */
413         { PCI_VDEVICE(ATI, 0x4392), board_ahci_sb600 }, /* ATI SB700/800 */
414         { PCI_VDEVICE(ATI, 0x4393), board_ahci_sb600 }, /* ATI SB700/800 */
415         { PCI_VDEVICE(ATI, 0x4394), board_ahci_sb600 }, /* ATI SB700/800 */
416         { PCI_VDEVICE(ATI, 0x4395), board_ahci_sb600 }, /* ATI SB700/800 */
417
418         /* VIA */
419         { PCI_VDEVICE(VIA, 0x3349), board_ahci_vt8251 }, /* VIA VT8251 */
420         { PCI_VDEVICE(VIA, 0x6287), board_ahci_vt8251 }, /* VIA VT8251 */
421
422         /* NVIDIA */
423         { PCI_VDEVICE(NVIDIA, 0x044c), board_ahci },            /* MCP65 */
424         { PCI_VDEVICE(NVIDIA, 0x044d), board_ahci },            /* MCP65 */
425         { PCI_VDEVICE(NVIDIA, 0x044e), board_ahci },            /* MCP65 */
426         { PCI_VDEVICE(NVIDIA, 0x044f), board_ahci },            /* MCP65 */
427         { PCI_VDEVICE(NVIDIA, 0x045c), board_ahci },            /* MCP65 */
428         { PCI_VDEVICE(NVIDIA, 0x045d), board_ahci },            /* MCP65 */
429         { PCI_VDEVICE(NVIDIA, 0x045e), board_ahci },            /* MCP65 */
430         { PCI_VDEVICE(NVIDIA, 0x045f), board_ahci },            /* MCP65 */
431         { PCI_VDEVICE(NVIDIA, 0x0550), board_ahci },            /* MCP67 */
432         { PCI_VDEVICE(NVIDIA, 0x0551), board_ahci },            /* MCP67 */
433         { PCI_VDEVICE(NVIDIA, 0x0552), board_ahci },            /* MCP67 */
434         { PCI_VDEVICE(NVIDIA, 0x0553), board_ahci },            /* MCP67 */
435         { PCI_VDEVICE(NVIDIA, 0x0554), board_ahci },            /* MCP67 */
436         { PCI_VDEVICE(NVIDIA, 0x0555), board_ahci },            /* MCP67 */
437         { PCI_VDEVICE(NVIDIA, 0x0556), board_ahci },            /* MCP67 */
438         { PCI_VDEVICE(NVIDIA, 0x0557), board_ahci },            /* MCP67 */
439         { PCI_VDEVICE(NVIDIA, 0x0558), board_ahci },            /* MCP67 */
440         { PCI_VDEVICE(NVIDIA, 0x0559), board_ahci },            /* MCP67 */
441         { PCI_VDEVICE(NVIDIA, 0x055a), board_ahci },            /* MCP67 */
442         { PCI_VDEVICE(NVIDIA, 0x055b), board_ahci },            /* MCP67 */
443         { PCI_VDEVICE(NVIDIA, 0x07f0), board_ahci },            /* MCP73 */
444         { PCI_VDEVICE(NVIDIA, 0x07f1), board_ahci },            /* MCP73 */
445         { PCI_VDEVICE(NVIDIA, 0x07f2), board_ahci },            /* MCP73 */
446         { PCI_VDEVICE(NVIDIA, 0x07f3), board_ahci },            /* MCP73 */
447         { PCI_VDEVICE(NVIDIA, 0x07f4), board_ahci },            /* MCP73 */
448         { PCI_VDEVICE(NVIDIA, 0x07f5), board_ahci },            /* MCP73 */
449         { PCI_VDEVICE(NVIDIA, 0x07f6), board_ahci },            /* MCP73 */
450         { PCI_VDEVICE(NVIDIA, 0x07f7), board_ahci },            /* MCP73 */
451         { PCI_VDEVICE(NVIDIA, 0x07f8), board_ahci },            /* MCP73 */
452         { PCI_VDEVICE(NVIDIA, 0x07f9), board_ahci },            /* MCP73 */
453         { PCI_VDEVICE(NVIDIA, 0x07fa), board_ahci },            /* MCP73 */
454         { PCI_VDEVICE(NVIDIA, 0x07fb), board_ahci },            /* MCP73 */
455         { PCI_VDEVICE(NVIDIA, 0x0ad0), board_ahci },            /* MCP77 */
456         { PCI_VDEVICE(NVIDIA, 0x0ad1), board_ahci },            /* MCP77 */
457         { PCI_VDEVICE(NVIDIA, 0x0ad2), board_ahci },            /* MCP77 */
458         { PCI_VDEVICE(NVIDIA, 0x0ad3), board_ahci },            /* MCP77 */
459         { PCI_VDEVICE(NVIDIA, 0x0ad4), board_ahci },            /* MCP77 */
460         { PCI_VDEVICE(NVIDIA, 0x0ad5), board_ahci },            /* MCP77 */
461         { PCI_VDEVICE(NVIDIA, 0x0ad6), board_ahci },            /* MCP77 */
462         { PCI_VDEVICE(NVIDIA, 0x0ad7), board_ahci },            /* MCP77 */
463         { PCI_VDEVICE(NVIDIA, 0x0ad8), board_ahci },            /* MCP77 */
464         { PCI_VDEVICE(NVIDIA, 0x0ad9), board_ahci },            /* MCP77 */
465         { PCI_VDEVICE(NVIDIA, 0x0ada), board_ahci },            /* MCP77 */
466         { PCI_VDEVICE(NVIDIA, 0x0adb), board_ahci },            /* MCP77 */
467
468         /* SiS */
469         { PCI_VDEVICE(SI, 0x1184), board_ahci }, /* SiS 966 */
470         { PCI_VDEVICE(SI, 0x1185), board_ahci }, /* SiS 966 */
471         { PCI_VDEVICE(SI, 0x0186), board_ahci }, /* SiS 968 */
472
473         /* Marvell */
474         { PCI_VDEVICE(MARVELL, 0x6145), board_ahci_mv },        /* 6145 */
475
476         /* Generic, PCI class code for AHCI */
477         { PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID,
478           PCI_CLASS_STORAGE_SATA_AHCI, 0xffffff, board_ahci },
479
480         { }     /* terminate list */
481 };
482
483
484 static struct pci_driver ahci_pci_driver = {
485         .name                   = DRV_NAME,
486         .id_table               = ahci_pci_tbl,
487         .probe                  = ahci_init_one,
488         .remove                 = ata_pci_remove_one,
489 #ifdef CONFIG_PM
490         .suspend                = ahci_pci_device_suspend,
491         .resume                 = ahci_pci_device_resume,
492 #endif
493 };
494
495
496 static inline int ahci_nr_ports(u32 cap)
497 {
498         return (cap & 0x1f) + 1;
499 }
500
501 static inline void __iomem *__ahci_port_base(struct ata_host *host,
502                                              unsigned int port_no)
503 {
504         void __iomem *mmio = host->iomap[AHCI_PCI_BAR];
505
506         return mmio + 0x100 + (port_no * 0x80);
507 }
508
509 static inline void __iomem *ahci_port_base(struct ata_port *ap)
510 {
511         return __ahci_port_base(ap->host, ap->port_no);
512 }
513
514 /**
515  *      ahci_save_initial_config - Save and fixup initial config values
516  *      @pdev: target PCI device
517  *      @pi: associated ATA port info
518  *      @hpriv: host private area to store config values
519  *
520  *      Some registers containing configuration info might be setup by
521  *      BIOS and might be cleared on reset.  This function saves the
522  *      initial values of those registers into @hpriv such that they
523  *      can be restored after controller reset.
524  *
525  *      If inconsistent, config values are fixed up by this function.
526  *
527  *      LOCKING:
528  *      None.
529  */
530 static void ahci_save_initial_config(struct pci_dev *pdev,
531                                      const struct ata_port_info *pi,
532                                      struct ahci_host_priv *hpriv)
533 {
534         void __iomem *mmio = pcim_iomap_table(pdev)[AHCI_PCI_BAR];
535         u32 cap, port_map;
536         int i;
537
538         /* Values prefixed with saved_ are written back to host after
539          * reset.  Values without are used for driver operation.
540          */
541         hpriv->saved_cap = cap = readl(mmio + HOST_CAP);
542         hpriv->saved_port_map = port_map = readl(mmio + HOST_PORTS_IMPL);
543
544         /* some chips have errata preventing 64bit use */
545         if ((cap & HOST_CAP_64) && (pi->flags & AHCI_FLAG_32BIT_ONLY)) {
546                 dev_printk(KERN_INFO, &pdev->dev,
547                            "controller can't do 64bit DMA, forcing 32bit\n");
548                 cap &= ~HOST_CAP_64;
549         }
550
551         if ((cap & HOST_CAP_NCQ) && (pi->flags & AHCI_FLAG_NO_NCQ)) {
552                 dev_printk(KERN_INFO, &pdev->dev,
553                            "controller can't do NCQ, turning off CAP_NCQ\n");
554                 cap &= ~HOST_CAP_NCQ;
555         }
556
557         /*
558          * Temporary Marvell 6145 hack: PATA port presence
559          * is asserted through the standard AHCI port
560          * presence register, as bit 4 (counting from 0)
561          */
562         if (pi->flags & AHCI_FLAG_MV_PATA) {
563                 dev_printk(KERN_ERR, &pdev->dev,
564                            "MV_AHCI HACK: port_map %x -> %x\n",
565                            hpriv->port_map,
566                            hpriv->port_map & 0xf);
567
568                 port_map &= 0xf;
569         }
570
571         /* cross check port_map and cap.n_ports */
572         if (port_map) {
573                 u32 tmp_port_map = port_map;
574                 int n_ports = ahci_nr_ports(cap);
575
576                 for (i = 0; i < AHCI_MAX_PORTS && n_ports; i++) {
577                         if (tmp_port_map & (1 << i)) {
578                                 n_ports--;
579                                 tmp_port_map &= ~(1 << i);
580                         }
581                 }
582
583                 /* If n_ports and port_map are inconsistent, whine and
584                  * clear port_map and let it be generated from n_ports.
585                  */
586                 if (n_ports || tmp_port_map) {
587                         dev_printk(KERN_WARNING, &pdev->dev,
588                                    "nr_ports (%u) and implemented port map "
589                                    "(0x%x) don't match, using nr_ports\n",
590                                    ahci_nr_ports(cap), port_map);
591                         port_map = 0;
592                 }
593         }
594
595         /* fabricate port_map from cap.nr_ports */
596         if (!port_map) {
597                 port_map = (1 << ahci_nr_ports(cap)) - 1;
598                 dev_printk(KERN_WARNING, &pdev->dev,
599                            "forcing PORTS_IMPL to 0x%x\n", port_map);
600
601                 /* write the fixed up value to the PI register */
602                 hpriv->saved_port_map = port_map;
603         }
604
605         /* record values to use during operation */
606         hpriv->cap = cap;
607         hpriv->port_map = port_map;
608 }
609
610 /**
611  *      ahci_restore_initial_config - Restore initial config
612  *      @host: target ATA host
613  *
614  *      Restore initial config stored by ahci_save_initial_config().
615  *
616  *      LOCKING:
617  *      None.
618  */
619 static void ahci_restore_initial_config(struct ata_host *host)
620 {
621         struct ahci_host_priv *hpriv = host->private_data;
622         void __iomem *mmio = host->iomap[AHCI_PCI_BAR];
623
624         writel(hpriv->saved_cap, mmio + HOST_CAP);
625         writel(hpriv->saved_port_map, mmio + HOST_PORTS_IMPL);
626         (void) readl(mmio + HOST_PORTS_IMPL);   /* flush */
627 }
628
629 static unsigned ahci_scr_offset(struct ata_port *ap, unsigned int sc_reg)
630 {
631         static const int offset[] = {
632                 [SCR_STATUS]            = PORT_SCR_STAT,
633                 [SCR_CONTROL]           = PORT_SCR_CTL,
634                 [SCR_ERROR]             = PORT_SCR_ERR,
635                 [SCR_ACTIVE]            = PORT_SCR_ACT,
636                 [SCR_NOTIFICATION]      = PORT_SCR_NTF,
637         };
638         struct ahci_host_priv *hpriv = ap->host->private_data;
639
640         if (sc_reg < ARRAY_SIZE(offset) &&
641             (sc_reg != SCR_NOTIFICATION || (hpriv->cap & HOST_CAP_SNTF)))
642                 return offset[sc_reg];
643         return 0;
644 }
645
646 static int ahci_scr_read(struct ata_port *ap, unsigned int sc_reg, u32 *val)
647 {
648         void __iomem *port_mmio = ahci_port_base(ap);
649         int offset = ahci_scr_offset(ap, sc_reg);
650
651         if (offset) {
652                 *val = readl(port_mmio + offset);
653                 return 0;
654         }
655         return -EINVAL;
656 }
657
658 static int ahci_scr_write(struct ata_port *ap, unsigned int sc_reg, u32 val)
659 {
660         void __iomem *port_mmio = ahci_port_base(ap);
661         int offset = ahci_scr_offset(ap, sc_reg);
662
663         if (offset) {
664                 writel(val, port_mmio + offset);
665                 return 0;
666         }
667         return -EINVAL;
668 }
669
670 static void ahci_start_engine(struct ata_port *ap)
671 {
672         void __iomem *port_mmio = ahci_port_base(ap);
673         u32 tmp;
674
675         /* start DMA */
676         tmp = readl(port_mmio + PORT_CMD);
677         tmp |= PORT_CMD_START;
678         writel(tmp, port_mmio + PORT_CMD);
679         readl(port_mmio + PORT_CMD); /* flush */
680 }
681
682 static int ahci_stop_engine(struct ata_port *ap)
683 {
684         void __iomem *port_mmio = ahci_port_base(ap);
685         u32 tmp;
686
687         tmp = readl(port_mmio + PORT_CMD);
688
689         /* check if the HBA is idle */
690         if ((tmp & (PORT_CMD_START | PORT_CMD_LIST_ON)) == 0)
691                 return 0;
692
693         /* setting HBA to idle */
694         tmp &= ~PORT_CMD_START;
695         writel(tmp, port_mmio + PORT_CMD);
696
697         /* wait for engine to stop. This could be as long as 500 msec */
698         tmp = ata_wait_register(port_mmio + PORT_CMD,
699                                 PORT_CMD_LIST_ON, PORT_CMD_LIST_ON, 1, 500);
700         if (tmp & PORT_CMD_LIST_ON)
701                 return -EIO;
702
703         return 0;
704 }
705
706 static void ahci_start_fis_rx(struct ata_port *ap)
707 {
708         void __iomem *port_mmio = ahci_port_base(ap);
709         struct ahci_host_priv *hpriv = ap->host->private_data;
710         struct ahci_port_priv *pp = ap->private_data;
711         u32 tmp;
712
713         /* set FIS registers */
714         if (hpriv->cap & HOST_CAP_64)
715                 writel((pp->cmd_slot_dma >> 16) >> 16,
716                        port_mmio + PORT_LST_ADDR_HI);
717         writel(pp->cmd_slot_dma & 0xffffffff, port_mmio + PORT_LST_ADDR);
718
719         if (hpriv->cap & HOST_CAP_64)
720                 writel((pp->rx_fis_dma >> 16) >> 16,
721                        port_mmio + PORT_FIS_ADDR_HI);
722         writel(pp->rx_fis_dma & 0xffffffff, port_mmio + PORT_FIS_ADDR);
723
724         /* enable FIS reception */
725         tmp = readl(port_mmio + PORT_CMD);
726         tmp |= PORT_CMD_FIS_RX;
727         writel(tmp, port_mmio + PORT_CMD);
728
729         /* flush */
730         readl(port_mmio + PORT_CMD);
731 }
732
733 static int ahci_stop_fis_rx(struct ata_port *ap)
734 {
735         void __iomem *port_mmio = ahci_port_base(ap);
736         u32 tmp;
737
738         /* disable FIS reception */
739         tmp = readl(port_mmio + PORT_CMD);
740         tmp &= ~PORT_CMD_FIS_RX;
741         writel(tmp, port_mmio + PORT_CMD);
742
743         /* wait for completion, spec says 500ms, give it 1000 */
744         tmp = ata_wait_register(port_mmio + PORT_CMD, PORT_CMD_FIS_ON,
745                                 PORT_CMD_FIS_ON, 10, 1000);
746         if (tmp & PORT_CMD_FIS_ON)
747                 return -EBUSY;
748
749         return 0;
750 }
751
752 static void ahci_power_up(struct ata_port *ap)
753 {
754         struct ahci_host_priv *hpriv = ap->host->private_data;
755         void __iomem *port_mmio = ahci_port_base(ap);
756         u32 cmd;
757
758         cmd = readl(port_mmio + PORT_CMD) & ~PORT_CMD_ICC_MASK;
759
760         /* spin up device */
761         if (hpriv->cap & HOST_CAP_SSS) {
762                 cmd |= PORT_CMD_SPIN_UP;
763                 writel(cmd, port_mmio + PORT_CMD);
764         }
765
766         /* wake up link */
767         writel(cmd | PORT_CMD_ICC_ACTIVE, port_mmio + PORT_CMD);
768 }
769
770 #ifdef CONFIG_PM
771 static void ahci_power_down(struct ata_port *ap)
772 {
773         struct ahci_host_priv *hpriv = ap->host->private_data;
774         void __iomem *port_mmio = ahci_port_base(ap);
775         u32 cmd, scontrol;
776
777         if (!(hpriv->cap & HOST_CAP_SSS))
778                 return;
779
780         /* put device into listen mode, first set PxSCTL.DET to 0 */
781         scontrol = readl(port_mmio + PORT_SCR_CTL);
782         scontrol &= ~0xf;
783         writel(scontrol, port_mmio + PORT_SCR_CTL);
784
785         /* then set PxCMD.SUD to 0 */
786         cmd = readl(port_mmio + PORT_CMD) & ~PORT_CMD_ICC_MASK;
787         cmd &= ~PORT_CMD_SPIN_UP;
788         writel(cmd, port_mmio + PORT_CMD);
789 }
790 #endif
791
792 static void ahci_start_port(struct ata_port *ap)
793 {
794         /* enable FIS reception */
795         ahci_start_fis_rx(ap);
796
797         /* enable DMA */
798         ahci_start_engine(ap);
799 }
800
801 static int ahci_deinit_port(struct ata_port *ap, const char **emsg)
802 {
803         int rc;
804
805         /* disable DMA */
806         rc = ahci_stop_engine(ap);
807         if (rc) {
808                 *emsg = "failed to stop engine";
809                 return rc;
810         }
811
812         /* disable FIS reception */
813         rc = ahci_stop_fis_rx(ap);
814         if (rc) {
815                 *emsg = "failed stop FIS RX";
816                 return rc;
817         }
818
819         return 0;
820 }
821
822 static int ahci_reset_controller(struct ata_host *host)
823 {
824         struct pci_dev *pdev = to_pci_dev(host->dev);
825         void __iomem *mmio = host->iomap[AHCI_PCI_BAR];
826         u32 tmp;
827
828         /* global controller reset */
829         tmp = readl(mmio + HOST_CTL);
830         if ((tmp & HOST_RESET) == 0) {
831                 writel(tmp | HOST_RESET, mmio + HOST_CTL);
832                 readl(mmio + HOST_CTL); /* flush */
833         }
834
835         /* reset must complete within 1 second, or
836          * the hardware should be considered fried.
837          */
838         ssleep(1);
839
840         tmp = readl(mmio + HOST_CTL);
841         if (tmp & HOST_RESET) {
842                 dev_printk(KERN_ERR, host->dev,
843                            "controller reset failed (0x%x)\n", tmp);
844                 return -EIO;
845         }
846
847         /* turn on AHCI mode */
848         writel(HOST_AHCI_EN, mmio + HOST_CTL);
849         (void) readl(mmio + HOST_CTL);  /* flush */
850
851         /* some registers might be cleared on reset.  restore initial values */
852         ahci_restore_initial_config(host);
853
854         if (pdev->vendor == PCI_VENDOR_ID_INTEL) {
855                 u16 tmp16;
856
857                 /* configure PCS */
858                 pci_read_config_word(pdev, 0x92, &tmp16);
859                 tmp16 |= 0xf;
860                 pci_write_config_word(pdev, 0x92, tmp16);
861         }
862
863         return 0;
864 }
865
866 static void ahci_port_init(struct pci_dev *pdev, struct ata_port *ap,
867                            int port_no, void __iomem *mmio,
868                            void __iomem *port_mmio)
869 {
870         const char *emsg = NULL;
871         int rc;
872         u32 tmp;
873
874         /* make sure port is not active */
875         rc = ahci_deinit_port(ap, &emsg);
876         if (rc)
877                 dev_printk(KERN_WARNING, &pdev->dev,
878                            "%s (%d)\n", emsg, rc);
879
880         /* clear SError */
881         tmp = readl(port_mmio + PORT_SCR_ERR);
882         VPRINTK("PORT_SCR_ERR 0x%x\n", tmp);
883         writel(tmp, port_mmio + PORT_SCR_ERR);
884
885         /* clear port IRQ */
886         tmp = readl(port_mmio + PORT_IRQ_STAT);
887         VPRINTK("PORT_IRQ_STAT 0x%x\n", tmp);
888         if (tmp)
889                 writel(tmp, port_mmio + PORT_IRQ_STAT);
890
891         writel(1 << port_no, mmio + HOST_IRQ_STAT);
892 }
893
894 static void ahci_init_controller(struct ata_host *host)
895 {
896         struct pci_dev *pdev = to_pci_dev(host->dev);
897         void __iomem *mmio = host->iomap[AHCI_PCI_BAR];
898         int i;
899         void __iomem *port_mmio;
900         u32 tmp;
901
902         if (host->ports[0]->flags & AHCI_FLAG_MV_PATA) {
903                 port_mmio = __ahci_port_base(host, 4);
904
905                 writel(0, port_mmio + PORT_IRQ_MASK);
906
907                 /* clear port IRQ */
908                 tmp = readl(port_mmio + PORT_IRQ_STAT);
909                 VPRINTK("PORT_IRQ_STAT 0x%x\n", tmp);
910                 if (tmp)
911                         writel(tmp, port_mmio + PORT_IRQ_STAT);
912         }
913
914         for (i = 0; i < host->n_ports; i++) {
915                 struct ata_port *ap = host->ports[i];
916
917                 port_mmio = ahci_port_base(ap);
918                 if (ata_port_is_dummy(ap))
919                         continue;
920
921                 ahci_port_init(pdev, ap, i, mmio, port_mmio);
922         }
923
924         tmp = readl(mmio + HOST_CTL);
925         VPRINTK("HOST_CTL 0x%x\n", tmp);
926         writel(tmp | HOST_IRQ_EN, mmio + HOST_CTL);
927         tmp = readl(mmio + HOST_CTL);
928         VPRINTK("HOST_CTL 0x%x\n", tmp);
929 }
930
931 static unsigned int ahci_dev_classify(struct ata_port *ap)
932 {
933         void __iomem *port_mmio = ahci_port_base(ap);
934         struct ata_taskfile tf;
935         u32 tmp;
936
937         tmp = readl(port_mmio + PORT_SIG);
938         tf.lbah         = (tmp >> 24)   & 0xff;
939         tf.lbam         = (tmp >> 16)   & 0xff;
940         tf.lbal         = (tmp >> 8)    & 0xff;
941         tf.nsect        = (tmp)         & 0xff;
942
943         return ata_dev_classify(&tf);
944 }
945
946 static void ahci_fill_cmd_slot(struct ahci_port_priv *pp, unsigned int tag,
947                                u32 opts)
948 {
949         dma_addr_t cmd_tbl_dma;
950
951         cmd_tbl_dma = pp->cmd_tbl_dma + tag * AHCI_CMD_TBL_SZ;
952
953         pp->cmd_slot[tag].opts = cpu_to_le32(opts);
954         pp->cmd_slot[tag].status = 0;
955         pp->cmd_slot[tag].tbl_addr = cpu_to_le32(cmd_tbl_dma & 0xffffffff);
956         pp->cmd_slot[tag].tbl_addr_hi = cpu_to_le32((cmd_tbl_dma >> 16) >> 16);
957 }
958
959 static int ahci_kick_engine(struct ata_port *ap, int force_restart)
960 {
961         void __iomem *port_mmio = ap->ioaddr.cmd_addr;
962         struct ahci_host_priv *hpriv = ap->host->private_data;
963         u32 tmp;
964         int busy, rc;
965
966         /* do we need to kick the port? */
967         busy = ahci_check_status(ap) & (ATA_BUSY | ATA_DRQ);
968         if (!busy && !force_restart)
969                 return 0;
970
971         /* stop engine */
972         rc = ahci_stop_engine(ap);
973         if (rc)
974                 goto out_restart;
975
976         /* need to do CLO? */
977         if (!busy) {
978                 rc = 0;
979                 goto out_restart;
980         }
981
982         if (!(hpriv->cap & HOST_CAP_CLO)) {
983                 rc = -EOPNOTSUPP;
984                 goto out_restart;
985         }
986
987         /* perform CLO */
988         tmp = readl(port_mmio + PORT_CMD);
989         tmp |= PORT_CMD_CLO;
990         writel(tmp, port_mmio + PORT_CMD);
991
992         rc = 0;
993         tmp = ata_wait_register(port_mmio + PORT_CMD,
994                                 PORT_CMD_CLO, PORT_CMD_CLO, 1, 500);
995         if (tmp & PORT_CMD_CLO)
996                 rc = -EIO;
997
998         /* restart engine */
999  out_restart:
1000         ahci_start_engine(ap);
1001         return rc;
1002 }
1003
1004 static int ahci_exec_polled_cmd(struct ata_port *ap, int pmp,
1005                                 struct ata_taskfile *tf, int is_cmd, u16 flags,
1006                                 unsigned long timeout_msec)
1007 {
1008         const u32 cmd_fis_len = 5; /* five dwords */
1009         struct ahci_port_priv *pp = ap->private_data;
1010         void __iomem *port_mmio = ahci_port_base(ap);
1011         u8 *fis = pp->cmd_tbl;
1012         u32 tmp;
1013
1014         /* prep the command */
1015         ata_tf_to_fis(tf, pmp, is_cmd, fis);
1016         ahci_fill_cmd_slot(pp, 0, cmd_fis_len | flags | (pmp << 12));
1017
1018         /* issue & wait */
1019         writel(1, port_mmio + PORT_CMD_ISSUE);
1020
1021         if (timeout_msec) {
1022                 tmp = ata_wait_register(port_mmio + PORT_CMD_ISSUE, 0x1, 0x1,
1023                                         1, timeout_msec);
1024                 if (tmp & 0x1) {
1025                         ahci_kick_engine(ap, 1);
1026                         return -EBUSY;
1027                 }
1028         } else
1029                 readl(port_mmio + PORT_CMD_ISSUE);      /* flush */
1030
1031         return 0;
1032 }
1033
1034 static int ahci_do_softreset(struct ata_link *link, unsigned int *class,
1035                              int pmp, unsigned long deadline)
1036 {
1037         struct ata_port *ap = link->ap;
1038         const char *reason = NULL;
1039         unsigned long now, msecs;
1040         struct ata_taskfile tf;
1041         int rc;
1042
1043         DPRINTK("ENTER\n");
1044
1045         if (ata_link_offline(link)) {
1046                 DPRINTK("PHY reports no device\n");
1047                 *class = ATA_DEV_NONE;
1048                 return 0;
1049         }
1050
1051         /* prepare for SRST (AHCI-1.1 10.4.1) */
1052         rc = ahci_kick_engine(ap, 1);
1053         if (rc)
1054                 ata_link_printk(link, KERN_WARNING,
1055                                 "failed to reset engine (errno=%d)", rc);
1056
1057         ata_tf_init(link->device, &tf);
1058
1059         /* issue the first D2H Register FIS */
1060         msecs = 0;
1061         now = jiffies;
1062         if (time_after(now, deadline))
1063                 msecs = jiffies_to_msecs(deadline - now);
1064
1065         tf.ctl |= ATA_SRST;
1066         if (ahci_exec_polled_cmd(ap, pmp, &tf, 0,
1067                                  AHCI_CMD_RESET | AHCI_CMD_CLR_BUSY, msecs)) {
1068                 rc = -EIO;
1069                 reason = "1st FIS failed";
1070                 goto fail;
1071         }
1072
1073         /* spec says at least 5us, but be generous and sleep for 1ms */
1074         msleep(1);
1075
1076         /* issue the second D2H Register FIS */
1077         tf.ctl &= ~ATA_SRST;
1078         ahci_exec_polled_cmd(ap, pmp, &tf, 0, 0, 0);
1079
1080         /* spec mandates ">= 2ms" before checking status.
1081          * We wait 150ms, because that was the magic delay used for
1082          * ATAPI devices in Hale Landis's ATADRVR, for the period of time
1083          * between when the ATA command register is written, and then
1084          * status is checked.  Because waiting for "a while" before
1085          * checking status is fine, post SRST, we perform this magic
1086          * delay here as well.
1087          */
1088         msleep(150);
1089
1090         rc = ata_wait_ready(ap, deadline);
1091         /* link occupied, -ENODEV too is an error */
1092         if (rc) {
1093                 reason = "device not ready";
1094                 goto fail;
1095         }
1096         *class = ahci_dev_classify(ap);
1097
1098         DPRINTK("EXIT, class=%u\n", *class);
1099         return 0;
1100
1101  fail:
1102         ata_link_printk(link, KERN_ERR, "softreset failed (%s)\n", reason);
1103         return rc;
1104 }
1105
1106 static int ahci_softreset(struct ata_link *link, unsigned int *class,
1107                           unsigned long deadline)
1108 {
1109         return ahci_do_softreset(link, class, 0, deadline);
1110 }
1111
1112 static int ahci_hardreset(struct ata_link *link, unsigned int *class,
1113                           unsigned long deadline)
1114 {
1115         struct ata_port *ap = link->ap;
1116         struct ahci_port_priv *pp = ap->private_data;
1117         u8 *d2h_fis = pp->rx_fis + RX_FIS_D2H_REG;
1118         struct ata_taskfile tf;
1119         int rc;
1120
1121         DPRINTK("ENTER\n");
1122
1123         ahci_stop_engine(ap);
1124
1125         /* clear D2H reception area to properly wait for D2H FIS */
1126         ata_tf_init(link->device, &tf);
1127         tf.command = 0x80;
1128         ata_tf_to_fis(&tf, 0, 0, d2h_fis);
1129
1130         rc = sata_std_hardreset(link, class, deadline);
1131
1132         ahci_start_engine(ap);
1133
1134         if (rc == 0 && ata_link_online(link))
1135                 *class = ahci_dev_classify(ap);
1136         if (*class == ATA_DEV_UNKNOWN)
1137                 *class = ATA_DEV_NONE;
1138
1139         DPRINTK("EXIT, rc=%d, class=%u\n", rc, *class);
1140         return rc;
1141 }
1142
1143 static int ahci_vt8251_hardreset(struct ata_link *link, unsigned int *class,
1144                                  unsigned long deadline)
1145 {
1146         struct ata_port *ap = link->ap;
1147         u32 serror;
1148         int rc;
1149
1150         DPRINTK("ENTER\n");
1151
1152         ahci_stop_engine(ap);
1153
1154         rc = sata_link_hardreset(link, sata_ehc_deb_timing(&link->eh_context),
1155                                  deadline);
1156
1157         /* vt8251 needs SError cleared for the port to operate */
1158         ahci_scr_read(ap, SCR_ERROR, &serror);
1159         ahci_scr_write(ap, SCR_ERROR, serror);
1160
1161         ahci_start_engine(ap);
1162
1163         DPRINTK("EXIT, rc=%d, class=%u\n", rc, *class);
1164
1165         /* vt8251 doesn't clear BSY on signature FIS reception,
1166          * request follow-up softreset.
1167          */
1168         return rc ?: -EAGAIN;
1169 }
1170
1171 static void ahci_postreset(struct ata_link *link, unsigned int *class)
1172 {
1173         struct ata_port *ap = link->ap;
1174         void __iomem *port_mmio = ahci_port_base(ap);
1175         u32 new_tmp, tmp;
1176
1177         ata_std_postreset(link, class);
1178
1179         /* Make sure port's ATAPI bit is set appropriately */
1180         new_tmp = tmp = readl(port_mmio + PORT_CMD);
1181         if (*class == ATA_DEV_ATAPI)
1182                 new_tmp |= PORT_CMD_ATAPI;
1183         else
1184                 new_tmp &= ~PORT_CMD_ATAPI;
1185         if (new_tmp != tmp) {
1186                 writel(new_tmp, port_mmio + PORT_CMD);
1187                 readl(port_mmio + PORT_CMD); /* flush */
1188         }
1189 }
1190
1191 static u8 ahci_check_status(struct ata_port *ap)
1192 {
1193         void __iomem *mmio = ap->ioaddr.cmd_addr;
1194
1195         return readl(mmio + PORT_TFDATA) & 0xFF;
1196 }
1197
1198 static void ahci_tf_read(struct ata_port *ap, struct ata_taskfile *tf)
1199 {
1200         struct ahci_port_priv *pp = ap->private_data;
1201         u8 *d2h_fis = pp->rx_fis + RX_FIS_D2H_REG;
1202
1203         ata_tf_from_fis(d2h_fis, tf);
1204 }
1205
1206 static unsigned int ahci_fill_sg(struct ata_queued_cmd *qc, void *cmd_tbl)
1207 {
1208         struct scatterlist *sg;
1209         struct ahci_sg *ahci_sg;
1210         unsigned int n_sg = 0;
1211
1212         VPRINTK("ENTER\n");
1213
1214         /*
1215          * Next, the S/G list.
1216          */
1217         ahci_sg = cmd_tbl + AHCI_CMD_TBL_HDR_SZ;
1218         ata_for_each_sg(sg, qc) {
1219                 dma_addr_t addr = sg_dma_address(sg);
1220                 u32 sg_len = sg_dma_len(sg);
1221
1222                 ahci_sg->addr = cpu_to_le32(addr & 0xffffffff);
1223                 ahci_sg->addr_hi = cpu_to_le32((addr >> 16) >> 16);
1224                 ahci_sg->flags_size = cpu_to_le32(sg_len - 1);
1225
1226                 ahci_sg++;
1227                 n_sg++;
1228         }
1229
1230         return n_sg;
1231 }
1232
1233 static void ahci_qc_prep(struct ata_queued_cmd *qc)
1234 {
1235         struct ata_port *ap = qc->ap;
1236         struct ahci_port_priv *pp = ap->private_data;
1237         int is_atapi = is_atapi_taskfile(&qc->tf);
1238         void *cmd_tbl;
1239         u32 opts;
1240         const u32 cmd_fis_len = 5; /* five dwords */
1241         unsigned int n_elem;
1242
1243         /*
1244          * Fill in command table information.  First, the header,
1245          * a SATA Register - Host to Device command FIS.
1246          */
1247         cmd_tbl = pp->cmd_tbl + qc->tag * AHCI_CMD_TBL_SZ;
1248
1249         ata_tf_to_fis(&qc->tf, 0, 1, cmd_tbl);
1250         if (is_atapi) {
1251                 memset(cmd_tbl + AHCI_CMD_TBL_CDB, 0, 32);
1252                 memcpy(cmd_tbl + AHCI_CMD_TBL_CDB, qc->cdb, qc->dev->cdb_len);
1253         }
1254
1255         n_elem = 0;
1256         if (qc->flags & ATA_QCFLAG_DMAMAP)
1257                 n_elem = ahci_fill_sg(qc, cmd_tbl);
1258
1259         /*
1260          * Fill in command slot information.
1261          */
1262         opts = cmd_fis_len | n_elem << 16;
1263         if (qc->tf.flags & ATA_TFLAG_WRITE)
1264                 opts |= AHCI_CMD_WRITE;
1265         if (is_atapi)
1266                 opts |= AHCI_CMD_ATAPI | AHCI_CMD_PREFETCH;
1267
1268         ahci_fill_cmd_slot(pp, qc->tag, opts);
1269 }
1270
1271 static void ahci_error_intr(struct ata_port *ap, u32 irq_stat)
1272 {
1273         struct ahci_port_priv *pp = ap->private_data;
1274         struct ata_eh_info *ehi = &ap->link.eh_info;
1275         unsigned int err_mask = 0, action = 0;
1276         struct ata_queued_cmd *qc;
1277         u32 serror;
1278
1279         ata_ehi_clear_desc(ehi);
1280
1281         /* AHCI needs SError cleared; otherwise, it might lock up */
1282         ahci_scr_read(ap, SCR_ERROR, &serror);
1283         ahci_scr_write(ap, SCR_ERROR, serror);
1284
1285         /* analyze @irq_stat */
1286         ata_ehi_push_desc(ehi, "irq_stat 0x%08x", irq_stat);
1287
1288         /* some controllers set IRQ_IF_ERR on device errors, ignore it */
1289         if (ap->flags & AHCI_FLAG_IGN_IRQ_IF_ERR)
1290                 irq_stat &= ~PORT_IRQ_IF_ERR;
1291
1292         if (irq_stat & PORT_IRQ_TF_ERR) {
1293                 err_mask |= AC_ERR_DEV;
1294                 if (ap->flags & AHCI_FLAG_IGN_SERR_INTERNAL)
1295                         serror &= ~SERR_INTERNAL;
1296         }
1297
1298         if (irq_stat & (PORT_IRQ_HBUS_ERR | PORT_IRQ_HBUS_DATA_ERR)) {
1299                 err_mask |= AC_ERR_HOST_BUS;
1300                 action |= ATA_EH_SOFTRESET;
1301         }
1302
1303         if (irq_stat & PORT_IRQ_IF_ERR) {
1304                 err_mask |= AC_ERR_ATA_BUS;
1305                 action |= ATA_EH_SOFTRESET;
1306                 ata_ehi_push_desc(ehi, "interface fatal error");
1307         }
1308
1309         if (irq_stat & (PORT_IRQ_CONNECT | PORT_IRQ_PHYRDY)) {
1310                 ata_ehi_hotplugged(ehi);
1311                 ata_ehi_push_desc(ehi, "%s", irq_stat & PORT_IRQ_CONNECT ?
1312                         "connection status changed" : "PHY RDY changed");
1313         }
1314
1315         if (irq_stat & PORT_IRQ_UNK_FIS) {
1316                 u32 *unk = (u32 *)(pp->rx_fis + RX_FIS_UNK);
1317
1318                 err_mask |= AC_ERR_HSM;
1319                 action |= ATA_EH_SOFTRESET;
1320                 ata_ehi_push_desc(ehi, "unknown FIS %08x %08x %08x %08x",
1321                                   unk[0], unk[1], unk[2], unk[3]);
1322         }
1323
1324         /* okay, let's hand over to EH */
1325         ehi->serror |= serror;
1326         ehi->action |= action;
1327
1328         qc = ata_qc_from_tag(ap, ap->link.active_tag);
1329         if (qc)
1330                 qc->err_mask |= err_mask;
1331         else
1332                 ehi->err_mask |= err_mask;
1333
1334         if (irq_stat & PORT_IRQ_FREEZE)
1335                 ata_port_freeze(ap);
1336         else
1337                 ata_port_abort(ap);
1338 }
1339
1340 static void ahci_port_intr(struct ata_port *ap)
1341 {
1342         void __iomem *port_mmio = ap->ioaddr.cmd_addr;
1343         struct ata_eh_info *ehi = &ap->link.eh_info;
1344         struct ahci_port_priv *pp = ap->private_data;
1345         u32 status, qc_active;
1346         int rc, known_irq = 0;
1347
1348         status = readl(port_mmio + PORT_IRQ_STAT);
1349         writel(status, port_mmio + PORT_IRQ_STAT);
1350
1351         if (unlikely(status & PORT_IRQ_ERROR)) {
1352                 ahci_error_intr(ap, status);
1353                 return;
1354         }
1355
1356         if (status & PORT_IRQ_SDB_FIS) {
1357                 /*
1358                  * if this is an ATAPI device with AN turned on,
1359                  * then we should interrogate the device to
1360                  * determine the cause of the interrupt
1361                  *
1362                  * for AN - this we should check the SDB FIS
1363                  * and find the I and N bits set
1364                  */
1365                 const __le32 *f = pp->rx_fis + RX_FIS_SDB;
1366                 u32 f0 = le32_to_cpu(f[0]);
1367
1368                 /* check the 'N' bit in word 0 of the FIS */
1369                 if (f0 & (1 << 15)) {
1370                         int port_addr = ((f0 & 0x00000f00) >> 8);
1371                         struct ata_device *adev;
1372                         if (port_addr < ATA_MAX_DEVICES) {
1373                                 adev = &ap->link.device[port_addr];
1374                                 if (adev->flags & ATA_DFLAG_AN)
1375                                         ata_scsi_media_change_notify(adev);
1376                         }
1377                 }
1378         }
1379
1380         if (ap->link.sactive)
1381                 qc_active = readl(port_mmio + PORT_SCR_ACT);
1382         else
1383                 qc_active = readl(port_mmio + PORT_CMD_ISSUE);
1384
1385         rc = ata_qc_complete_multiple(ap, qc_active, NULL);
1386         if (rc > 0)
1387                 return;
1388         if (rc < 0) {
1389                 ehi->err_mask |= AC_ERR_HSM;
1390                 ehi->action |= ATA_EH_SOFTRESET;
1391                 ata_port_freeze(ap);
1392                 return;
1393         }
1394
1395         /* hmmm... a spurious interupt */
1396
1397         /* if !NCQ, ignore.  No modern ATA device has broken HSM
1398          * implementation for non-NCQ commands.
1399          */
1400         if (!ap->link.sactive)
1401                 return;
1402
1403         if (status & PORT_IRQ_D2H_REG_FIS) {
1404                 if (!pp->ncq_saw_d2h)
1405                         ata_port_printk(ap, KERN_INFO,
1406                                 "D2H reg with I during NCQ, "
1407                                 "this message won't be printed again\n");
1408                 pp->ncq_saw_d2h = 1;
1409                 known_irq = 1;
1410         }
1411
1412         if (status & PORT_IRQ_DMAS_FIS) {
1413                 if (!pp->ncq_saw_dmas)
1414                         ata_port_printk(ap, KERN_INFO,
1415                                 "DMAS FIS during NCQ, "
1416                                 "this message won't be printed again\n");
1417                 pp->ncq_saw_dmas = 1;
1418                 known_irq = 1;
1419         }
1420
1421         if (status & PORT_IRQ_SDB_FIS) {
1422                 const __le32 *f = pp->rx_fis + RX_FIS_SDB;
1423
1424                 if (le32_to_cpu(f[1])) {
1425                         /* SDB FIS containing spurious completions
1426                          * might be dangerous, whine and fail commands
1427                          * with HSM violation.  EH will turn off NCQ
1428                          * after several such failures.
1429                          */
1430                         ata_ehi_push_desc(ehi,
1431                                 "spurious completions during NCQ "
1432                                 "issue=0x%x SAct=0x%x FIS=%08x:%08x",
1433                                 readl(port_mmio + PORT_CMD_ISSUE),
1434                                 readl(port_mmio + PORT_SCR_ACT),
1435                                 le32_to_cpu(f[0]), le32_to_cpu(f[1]));
1436                         ehi->err_mask |= AC_ERR_HSM;
1437                         ehi->action |= ATA_EH_SOFTRESET;
1438                         ata_port_freeze(ap);
1439                 } else {
1440                         if (!pp->ncq_saw_sdb)
1441                                 ata_port_printk(ap, KERN_INFO,
1442                                         "spurious SDB FIS %08x:%08x during NCQ, "
1443                                         "this message won't be printed again\n",
1444                                         le32_to_cpu(f[0]), le32_to_cpu(f[1]));
1445                         pp->ncq_saw_sdb = 1;
1446                 }
1447                 known_irq = 1;
1448         }
1449
1450         if (!known_irq)
1451                 ata_port_printk(ap, KERN_INFO, "spurious interrupt "
1452                                 "(irq_stat 0x%x active_tag 0x%x sactive 0x%x)\n",
1453                                 status, ap->link.active_tag, ap->link.sactive);
1454 }
1455
1456 static void ahci_irq_clear(struct ata_port *ap)
1457 {
1458         /* TODO */
1459 }
1460
1461 static irqreturn_t ahci_interrupt(int irq, void *dev_instance)
1462 {
1463         struct ata_host *host = dev_instance;
1464         struct ahci_host_priv *hpriv;
1465         unsigned int i, handled = 0;
1466         void __iomem *mmio;
1467         u32 irq_stat, irq_ack = 0;
1468
1469         VPRINTK("ENTER\n");
1470
1471         hpriv = host->private_data;
1472         mmio = host->iomap[AHCI_PCI_BAR];
1473
1474         /* sigh.  0xffffffff is a valid return from h/w */
1475         irq_stat = readl(mmio + HOST_IRQ_STAT);
1476         irq_stat &= hpriv->port_map;
1477         if (!irq_stat)
1478                 return IRQ_NONE;
1479
1480         spin_lock(&host->lock);
1481
1482         for (i = 0; i < host->n_ports; i++) {
1483                 struct ata_port *ap;
1484
1485                 if (!(irq_stat & (1 << i)))
1486                         continue;
1487
1488                 ap = host->ports[i];
1489                 if (ap) {
1490                         ahci_port_intr(ap);
1491                         VPRINTK("port %u\n", i);
1492                 } else {
1493                         VPRINTK("port %u (no irq)\n", i);
1494                         if (ata_ratelimit())
1495                                 dev_printk(KERN_WARNING, host->dev,
1496                                         "interrupt on disabled port %u\n", i);
1497                 }
1498
1499                 irq_ack |= (1 << i);
1500         }
1501
1502         if (irq_ack) {
1503                 writel(irq_ack, mmio + HOST_IRQ_STAT);
1504                 handled = 1;
1505         }
1506
1507         spin_unlock(&host->lock);
1508
1509         VPRINTK("EXIT\n");
1510
1511         return IRQ_RETVAL(handled);
1512 }
1513
1514 static unsigned int ahci_qc_issue(struct ata_queued_cmd *qc)
1515 {
1516         struct ata_port *ap = qc->ap;
1517         void __iomem *port_mmio = ahci_port_base(ap);
1518
1519         if (qc->tf.protocol == ATA_PROT_NCQ)
1520                 writel(1 << qc->tag, port_mmio + PORT_SCR_ACT);
1521         writel(1 << qc->tag, port_mmio + PORT_CMD_ISSUE);
1522         readl(port_mmio + PORT_CMD_ISSUE);      /* flush */
1523
1524         return 0;
1525 }
1526
1527 static void ahci_freeze(struct ata_port *ap)
1528 {
1529         void __iomem *port_mmio = ahci_port_base(ap);
1530
1531         /* turn IRQ off */
1532         writel(0, port_mmio + PORT_IRQ_MASK);
1533 }
1534
1535 static void ahci_thaw(struct ata_port *ap)
1536 {
1537         void __iomem *mmio = ap->host->iomap[AHCI_PCI_BAR];
1538         void __iomem *port_mmio = ahci_port_base(ap);
1539         u32 tmp;
1540         struct ahci_port_priv *pp = ap->private_data;
1541
1542         /* clear IRQ */
1543         tmp = readl(port_mmio + PORT_IRQ_STAT);
1544         writel(tmp, port_mmio + PORT_IRQ_STAT);
1545         writel(1 << ap->port_no, mmio + HOST_IRQ_STAT);
1546
1547         /* turn IRQ back on */
1548         writel(pp->intr_mask, port_mmio + PORT_IRQ_MASK);
1549 }
1550
1551 static void ahci_error_handler(struct ata_port *ap)
1552 {
1553         if (!(ap->pflags & ATA_PFLAG_FROZEN)) {
1554                 /* restart engine */
1555                 ahci_stop_engine(ap);
1556                 ahci_start_engine(ap);
1557         }
1558
1559         /* perform recovery */
1560         ata_do_eh(ap, ata_std_prereset, ahci_softreset, ahci_hardreset,
1561                   ahci_postreset);
1562 }
1563
1564 static void ahci_vt8251_error_handler(struct ata_port *ap)
1565 {
1566         if (!(ap->pflags & ATA_PFLAG_FROZEN)) {
1567                 /* restart engine */
1568                 ahci_stop_engine(ap);
1569                 ahci_start_engine(ap);
1570         }
1571
1572         /* perform recovery */
1573         ata_do_eh(ap, ata_std_prereset, ahci_softreset, ahci_vt8251_hardreset,
1574                   ahci_postreset);
1575 }
1576
1577 static void ahci_post_internal_cmd(struct ata_queued_cmd *qc)
1578 {
1579         struct ata_port *ap = qc->ap;
1580
1581         /* make DMA engine forget about the failed command */
1582         if (qc->flags & ATA_QCFLAG_FAILED)
1583                 ahci_kick_engine(ap, 1);
1584 }
1585
1586 static int ahci_port_resume(struct ata_port *ap)
1587 {
1588         ahci_power_up(ap);
1589         ahci_start_port(ap);
1590
1591         return 0;
1592 }
1593
1594 #ifdef CONFIG_PM
1595 static int ahci_port_suspend(struct ata_port *ap, pm_message_t mesg)
1596 {
1597         const char *emsg = NULL;
1598         int rc;
1599
1600         rc = ahci_deinit_port(ap, &emsg);
1601         if (rc == 0)
1602                 ahci_power_down(ap);
1603         else {
1604                 ata_port_printk(ap, KERN_ERR, "%s (%d)\n", emsg, rc);
1605                 ahci_start_port(ap);
1606         }
1607
1608         return rc;
1609 }
1610
1611 static int ahci_pci_device_suspend(struct pci_dev *pdev, pm_message_t mesg)
1612 {
1613         struct ata_host *host = dev_get_drvdata(&pdev->dev);
1614         void __iomem *mmio = host->iomap[AHCI_PCI_BAR];
1615         u32 ctl;
1616
1617         if (mesg.event == PM_EVENT_SUSPEND) {
1618                 /* AHCI spec rev1.1 section 8.3.3:
1619                  * Software must disable interrupts prior to requesting a
1620                  * transition of the HBA to D3 state.
1621                  */
1622                 ctl = readl(mmio + HOST_CTL);
1623                 ctl &= ~HOST_IRQ_EN;
1624                 writel(ctl, mmio + HOST_CTL);
1625                 readl(mmio + HOST_CTL); /* flush */
1626         }
1627
1628         return ata_pci_device_suspend(pdev, mesg);
1629 }
1630
1631 static int ahci_pci_device_resume(struct pci_dev *pdev)
1632 {
1633         struct ata_host *host = dev_get_drvdata(&pdev->dev);
1634         int rc;
1635
1636         rc = ata_pci_device_do_resume(pdev);
1637         if (rc)
1638                 return rc;
1639
1640         if (pdev->dev.power.power_state.event == PM_EVENT_SUSPEND) {
1641                 rc = ahci_reset_controller(host);
1642                 if (rc)
1643                         return rc;
1644
1645                 ahci_init_controller(host);
1646         }
1647
1648         ata_host_resume(host);
1649
1650         return 0;
1651 }
1652 #endif
1653
1654 static int ahci_port_start(struct ata_port *ap)
1655 {
1656         struct device *dev = ap->host->dev;
1657         struct ahci_port_priv *pp;
1658         void *mem;
1659         dma_addr_t mem_dma;
1660         int rc;
1661
1662         pp = devm_kzalloc(dev, sizeof(*pp), GFP_KERNEL);
1663         if (!pp)
1664                 return -ENOMEM;
1665
1666         rc = ata_pad_alloc(ap, dev);
1667         if (rc)
1668                 return rc;
1669
1670         mem = dmam_alloc_coherent(dev, AHCI_PORT_PRIV_DMA_SZ, &mem_dma,
1671                                   GFP_KERNEL);
1672         if (!mem)
1673                 return -ENOMEM;
1674         memset(mem, 0, AHCI_PORT_PRIV_DMA_SZ);
1675
1676         /*
1677          * First item in chunk of DMA memory: 32-slot command table,
1678          * 32 bytes each in size
1679          */
1680         pp->cmd_slot = mem;
1681         pp->cmd_slot_dma = mem_dma;
1682
1683         mem += AHCI_CMD_SLOT_SZ;
1684         mem_dma += AHCI_CMD_SLOT_SZ;
1685
1686         /*
1687          * Second item: Received-FIS area
1688          */
1689         pp->rx_fis = mem;
1690         pp->rx_fis_dma = mem_dma;
1691
1692         mem += AHCI_RX_FIS_SZ;
1693         mem_dma += AHCI_RX_FIS_SZ;
1694
1695         /*
1696          * Third item: data area for storing a single command
1697          * and its scatter-gather table
1698          */
1699         pp->cmd_tbl = mem;
1700         pp->cmd_tbl_dma = mem_dma;
1701
1702         /*
1703          * Save off initial list of interrupts to be enabled.
1704          * This could be changed later
1705          */
1706         pp->intr_mask = DEF_PORT_IRQ;
1707
1708         ap->private_data = pp;
1709
1710         /* engage engines, captain */
1711         return ahci_port_resume(ap);
1712 }
1713
1714 static void ahci_port_stop(struct ata_port *ap)
1715 {
1716         const char *emsg = NULL;
1717         int rc;
1718
1719         /* de-initialize port */
1720         rc = ahci_deinit_port(ap, &emsg);
1721         if (rc)
1722                 ata_port_printk(ap, KERN_WARNING, "%s (%d)\n", emsg, rc);
1723 }
1724
1725 static int ahci_configure_dma_masks(struct pci_dev *pdev, int using_dac)
1726 {
1727         int rc;
1728
1729         if (using_dac &&
1730             !pci_set_dma_mask(pdev, DMA_64BIT_MASK)) {
1731                 rc = pci_set_consistent_dma_mask(pdev, DMA_64BIT_MASK);
1732                 if (rc) {
1733                         rc = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
1734                         if (rc) {
1735                                 dev_printk(KERN_ERR, &pdev->dev,
1736                                            "64-bit DMA enable failed\n");
1737                                 return rc;
1738                         }
1739                 }
1740         } else {
1741                 rc = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
1742                 if (rc) {
1743                         dev_printk(KERN_ERR, &pdev->dev,
1744                                    "32-bit DMA enable failed\n");
1745                         return rc;
1746                 }
1747                 rc = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
1748                 if (rc) {
1749                         dev_printk(KERN_ERR, &pdev->dev,
1750                                    "32-bit consistent DMA enable failed\n");
1751                         return rc;
1752                 }
1753         }
1754         return 0;
1755 }
1756
1757 static void ahci_print_info(struct ata_host *host)
1758 {
1759         struct ahci_host_priv *hpriv = host->private_data;
1760         struct pci_dev *pdev = to_pci_dev(host->dev);
1761         void __iomem *mmio = host->iomap[AHCI_PCI_BAR];
1762         u32 vers, cap, impl, speed;
1763         const char *speed_s;
1764         u16 cc;
1765         const char *scc_s;
1766
1767         vers = readl(mmio + HOST_VERSION);
1768         cap = hpriv->cap;
1769         impl = hpriv->port_map;
1770
1771         speed = (cap >> 20) & 0xf;
1772         if (speed == 1)
1773                 speed_s = "1.5";
1774         else if (speed == 2)
1775                 speed_s = "3";
1776         else
1777                 speed_s = "?";
1778
1779         pci_read_config_word(pdev, 0x0a, &cc);
1780         if (cc == PCI_CLASS_STORAGE_IDE)
1781                 scc_s = "IDE";
1782         else if (cc == PCI_CLASS_STORAGE_SATA)
1783                 scc_s = "SATA";
1784         else if (cc == PCI_CLASS_STORAGE_RAID)
1785                 scc_s = "RAID";
1786         else
1787                 scc_s = "unknown";
1788
1789         dev_printk(KERN_INFO, &pdev->dev,
1790                 "AHCI %02x%02x.%02x%02x "
1791                 "%u slots %u ports %s Gbps 0x%x impl %s mode\n"
1792                 ,
1793
1794                 (vers >> 24) & 0xff,
1795                 (vers >> 16) & 0xff,
1796                 (vers >> 8) & 0xff,
1797                 vers & 0xff,
1798
1799                 ((cap >> 8) & 0x1f) + 1,
1800                 (cap & 0x1f) + 1,
1801                 speed_s,
1802                 impl,
1803                 scc_s);
1804
1805         dev_printk(KERN_INFO, &pdev->dev,
1806                 "flags: "
1807                 "%s%s%s%s%s%s%s"
1808                 "%s%s%s%s%s%s%s\n"
1809                 ,
1810
1811                 cap & (1 << 31) ? "64bit " : "",
1812                 cap & (1 << 30) ? "ncq " : "",
1813                 cap & (1 << 29) ? "sntf " : "",
1814                 cap & (1 << 28) ? "ilck " : "",
1815                 cap & (1 << 27) ? "stag " : "",
1816                 cap & (1 << 26) ? "pm " : "",
1817                 cap & (1 << 25) ? "led " : "",
1818
1819                 cap & (1 << 24) ? "clo " : "",
1820                 cap & (1 << 19) ? "nz " : "",
1821                 cap & (1 << 18) ? "only " : "",
1822                 cap & (1 << 17) ? "pmp " : "",
1823                 cap & (1 << 15) ? "pio " : "",
1824                 cap & (1 << 14) ? "slum " : "",
1825                 cap & (1 << 13) ? "part " : ""
1826                 );
1827 }
1828
1829 static int ahci_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
1830 {
1831         static int printed_version;
1832         struct ata_port_info pi = ahci_port_info[ent->driver_data];
1833         const struct ata_port_info *ppi[] = { &pi, NULL };
1834         struct device *dev = &pdev->dev;
1835         struct ahci_host_priv *hpriv;
1836         struct ata_host *host;
1837         int i, rc;
1838
1839         VPRINTK("ENTER\n");
1840
1841         WARN_ON(ATA_MAX_QUEUE > AHCI_MAX_CMDS);
1842
1843         if (!printed_version++)
1844                 dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
1845
1846         /* acquire resources */
1847         rc = pcim_enable_device(pdev);
1848         if (rc)
1849                 return rc;
1850
1851         rc = pcim_iomap_regions(pdev, 1 << AHCI_PCI_BAR, DRV_NAME);
1852         if (rc == -EBUSY)
1853                 pcim_pin_device(pdev);
1854         if (rc)
1855                 return rc;
1856
1857         if ((pi.flags & AHCI_FLAG_NO_MSI) || pci_enable_msi(pdev))
1858                 pci_intx(pdev, 1);
1859
1860         hpriv = devm_kzalloc(dev, sizeof(*hpriv), GFP_KERNEL);
1861         if (!hpriv)
1862                 return -ENOMEM;
1863
1864         /* save initial config */
1865         ahci_save_initial_config(pdev, &pi, hpriv);
1866
1867         /* prepare host */
1868         if (hpriv->cap & HOST_CAP_NCQ)
1869                 pi.flags |= ATA_FLAG_NCQ;
1870
1871         host = ata_host_alloc_pinfo(&pdev->dev, ppi, fls(hpriv->port_map));
1872         if (!host)
1873                 return -ENOMEM;
1874         host->iomap = pcim_iomap_table(pdev);
1875         host->private_data = hpriv;
1876
1877         for (i = 0; i < host->n_ports; i++) {
1878                 struct ata_port *ap = host->ports[i];
1879                 void __iomem *port_mmio = ahci_port_base(ap);
1880
1881                 ata_port_pbar_desc(ap, AHCI_PCI_BAR, -1, "abar");
1882                 ata_port_pbar_desc(ap, AHCI_PCI_BAR,
1883                                    0x100 + ap->port_no * 0x80, "port");
1884
1885                 /* standard SATA port setup */
1886                 if (hpriv->port_map & (1 << i))
1887                         ap->ioaddr.cmd_addr = port_mmio;
1888
1889                 /* disabled/not-implemented port */
1890                 else
1891                         ap->ops = &ata_dummy_port_ops;
1892         }
1893
1894         /* initialize adapter */
1895         rc = ahci_configure_dma_masks(pdev, hpriv->cap & HOST_CAP_64);
1896         if (rc)
1897                 return rc;
1898
1899         rc = ahci_reset_controller(host);
1900         if (rc)
1901                 return rc;
1902
1903         ahci_init_controller(host);
1904         ahci_print_info(host);
1905
1906         pci_set_master(pdev);
1907         return ata_host_activate(host, pdev->irq, ahci_interrupt, IRQF_SHARED,
1908                                  &ahci_sht);
1909 }
1910
1911 static int __init ahci_init(void)
1912 {
1913         return pci_register_driver(&ahci_pci_driver);
1914 }
1915
1916 static void __exit ahci_exit(void)
1917 {
1918         pci_unregister_driver(&ahci_pci_driver);
1919 }
1920
1921
1922 MODULE_AUTHOR("Jeff Garzik");
1923 MODULE_DESCRIPTION("AHCI SATA low-level driver");
1924 MODULE_LICENSE("GPL");
1925 MODULE_DEVICE_TABLE(pci, ahci_pci_tbl);
1926 MODULE_VERSION(DRV_VERSION);
1927
1928 module_init(ahci_init);
1929 module_exit(ahci_exit);