sata_mv.c revision 3e4ec3443f70fbe144799ccf0b1c3797f78d1715
120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ/* 220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * sata_mv.c - Marvell SATA support 320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * 440f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord * Copyright 2008-2009: Marvell Corporation, all rights reserved. 58b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik * Copyright 2005: EMC Corporation, all rights reserved. 6e2b1be56c5656902744c2b52e8304126a40bb609Jeff Garzik * Copyright 2005 Red Hat, Inc. All rights reserved. 720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * 840f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord * Originally written by Brett Russ. 940f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord * Extensive overhaul and enhancement by Mark Lord <mlord@pobox.com>. 1040f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord * 1120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * Please ALWAYS copy linux-ide@vger.kernel.org on emails. 1220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * 1320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * This program is free software; you can redistribute it and/or modify 1420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * it under the terms of the GNU General Public License as published by 1520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * the Free Software Foundation; version 2 of the License. 1620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * 1720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * This program is distributed in the hope that it will be useful, 1820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * but WITHOUT ANY WARRANTY; without even the implied warranty of 1920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 2020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * GNU General Public License for more details. 2120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * 2220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * You should have received a copy of the GNU General Public License 2320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * along with this program; if not, write to the Free Software 2420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 2520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * 2620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ */ 2720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 284a05e2091709dbb22b86a1b3343cd3fa3c0d7a6bJeff Garzik/* 2985afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * sata_mv TODO list: 3085afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * 3185afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * --> Develop a low-power-consumption strategy, and implement it. 3285afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * 332b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * --> Add sysfs attributes for per-chip / per-HC IRQ coalescing thresholds. 3485afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * 3585afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * --> [Experiment, Marvell value added] Is it possible to use target 3685afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * mode to cross-connect two Linux boxes with Marvell cards? If so, 3785afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * creating LibATA target mode support would be very interesting. 3885afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * 3985afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * Target mode, for those without docs, is the ability to directly 4085afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord * connect two SATA ports. 4185afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord */ 424a05e2091709dbb22b86a1b3343cd3fa3c0d7a6bJeff Garzik 4365ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord/* 4465ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord * 80x1-B2 errata PCI#11: 4565ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord * 4665ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord * Users of the 6041/6081 Rev.B2 chips (current is C0) 4765ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord * should be careful to insert those cards only onto PCI-X bus #0, 4865ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord * and only in device slots 0..7, not higher. The chips may not 4965ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord * work correctly otherwise (note: this is a pretty rare condition). 5065ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord */ 5165ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord 5220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#include <linux/kernel.h> 5320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#include <linux/module.h> 5420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#include <linux/pci.h> 5520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#include <linux/init.h> 5620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#include <linux/blkdev.h> 5720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#include <linux/delay.h> 5820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#include <linux/interrupt.h> 598d8b60046d6a2328ca4b9031b4948084f775f607Andrew Morton#include <linux/dmapool.h> 6020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#include <linux/dma-mapping.h> 61a9524a76f70f3343e4be27f95a7e92a8ba5f9009Jeff Garzik#include <linux/device.h> 62c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#include <linux/clk.h> 63f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara#include <linux/platform_device.h> 64f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara#include <linux/ata_platform.h> 6515a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek#include <linux/mbus.h> 66c46938ccfe35a58a0873715ee4c26fc9eb8d87b3Mark Lord#include <linux/bitops.h> 675a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/gfp.h> 6820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#include <scsi/scsi_host.h> 69193515d51ccb363165d6b09e9ba5c21089e34badJeff Garzik#include <scsi/scsi_cmnd.h> 706c08772e49622e90d39903e7ff0be1a0f463ac86Jeff Garzik#include <scsi/scsi_device.h> 7120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#include <linux/libata.h> 7220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 7320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ#define DRV_NAME "sata_mv" 74cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord#define DRV_VERSION "1.28" 7520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 7640f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord/* 7740f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord * module options 7840f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord */ 7940f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord 8040f21b1124a9552bc093469280eb8239dc5f73d7Mark Lordstatic int msi; 8140f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord#ifdef CONFIG_PCI 8240f21b1124a9552bc093469280eb8239dc5f73d7Mark Lordmodule_param(msi, int, S_IRUGO); 8340f21b1124a9552bc093469280eb8239dc5f73d7Mark LordMODULE_PARM_DESC(msi, "Enable use of PCI MSI (0=off, 1=on)"); 8440f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord#endif 8540f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord 862b748a0a344847fe6b924407bbe153e1878c9f09Mark Lordstatic int irq_coalescing_io_count; 872b748a0a344847fe6b924407bbe153e1878c9f09Mark Lordmodule_param(irq_coalescing_io_count, int, S_IRUGO); 882b748a0a344847fe6b924407bbe153e1878c9f09Mark LordMODULE_PARM_DESC(irq_coalescing_io_count, 892b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord "IRQ coalescing I/O count threshold (0..255)"); 902b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 912b748a0a344847fe6b924407bbe153e1878c9f09Mark Lordstatic int irq_coalescing_usecs; 922b748a0a344847fe6b924407bbe153e1878c9f09Mark Lordmodule_param(irq_coalescing_usecs, int, S_IRUGO); 932b748a0a344847fe6b924407bbe153e1878c9f09Mark LordMODULE_PARM_DESC(irq_coalescing_usecs, 942b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord "IRQ coalescing time threshold in usecs"); 952b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 9620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russenum { 9720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ /* BAR's are enumerated in terms of pci_resource_start() terms */ 9820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_PRIMARY_BAR = 0, /* offset 0x10: memory space */ 9920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_IO_BAR = 2, /* offset 0x18: IO space */ 10020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_MISC_BAR = 3, /* offset 0x1c: FLASH, NVRAM, SRAM */ 10120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 10220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_MAJOR_REG_AREA_SZ = 0x10000, /* 64KB */ 10320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_MINOR_REG_AREA_SZ = 0x2000, /* 8KB */ 10420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 1052b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* For use with both IRQ coalescing methods ("all ports" or "per-HC" */ 1062b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord COAL_CLOCKS_PER_USEC = 150, /* for calculating COAL_TIMEs */ 1072b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord MAX_COAL_TIME_THRESHOLD = ((1 << 24) - 1), /* internal clocks count */ 1082b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord MAX_COAL_IO_COUNT = 255, /* completed I/O count */ 1092b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 11020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_PCI_REG_BASE = 0, 111615ab95342f6245026d8974b9724f7ea57d9a184Mark Lord 1122b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* 1132b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * Per-chip ("all ports") interrupt coalescing feature. 1142b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * This is only for GEN_II / GEN_IIE hardware. 1152b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * 1162b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * Coalescing defers the interrupt until either the IO_THRESHOLD 1172b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * (count of completed I/Os) is met, or the TIME_THRESHOLD is met. 1182b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord */ 119cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord COAL_REG_BASE = 0x18000, 120cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord IRQ_COAL_CAUSE = (COAL_REG_BASE + 0x08), 1212b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord ALL_PORTS_COAL_IRQ = (1 << 4), /* all ports irq event */ 1222b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 123cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord IRQ_COAL_IO_THRESHOLD = (COAL_REG_BASE + 0xcc), 124cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord IRQ_COAL_TIME_THRESHOLD = (COAL_REG_BASE + 0xd0), 1252b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 1262b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* 1272b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * Registers for the (unused here) transaction coalescing feature: 1282b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord */ 129cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord TRAN_COAL_CAUSE_LO = (COAL_REG_BASE + 0x88), 130cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord TRAN_COAL_CAUSE_HI = (COAL_REG_BASE + 0x8c), 1312b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 132cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SATAHC0_REG_BASE = 0x20000, 133cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord FLASH_CTL = 0x1046c, 134cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord GPIO_PORT_CTL = 0x104f0, 135cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord RESET_CFG = 0x180d8, 13620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 13720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_PCI_REG_SZ = MV_MAJOR_REG_AREA_SZ, 13820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_SATAHC_REG_SZ = MV_MAJOR_REG_AREA_SZ, 13920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_SATAHC_ARBTR_REG_SZ = MV_MINOR_REG_AREA_SZ, /* arbiter */ 14020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_PORT_REG_SZ = MV_MINOR_REG_AREA_SZ, 14120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 14231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ MV_MAX_Q_DEPTH = 32, 14331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ MV_MAX_Q_DEPTH_MASK = MV_MAX_Q_DEPTH - 1, 14431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 14531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ /* CRQB needs alignment on a 1KB boundary. Size == 1KB 14631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * CRPB needs alignment on a 256B boundary. Size == 256B 14731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * ePRD (SG) entries need alignment on a 16B boundary. Size == 16B 14831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ */ 14931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ MV_CRQB_Q_SZ = (32 * MV_MAX_Q_DEPTH), 15031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ MV_CRPB_Q_SZ = (8 * MV_MAX_Q_DEPTH), 151da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord MV_MAX_SG_CT = 256, 15231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ MV_SG_TBL_SZ = (16 * MV_MAX_SG_CT), 15331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 154352fab701ca4753dd005b67ce5e512be944eb591Mark Lord /* Determine hc from 0-7 port: hc = port >> MV_PORT_HC_SHIFT */ 15520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_PORT_HC_SHIFT = 2, 156352fab701ca4753dd005b67ce5e512be944eb591Mark Lord MV_PORTS_PER_HC = (1 << MV_PORT_HC_SHIFT), /* 4 */ 157352fab701ca4753dd005b67ce5e512be944eb591Mark Lord /* Determine hc port from 0-7 port: hardport = port & MV_PORT_MASK */ 158352fab701ca4753dd005b67ce5e512be944eb591Mark Lord MV_PORT_MASK = (MV_PORTS_PER_HC - 1), /* 3 */ 15920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 16020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ /* Host Flags */ 16120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ MV_FLAG_DUAL_HC = (1 << 30), /* two SATA Host Controllers */ 1627bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara 163c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik MV_COMMON_FLAGS = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY | 16491b1a84c10869e2e46a576e5367de3166bff8eccMark Lord ATA_FLAG_MMIO | ATA_FLAG_PIO_POLLING, 165ad3aef51e17b9c6a90a9014805f1645e8e441c17Mark Lord 16691b1a84c10869e2e46a576e5367de3166bff8eccMark Lord MV_GEN_I_FLAGS = MV_COMMON_FLAGS | ATA_FLAG_NO_ATAPI, 16720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 16840f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord MV_GEN_II_FLAGS = MV_COMMON_FLAGS | ATA_FLAG_NCQ | 16940f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord ATA_FLAG_PMP | ATA_FLAG_ACPI_SATA, 17091b1a84c10869e2e46a576e5367de3166bff8eccMark Lord 17191b1a84c10869e2e46a576e5367de3166bff8eccMark Lord MV_GEN_IIE_FLAGS = MV_GEN_II_FLAGS | ATA_FLAG_AN, 172ad3aef51e17b9c6a90a9014805f1645e8e441c17Mark Lord 17331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ CRQB_FLAG_READ = (1 << 0), 17431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ CRQB_TAG_SHIFT = 1, 175c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik CRQB_IOID_SHIFT = 6, /* CRQB Gen-II/IIE IO Id shift */ 176e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord CRQB_PMP_SHIFT = 12, /* CRQB Gen-II/IIE PMP shift */ 177c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik CRQB_HOSTQ_SHIFT = 17, /* CRQB Gen-II/IIE HostQueTag shift */ 17831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ CRQB_CMD_ADDR_SHIFT = 8, 17931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ CRQB_CMD_CS = (0x2 << 11), 18031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ CRQB_CMD_LAST = (1 << 15), 18131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 18231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ CRPB_FLAG_STATUS_SHIFT = 8, 183c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik CRPB_IOID_SHIFT_6 = 5, /* CRPB Gen-II IO Id shift */ 184c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik CRPB_IOID_SHIFT_7 = 7, /* CRPB Gen-IIE IO Id shift */ 18531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 18631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ EPRD_FLAG_END_OF_TBL = (1 << 31), 18731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 18820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ /* PCI interface registers */ 18920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 190cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord MV_PCI_COMMAND = 0xc00, 191cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord MV_PCI_COMMAND_MWRCOM = (1 << 4), /* PCI Master Write Combining */ 192cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord MV_PCI_COMMAND_MRDTRIG = (1 << 7), /* PCI Master Read Trigger */ 19331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 194cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord PCI_MAIN_CMD_STS = 0xd30, 19520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ STOP_PCI_MASTER = (1 << 2), 19620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ PCI_MASTER_EMPTY = (1 << 3), 19720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ GLOB_SFT_RST = (1 << 4), 19820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 199cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord MV_PCI_MODE = 0xd00, 2008e7decdb8b132ee970a2636931b7653dec6af472Mark Lord MV_PCI_MODE_MASK = 0x30, 2018e7decdb8b132ee970a2636931b7653dec6af472Mark Lord 202522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik MV_PCI_EXP_ROM_BAR_CTL = 0xd2c, 203522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik MV_PCI_DISC_TIMER = 0xd04, 204522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik MV_PCI_MSI_TRIGGER = 0xc38, 205522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik MV_PCI_SERR_MASK = 0xc28, 206cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord MV_PCI_XBAR_TMOUT = 0x1d04, 207522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik MV_PCI_ERR_LOW_ADDRESS = 0x1d40, 208522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik MV_PCI_ERR_HIGH_ADDRESS = 0x1d44, 209522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik MV_PCI_ERR_ATTRIBUTE = 0x1d48, 210522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik MV_PCI_ERR_COMMAND = 0x1d50, 211522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik 212cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord PCI_IRQ_CAUSE = 0x1d58, 213cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord PCI_IRQ_MASK = 0x1d5c, 21420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ PCI_UNMASK_ALL_IRQS = 0x7fffff, /* bits 22-0 */ 21520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 216cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord PCIE_IRQ_CAUSE = 0x1900, 217cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord PCIE_IRQ_MASK = 0x1910, 218646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord PCIE_UNMASK_ALL_IRQS = 0x40a, /* assorted bits */ 21902a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord 2207368f91926a2870a8c3f9546d86535ce71ae0757Mark Lord /* Host Controller Main Interrupt Cause/Mask registers (1 per-chip) */ 221cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord PCI_HC_MAIN_IRQ_CAUSE = 0x1d60, 222cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord PCI_HC_MAIN_IRQ_MASK = 0x1d64, 223cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SOC_HC_MAIN_IRQ_CAUSE = 0x20020, 224cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SOC_HC_MAIN_IRQ_MASK = 0x20024, 22540f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord ERR_IRQ = (1 << 0), /* shift by (2 * port #) */ 22640f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord DONE_IRQ = (1 << 1), /* shift by (2 * port #) */ 22720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ HC0_IRQ_PEND = 0x1ff, /* bits 0-8 = HC0's ports */ 22820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ HC_SHIFT = 9, /* bits 9-17 = HC1's ports */ 2292b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord DONE_IRQ_0_3 = 0x000000aa, /* DONE_IRQ ports 0,1,2,3 */ 2302b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord DONE_IRQ_4_7 = (DONE_IRQ_0_3 << HC_SHIFT), /* 4,5,6,7 */ 23120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ PCI_ERR = (1 << 18), 23240f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord TRAN_COAL_LO_DONE = (1 << 19), /* transaction coalescing */ 23340f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord TRAN_COAL_HI_DONE = (1 << 20), /* transaction coalescing */ 23440f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord PORTS_0_3_COAL_DONE = (1 << 8), /* HC0 IRQ coalescing */ 23540f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord PORTS_4_7_COAL_DONE = (1 << 17), /* HC1 IRQ coalescing */ 23640f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord ALL_PORTS_COAL_DONE = (1 << 21), /* GEN_II(E) IRQ coalescing */ 23720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ GPIO_INT = (1 << 22), 23820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ SELF_INT = (1 << 23), 23920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ TWSI_INT = (1 << 24), 24020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ HC_MAIN_RSVD = (0x7f << 25), /* bits 31-25 */ 241fb621e2fde735abab854586d52c96c5624bcb5b8Jeff Garzik HC_MAIN_RSVD_5 = (0x1fff << 19), /* bits 31-19 */ 242e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord HC_MAIN_RSVD_SOC = (0x3fffffb << 6), /* bits 31-9, 7-6 */ 24320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 24420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ /* SATAHC registers */ 245cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord HC_CFG = 0x00, 24620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 247cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord HC_IRQ_CAUSE = 0x14, 248352fab701ca4753dd005b67ce5e512be944eb591Mark Lord DMA_IRQ = (1 << 0), /* shift by port # */ 249352fab701ca4753dd005b67ce5e512be944eb591Mark Lord HC_COAL_IRQ = (1 << 4), /* IRQ coalescing */ 25020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ DEV_IRQ = (1 << 8), /* shift by port # */ 25120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 2522b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* 2532b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * Per-HC (Host-Controller) interrupt coalescing feature. 2542b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * This is present on all chip generations. 2552b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * 2562b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * Coalescing defers the interrupt until either the IO_THRESHOLD 2572b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * (count of completed I/Os) is met, or the TIME_THRESHOLD is met. 2582b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord */ 259cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord HC_IRQ_COAL_IO_THRESHOLD = 0x000c, 260cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord HC_IRQ_COAL_TIME_THRESHOLD = 0x0010, 2612b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 262cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SOC_LED_CTRL = 0x2c, 263000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord SOC_LED_CTRL_BLINK = (1 << 0), /* Active LED blink */ 264000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord SOC_LED_CTRL_ACT_PRESENCE = (1 << 2), /* Multiplex dev presence */ 265000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord /* with dev activity LED */ 266000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord 26720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ /* Shadow block registers */ 268cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SHD_BLK = 0x100, 269cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SHD_CTL_AST = 0x20, /* ofs from SHD_BLK */ 27020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 27120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ /* SATA registers */ 272cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SATA_STATUS = 0x300, /* ctrl, err regs follow status */ 273cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SATA_ACTIVE = 0x350, 274cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord FIS_IRQ_CAUSE = 0x364, 275cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord FIS_IRQ_CAUSE_AN = (1 << 9), /* async notification */ 27617c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord 277cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord LTMODE = 0x30c, /* requires read-after-write */ 27817c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord LTMODE_BIT8 = (1 << 8), /* unknown, but necessary */ 27917c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord 280cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord PHY_MODE2 = 0x330, 28147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik PHY_MODE3 = 0x310, 282cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord 283cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord PHY_MODE4 = 0x314, /* requires read-after-write */ 284ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord PHY_MODE4_CFG_MASK = 0x00000003, /* phy internal config field */ 285ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord PHY_MODE4_CFG_VALUE = 0x00000001, /* phy internal config field */ 286ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord PHY_MODE4_RSVD_ZEROS = 0x5de3fffa, /* Gen2e always write zeros */ 287ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord PHY_MODE4_RSVD_ONES = 0x00000005, /* Gen2e always write ones */ 288ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord 289cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SATA_IFCTL = 0x344, 290cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SATA_TESTCTL = 0x348, 291cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SATA_IFSTAT = 0x34c, 292cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord VENDOR_UNIQUE_FIS = 0x35c, 29317c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord 294cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord FISCFG = 0x360, 2958e7decdb8b132ee970a2636931b7653dec6af472Mark Lord FISCFG_WAIT_DEV_ERR = (1 << 8), /* wait for host on DevErr */ 2968e7decdb8b132ee970a2636931b7653dec6af472Mark Lord FISCFG_SINGLE_SYNC = (1 << 16), /* SYNC on DMA activation */ 29717c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord 29829b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr PHY_MODE9_GEN2 = 0x398, 29929b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr PHY_MODE9_GEN1 = 0x39c, 30029b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr PHYCFG_OFS = 0x3a0, /* only in 65n devices */ 30129b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr 302c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik MV5_PHY_MODE = 0x74, 303cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord MV5_LTMODE = 0x30, 304cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord MV5_PHY_CTL = 0x0C, 305cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord SATA_IFCFG = 0x050, 306bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 307bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik MV_M2_PREAMP_MASK = 0x7e0, 30820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 30920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ /* Port registers */ 310cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_CFG = 0, 3110c58912e192fc3a4835d772aafa40b72552b819fMark Lord EDMA_CFG_Q_DEPTH = 0x1f, /* max device queue depth */ 3120c58912e192fc3a4835d772aafa40b72552b819fMark Lord EDMA_CFG_NCQ = (1 << 5), /* for R/W FPDMA queued */ 3130c58912e192fc3a4835d772aafa40b72552b819fMark Lord EDMA_CFG_NCQ_GO_ON_ERR = (1 << 14), /* continue on error */ 3140c58912e192fc3a4835d772aafa40b72552b819fMark Lord EDMA_CFG_RD_BRST_EXT = (1 << 11), /* read burst 512B */ 3150c58912e192fc3a4835d772aafa40b72552b819fMark Lord EDMA_CFG_WR_BUFF_LEN = (1 << 13), /* write buffer 512B */ 316e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord EDMA_CFG_EDMA_FBS = (1 << 16), /* EDMA FIS-Based Switching */ 317e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord EDMA_CFG_FBS = (1 << 26), /* FIS-Based Switching */ 31820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 319cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_ERR_IRQ_CAUSE = 0x8, 320cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_ERR_IRQ_MASK = 0xc, 3216c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_D_PAR = (1 << 0), /* UDMA data parity err */ 3226c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_PRD_PAR = (1 << 1), /* UDMA PRD parity err */ 3236c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_DEV = (1 << 2), /* device error */ 3246c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_DEV_DCON = (1 << 3), /* device disconnect */ 3256c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_DEV_CON = (1 << 4), /* device connected */ 3266c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_SERR = (1 << 5), /* SError bits [WBDST] raised */ 327c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik EDMA_ERR_SELF_DIS = (1 << 7), /* Gen II/IIE self-disable */ 328c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik EDMA_ERR_SELF_DIS_5 = (1 << 8), /* Gen I self-disable */ 3296c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_BIST_ASYNC = (1 << 8), /* BIST FIS or Async Notify */ 330c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik EDMA_ERR_TRANS_IRQ_7 = (1 << 8), /* Gen IIE transprt layer irq */ 3316c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_CRQB_PAR = (1 << 9), /* CRQB parity error */ 3326c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_CRPB_PAR = (1 << 10), /* CRPB parity error */ 3336c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_INTRL_PAR = (1 << 11), /* internal parity error */ 3346c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_IORDY = (1 << 12), /* IORdy timeout */ 335646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord 3366c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_LNK_CTRL_RX = (0xf << 13), /* link ctrl rx error */ 337646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_RX_0 = (1 << 13), /* transient: CRC err */ 338646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_RX_1 = (1 << 14), /* transient: FIFO err */ 339646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_RX_2 = (1 << 15), /* fatal: caught SYNC */ 340646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_RX_3 = (1 << 16), /* transient: FIS rx err */ 341646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord 3426c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_LNK_DATA_RX = (0xf << 17), /* link data rx error */ 343646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord 3446c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_LNK_CTRL_TX = (0x1f << 21), /* link ctrl tx error */ 345646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_TX_0 = (1 << 21), /* transient: CRC err */ 346646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_TX_1 = (1 << 22), /* transient: FIFO err */ 347646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_TX_2 = (1 << 23), /* transient: caught SYNC */ 348646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_TX_3 = (1 << 24), /* transient: caught DMAT */ 349646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_TX_4 = (1 << 25), /* transient: FIS collision */ 350646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord 3516c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_LNK_DATA_TX = (0x1f << 26), /* link data tx error */ 352646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord 3536c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_TRANS_PROTO = (1 << 31), /* transport protocol error */ 354c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik EDMA_ERR_OVERRUN_5 = (1 << 5), 355c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik EDMA_ERR_UNDERRUN_5 = (1 << 6), 356646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord 357646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_IRQ_TRANSIENT = EDMA_ERR_LNK_CTRL_RX_0 | 358646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_RX_1 | 359646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord EDMA_ERR_LNK_CTRL_RX_3 | 36085afb934575abdff1b2ac8ea4d522d1355f22a89Mark Lord EDMA_ERR_LNK_CTRL_TX, 361646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord 362bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_EH_FREEZE = EDMA_ERR_D_PAR | 363bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_PRD_PAR | 364bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_DEV_DCON | 365bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_DEV_CON | 366bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_SERR | 367bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_SELF_DIS | 3686c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_CRQB_PAR | 369bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_CRPB_PAR | 370bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_INTRL_PAR | 371bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_IORDY | 372bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_LNK_CTRL_RX_2 | 373bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_LNK_DATA_RX | 374bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_LNK_DATA_TX | 375bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_TRANS_PROTO, 376e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord 377bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_EH_FREEZE_5 = EDMA_ERR_D_PAR | 378bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_PRD_PAR | 379bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_DEV_DCON | 380bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_DEV_CON | 381bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_OVERRUN_5 | 382bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_UNDERRUN_5 | 383bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_SELF_DIS_5 | 3846c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_CRQB_PAR | 385bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_CRPB_PAR | 386bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_INTRL_PAR | 387bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_IORDY, 38820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 389cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_REQ_Q_BASE_HI = 0x10, 390cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_REQ_Q_IN_PTR = 0x14, /* also contains BASE_LO */ 39131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 392cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_REQ_Q_OUT_PTR = 0x18, 39331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ EDMA_REQ_Q_PTR_SHIFT = 5, 39431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 395cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_RSP_Q_BASE_HI = 0x1c, 396cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_RSP_Q_IN_PTR = 0x20, 397cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_RSP_Q_OUT_PTR = 0x24, /* also contains BASE_LO */ 39831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ EDMA_RSP_Q_PTR_SHIFT = 3, 39931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 400cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_CMD = 0x28, /* EDMA command register */ 4010ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik EDMA_EN = (1 << 0), /* enable EDMA */ 4020ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik EDMA_DS = (1 << 1), /* disable EDMA; self-negated */ 4038e7decdb8b132ee970a2636931b7653dec6af472Mark Lord EDMA_RESET = (1 << 2), /* reset eng/trans/link/phy */ 4048e7decdb8b132ee970a2636931b7653dec6af472Mark Lord 405cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_STATUS = 0x30, /* EDMA engine status */ 4068e7decdb8b132ee970a2636931b7653dec6af472Mark Lord EDMA_STATUS_CACHE_EMPTY = (1 << 6), /* GenIIe command cache empty */ 4078e7decdb8b132ee970a2636931b7653dec6af472Mark Lord EDMA_STATUS_IDLE = (1 << 7), /* GenIIe EDMA enabled/idle */ 40820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 409cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_IORDY_TMOUT = 0x34, 410cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_ARB_CFG = 0x38, 4118e7decdb8b132ee970a2636931b7653dec6af472Mark Lord 412cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_HALTCOND = 0x60, /* GenIIe halt conditions */ 413cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord EDMA_UNKNOWN_RSVD = 0x6C, /* GenIIe unknown/reserved */ 414da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 415cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord BMDMA_CMD = 0x224, /* bmdma command register */ 416cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord BMDMA_STATUS = 0x228, /* bmdma status register */ 417cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord BMDMA_PRD_LOW = 0x22c, /* bmdma PRD addr 31:0 */ 418cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord BMDMA_PRD_HIGH = 0x230, /* bmdma PRD addr 63:32 */ 419da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 42031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ /* Host private flags (hp_flags) */ 42131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ MV_HP_FLAG_MSI = (1 << 0), 42247c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik MV_HP_ERRATA_50XXB0 = (1 << 1), 42347c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik MV_HP_ERRATA_50XXB2 = (1 << 2), 42447c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik MV_HP_ERRATA_60X1B2 = (1 << 3), 42547c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik MV_HP_ERRATA_60X1C0 = (1 << 4), 4260ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik MV_HP_GEN_I = (1 << 6), /* Generation I: 50xx */ 4270ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik MV_HP_GEN_II = (1 << 7), /* Generation II: 60xx */ 4280ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik MV_HP_GEN_IIE = (1 << 8), /* Generation IIE: 6042/7042 */ 42902a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord MV_HP_PCIE = (1 << 9), /* PCIe bus/regs: 7042 */ 430616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord MV_HP_CUT_THROUGH = (1 << 10), /* can use EDMA cut-through */ 4311f39847255a02c69190ae30c33b8ccf4c10840dfMark Lord MV_HP_FLAG_SOC = (1 << 11), /* SystemOnChip, no PCI */ 432000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord MV_HP_QUIRK_LED_BLINK_EN = (1 << 12), /* is led blinking enabled? */ 43320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 43431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ /* Port private flags (pp_flags) */ 4350ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik MV_PP_FLAG_EDMA_EN = (1 << 0), /* is EDMA engine enabled? */ 436721091685f853ba4e6c49f26f989db0b1a811250Mark Lord MV_PP_FLAG_NCQ_EN = (1 << 1), /* is EDMA set up for NCQ? */ 43700f42eabb204c68fa64ef72de834e74aca15c81fMark Lord MV_PP_FLAG_FBS_EN = (1 << 2), /* is EDMA set up for FBS? */ 43829d187bb1e30682e228ce461c487d78d945c3e4fMark Lord MV_PP_FLAG_DELAYED_EH = (1 << 3), /* delayed dev err handling */ 439d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord MV_PP_FLAG_FAKE_ATA_BUSY = (1 << 4), /* ignore initial ATA_DRDY */ 44020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ}; 44120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 442ee9ccdf70163ca6408f6965e0fbc65baeac7312cJeff Garzik#define IS_GEN_I(hpriv) ((hpriv)->hp_flags & MV_HP_GEN_I) 443ee9ccdf70163ca6408f6965e0fbc65baeac7312cJeff Garzik#define IS_GEN_II(hpriv) ((hpriv)->hp_flags & MV_HP_GEN_II) 444e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik#define IS_GEN_IIE(hpriv) ((hpriv)->hp_flags & MV_HP_GEN_IIE) 4458e7decdb8b132ee970a2636931b7653dec6af472Mark Lord#define IS_PCIE(hpriv) ((hpriv)->hp_flags & MV_HP_PCIE) 4461f39847255a02c69190ae30c33b8ccf4c10840dfMark Lord#define IS_SOC(hpriv) ((hpriv)->hp_flags & MV_HP_FLAG_SOC) 447bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 44815a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek#define WINDOW_CTRL(i) (0x20030 + ((i) << 4)) 44915a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek#define WINDOW_BASE(i) (0x20034 + ((i) << 4)) 45015a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek 451095fec887eaa1c38d17c0c929a6733c744a9fa1fJeff Garzikenum { 452baf14aa14efcfdb5a74d5cf804691086c6bec743Jeff Garzik /* DMA boundary 0xffff is required by the s/g splitting 453baf14aa14efcfdb5a74d5cf804691086c6bec743Jeff Garzik * we need on /length/ in mv_fill-sg(). 454baf14aa14efcfdb5a74d5cf804691086c6bec743Jeff Garzik */ 455baf14aa14efcfdb5a74d5cf804691086c6bec743Jeff Garzik MV_DMA_BOUNDARY = 0xffffU, 456095fec887eaa1c38d17c0c929a6733c744a9fa1fJeff Garzik 4570ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik /* mask of register bits containing lower 32 bits 4580ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik * of EDMA request queue DMA address 4590ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik */ 460095fec887eaa1c38d17c0c929a6733c744a9fa1fJeff Garzik EDMA_REQ_Q_BASE_LO_MASK = 0xfffffc00U, 461095fec887eaa1c38d17c0c929a6733c744a9fa1fJeff Garzik 4620ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik /* ditto, for response queue */ 463095fec887eaa1c38d17c0c929a6733c744a9fa1fJeff Garzik EDMA_RSP_Q_BASE_LO_MASK = 0xffffff00U, 464095fec887eaa1c38d17c0c929a6733c744a9fa1fJeff Garzik}; 465095fec887eaa1c38d17c0c929a6733c744a9fa1fJeff Garzik 466522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzikenum chip_type { 467522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik chip_504x, 468522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik chip_508x, 469522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik chip_5080, 470522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik chip_604x, 471522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik chip_608x, 472e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik chip_6042, 473e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik chip_7042, 474f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara chip_soc, 475522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik}; 476522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik 47731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ/* Command ReQuest Block: 32B */ 47831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstruct mv_crqb { 479e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 sg_addr; 480e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 sg_addr_hi; 481e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le16 ctrl_flags; 482e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le16 ata_cmd[11]; 48331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ}; 48420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 485e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzikstruct mv_crqb_iie { 486e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 addr; 487e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 addr_hi; 488e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 flags; 489e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 len; 490e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 ata_cmd[4]; 491e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik}; 492e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 49331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ/* Command ResPonse Block: 8B */ 49431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstruct mv_crpb { 495e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le16 id; 496e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le16 flags; 497e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 tmstmp; 49820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ}; 49920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 50031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ/* EDMA Physical Region Descriptor (ePRD); A.K.A. SG */ 50131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstruct mv_sg { 502e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 addr; 503e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 flags_size; 504e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 addr_hi; 505e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le32 reserved; 50631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ}; 50720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 50808da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord/* 50908da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * We keep a local cache of a few frequently accessed port 51008da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * registers here, to avoid having to read them (very slow) 51108da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * when switching between EDMA and non-EDMA modes. 51208da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord */ 51308da175937a35d34a83eaefbb3458472eb1a89d4Mark Lordstruct mv_cached_regs { 51408da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord u32 fiscfg; 51508da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord u32 ltmode; 51608da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord u32 haltcond; 517c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord u32 unknown_rsvd; 51808da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord}; 51908da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord 52031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstruct mv_port_priv { 52131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ struct mv_crqb *crqb; 52231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ dma_addr_t crqb_dma; 52331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ struct mv_crpb *crpb; 52431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ dma_addr_t crpb_dma; 525eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord struct mv_sg *sg_tbl[MV_MAX_Q_DEPTH]; 526eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord dma_addr_t sg_tbl_dma[MV_MAX_Q_DEPTH]; 527bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 528bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik unsigned int req_idx; 529bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik unsigned int resp_idx; 530bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 53131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ u32 pp_flags; 53208da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord struct mv_cached_regs cached; 53329d187bb1e30682e228ce461c487d78d945c3e4fMark Lord unsigned int delayed_eh_pmp_map; 53431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ}; 53531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 536bca1c4eb9411533d613123618c0d127fae532595Jeff Garzikstruct mv_port_signal { 537bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik u32 amps; 538bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik u32 pre; 539bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik}; 540bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 54102a121da5a53d415b6596bc19cc6999d295d32a4Mark Lordstruct mv_host_priv { 54202a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord u32 hp_flags; 5431bfeff03f8a52eb896e5aad33d52e2451437bb0bSaeed Bishara unsigned int board_idx; 54496e2c487933e5f69e98fffdcae2c35c78a671c07Mark Lord u32 main_irq_mask; 54502a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord struct mv_port_signal signal[8]; 54602a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord const struct mv_hw_ops *ops; 547f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara int n_ports; 548f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *base; 5497368f91926a2870a8c3f9546d86535ce71ae0757Mark Lord void __iomem *main_irq_cause_addr; 5507368f91926a2870a8c3f9546d86535ce71ae0757Mark Lord void __iomem *main_irq_mask_addr; 551cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord u32 irq_cause_offset; 552cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord u32 irq_mask_offset; 55302a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord u32 unmask_all_irqs; 554c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara 555c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#if defined(CONFIG_HAVE_CLK) 556c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara struct clk *clk; 557c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#endif 558da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord /* 559da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord * These consistent DMA memory pools give us guaranteed 560da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord * alignment for hardware-accessed data structures, 561da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord * and less memory waste in accomplishing the alignment. 562da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord */ 563da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord struct dma_pool *crqb_pool; 564da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord struct dma_pool *crpb_pool; 565da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord struct dma_pool *sg_tbl_pool; 56602a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord}; 56702a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord 56847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstruct mv_hw_ops { 5692a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzik void (*phy_errata)(struct mv_host_priv *hpriv, void __iomem *mmio, 5702a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzik unsigned int port); 57147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik void (*enable_leds)(struct mv_host_priv *hpriv, void __iomem *mmio); 57247c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik void (*read_preamp)(struct mv_host_priv *hpriv, int idx, 57347c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik void __iomem *mmio); 574c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik int (*reset_hc)(struct mv_host_priv *hpriv, void __iomem *mmio, 575c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int n_hc); 576522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik void (*reset_flash)(struct mv_host_priv *hpriv, void __iomem *mmio); 5777bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara void (*reset_bus)(struct ata_host *host, void __iomem *mmio); 57847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik}; 57947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 58082ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heostatic int mv_scr_read(struct ata_link *link, unsigned int sc_reg_in, u32 *val); 58182ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heostatic int mv_scr_write(struct ata_link *link, unsigned int sc_reg_in, u32 val); 58282ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heostatic int mv5_scr_read(struct ata_link *link, unsigned int sc_reg_in, u32 *val); 58382ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heostatic int mv5_scr_write(struct ata_link *link, unsigned int sc_reg_in, u32 val); 58431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstatic int mv_port_start(struct ata_port *ap); 58531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstatic void mv_port_stop(struct ata_port *ap); 5863e4a139107e497a741c26f8a377a10f214d63ec1Mark Lordstatic int mv_qc_defer(struct ata_queued_cmd *qc); 58731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstatic void mv_qc_prep(struct ata_queued_cmd *qc); 588e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzikstatic void mv_qc_prep_iie(struct ata_queued_cmd *qc); 5899a3d9eb0177eb10500d49cd283b35576082a522dTejun Heostatic unsigned int mv_qc_issue(struct ata_queued_cmd *qc); 590a1efdaba2dbd6fb89e23a87b66d3f4dd92c9f5afTejun Heostatic int mv_hardreset(struct ata_link *link, unsigned int *class, 591a1efdaba2dbd6fb89e23a87b66d3f4dd92c9f5afTejun Heo unsigned long deadline); 592bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzikstatic void mv_eh_freeze(struct ata_port *ap); 593bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzikstatic void mv_eh_thaw(struct ata_port *ap); 594f273827e2aadcf2f74a7bdc9ad715a1b20ea7ddaMark Lordstatic void mv6_dev_config(struct ata_device *dev); 59520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 5962a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzikstatic void mv5_phy_errata(struct mv_host_priv *hpriv, void __iomem *mmio, 5972a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzik unsigned int port); 59847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstatic void mv5_enable_leds(struct mv_host_priv *hpriv, void __iomem *mmio); 59947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstatic void mv5_read_preamp(struct mv_host_priv *hpriv, int idx, 60047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik void __iomem *mmio); 601c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic int mv5_reset_hc(struct mv_host_priv *hpriv, void __iomem *mmio, 602c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int n_hc); 603522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzikstatic void mv5_reset_flash(struct mv_host_priv *hpriv, void __iomem *mmio); 6047bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bisharastatic void mv5_reset_bus(struct ata_host *host, void __iomem *mmio); 60547c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 6062a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzikstatic void mv6_phy_errata(struct mv_host_priv *hpriv, void __iomem *mmio, 6072a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzik unsigned int port); 60847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstatic void mv6_enable_leds(struct mv_host_priv *hpriv, void __iomem *mmio); 60947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstatic void mv6_read_preamp(struct mv_host_priv *hpriv, int idx, 61047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik void __iomem *mmio); 611c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic int mv6_reset_hc(struct mv_host_priv *hpriv, void __iomem *mmio, 612c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int n_hc); 613522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzikstatic void mv6_reset_flash(struct mv_host_priv *hpriv, void __iomem *mmio); 614f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic void mv_soc_enable_leds(struct mv_host_priv *hpriv, 615f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio); 616f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic void mv_soc_read_preamp(struct mv_host_priv *hpriv, int idx, 617f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio); 618f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic int mv_soc_reset_hc(struct mv_host_priv *hpriv, 619f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio, unsigned int n_hc); 620f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic void mv_soc_reset_flash(struct mv_host_priv *hpriv, 621f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio); 622f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic void mv_soc_reset_bus(struct ata_host *host, void __iomem *mmio); 62329b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayrstatic void mv_soc_65n_phy_errata(struct mv_host_priv *hpriv, 62429b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr void __iomem *mmio, unsigned int port); 6257bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bisharastatic void mv_reset_pci_bus(struct ata_host *host, void __iomem *mmio); 626e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lordstatic void mv_reset_channel(struct mv_host_priv *hpriv, void __iomem *mmio, 627c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int port_no); 628e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lordstatic int mv_stop_edma(struct ata_port *ap); 629b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lordstatic int mv_stop_edma_engine(void __iomem *port_mmio); 63000b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lordstatic void mv_edma_cfg(struct ata_port *ap, int want_ncq, int want_edma); 63147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 632e49856d82a887ce365637176f9f99ab68076eae8Mark Lordstatic void mv_pmp_select(struct ata_port *ap, int pmp); 633e49856d82a887ce365637176f9f99ab68076eae8Mark Lordstatic int mv_pmp_hardreset(struct ata_link *link, unsigned int *class, 634e49856d82a887ce365637176f9f99ab68076eae8Mark Lord unsigned long deadline); 635e49856d82a887ce365637176f9f99ab68076eae8Mark Lordstatic int mv_softreset(struct ata_link *link, unsigned int *class, 636e49856d82a887ce365637176f9f99ab68076eae8Mark Lord unsigned long deadline); 63729d187bb1e30682e228ce461c487d78d945c3e4fMark Lordstatic void mv_pmp_error_handler(struct ata_port *ap); 6384c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lordstatic void mv_process_crpb_entries(struct ata_port *ap, 6394c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord struct mv_port_priv *pp); 64047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 641da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic void mv_sff_irq_clear(struct ata_port *ap); 642da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic int mv_check_atapi_dma(struct ata_queued_cmd *qc); 643da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic void mv_bmdma_setup(struct ata_queued_cmd *qc); 644da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic void mv_bmdma_start(struct ata_queued_cmd *qc); 645da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic void mv_bmdma_stop(struct ata_queued_cmd *qc); 646da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic u8 mv_bmdma_status(struct ata_port *ap); 647d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lordstatic u8 mv_sff_check_status(struct ata_port *ap); 648da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 649eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord/* .sg_tablesize is (MV_MAX_SG_CT / 2) in the structures below 650eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord * because we have to allow room for worst case splitting of 651eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord * PRDs for 64K boundaries in mv_fill_sg(). 652eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord */ 653c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzikstatic struct scsi_host_template mv5_sht = { 65468d1d07b510bb57a504588adc2bd2758adea0965Tejun Heo ATA_BASE_SHT(DRV_NAME), 655baf14aa14efcfdb5a74d5cf804691086c6bec743Jeff Garzik .sg_tablesize = MV_MAX_SG_CT / 2, 656c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik .dma_boundary = MV_DMA_BOUNDARY, 657c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik}; 658c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik 659c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzikstatic struct scsi_host_template mv6_sht = { 66068d1d07b510bb57a504588adc2bd2758adea0965Tejun Heo ATA_NCQ_SHT(DRV_NAME), 661138bfdd03f2c08cc62b6af3900fb7be1c696315bMark Lord .can_queue = MV_MAX_Q_DEPTH - 1, 662baf14aa14efcfdb5a74d5cf804691086c6bec743Jeff Garzik .sg_tablesize = MV_MAX_SG_CT / 2, 66320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ .dma_boundary = MV_DMA_BOUNDARY, 66420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ}; 66520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 666029cfd6b74fc5c517865fad78cf4a3ea8d9b664aTejun Heostatic struct ata_port_operations mv5_ops = { 667029cfd6b74fc5c517865fad78cf4a3ea8d9b664aTejun Heo .inherits = &ata_sff_port_ops, 668c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 669c96f1732e25362d10ee7bcac1df8412a2e6b7d23Alan Cox .lost_interrupt = ATA_OP_NULL, 670c96f1732e25362d10ee7bcac1df8412a2e6b7d23Alan Cox 6713e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord .qc_defer = mv_qc_defer, 672c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .qc_prep = mv_qc_prep, 673c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .qc_issue = mv_qc_issue, 674c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 675bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik .freeze = mv_eh_freeze, 676bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik .thaw = mv_eh_thaw, 677a1efdaba2dbd6fb89e23a87b66d3f4dd92c9f5afTejun Heo .hardreset = mv_hardreset, 678a1efdaba2dbd6fb89e23a87b66d3f4dd92c9f5afTejun Heo .error_handler = ata_std_error_handler, /* avoid SFF EH */ 679029cfd6b74fc5c517865fad78cf4a3ea8d9b664aTejun Heo .post_internal_cmd = ATA_OP_NULL, 680bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 681c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .scr_read = mv5_scr_read, 682c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .scr_write = mv5_scr_write, 683c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 684c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .port_start = mv_port_start, 685c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .port_stop = mv_port_stop, 686c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik}; 687c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 688029cfd6b74fc5c517865fad78cf4a3ea8d9b664aTejun Heostatic struct ata_port_operations mv6_ops = { 689029cfd6b74fc5c517865fad78cf4a3ea8d9b664aTejun Heo .inherits = &mv5_ops, 690f273827e2aadcf2f74a7bdc9ad715a1b20ea7ddaMark Lord .dev_config = mv6_dev_config, 69120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ .scr_read = mv_scr_read, 69220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ .scr_write = mv_scr_write, 69320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 694e49856d82a887ce365637176f9f99ab68076eae8Mark Lord .pmp_hardreset = mv_pmp_hardreset, 695e49856d82a887ce365637176f9f99ab68076eae8Mark Lord .pmp_softreset = mv_softreset, 696e49856d82a887ce365637176f9f99ab68076eae8Mark Lord .softreset = mv_softreset, 69729d187bb1e30682e228ce461c487d78d945c3e4fMark Lord .error_handler = mv_pmp_error_handler, 698da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 69940f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord .sff_check_status = mv_sff_check_status, 700da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord .sff_irq_clear = mv_sff_irq_clear, 701da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord .check_atapi_dma = mv_check_atapi_dma, 702da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord .bmdma_setup = mv_bmdma_setup, 703da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord .bmdma_start = mv_bmdma_start, 704da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord .bmdma_stop = mv_bmdma_stop, 705da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord .bmdma_status = mv_bmdma_status, 70620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ}; 70720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 708029cfd6b74fc5c517865fad78cf4a3ea8d9b664aTejun Heostatic struct ata_port_operations mv_iie_ops = { 709029cfd6b74fc5c517865fad78cf4a3ea8d9b664aTejun Heo .inherits = &mv6_ops, 710029cfd6b74fc5c517865fad78cf4a3ea8d9b664aTejun Heo .dev_config = ATA_OP_NULL, 711e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik .qc_prep = mv_qc_prep_iie, 712e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik}; 713e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 71498ac62defe529d04a192688f40d801a2d8fbcf98Arjan van de Venstatic const struct ata_port_info mv_port_info[] = { 71520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ { /* chip_504x */ 71691b1a84c10869e2e46a576e5367de3166bff8eccMark Lord .flags = MV_GEN_I_FLAGS, 717c361acbc59c434315f8649ab06e5b7d5b297d1b7Mark Lord .pio_mask = ATA_PIO4, 718bf6263a853c9c143bf03f0a6fdcc68ab714fb5f5Jeff Garzik .udma_mask = ATA_UDMA6, 719c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .port_ops = &mv5_ops, 72020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ }, 72120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ { /* chip_508x */ 72291b1a84c10869e2e46a576e5367de3166bff8eccMark Lord .flags = MV_GEN_I_FLAGS | MV_FLAG_DUAL_HC, 723c361acbc59c434315f8649ab06e5b7d5b297d1b7Mark Lord .pio_mask = ATA_PIO4, 724bf6263a853c9c143bf03f0a6fdcc68ab714fb5f5Jeff Garzik .udma_mask = ATA_UDMA6, 725c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .port_ops = &mv5_ops, 72620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ }, 72747c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik { /* chip_5080 */ 72891b1a84c10869e2e46a576e5367de3166bff8eccMark Lord .flags = MV_GEN_I_FLAGS | MV_FLAG_DUAL_HC, 729c361acbc59c434315f8649ab06e5b7d5b297d1b7Mark Lord .pio_mask = ATA_PIO4, 730bf6263a853c9c143bf03f0a6fdcc68ab714fb5f5Jeff Garzik .udma_mask = ATA_UDMA6, 731c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .port_ops = &mv5_ops, 73247c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik }, 73320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ { /* chip_604x */ 73491b1a84c10869e2e46a576e5367de3166bff8eccMark Lord .flags = MV_GEN_II_FLAGS, 735c361acbc59c434315f8649ab06e5b7d5b297d1b7Mark Lord .pio_mask = ATA_PIO4, 736bf6263a853c9c143bf03f0a6fdcc68ab714fb5f5Jeff Garzik .udma_mask = ATA_UDMA6, 737c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .port_ops = &mv6_ops, 73820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ }, 73920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ { /* chip_608x */ 74091b1a84c10869e2e46a576e5367de3166bff8eccMark Lord .flags = MV_GEN_II_FLAGS | MV_FLAG_DUAL_HC, 741c361acbc59c434315f8649ab06e5b7d5b297d1b7Mark Lord .pio_mask = ATA_PIO4, 742bf6263a853c9c143bf03f0a6fdcc68ab714fb5f5Jeff Garzik .udma_mask = ATA_UDMA6, 743c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik .port_ops = &mv6_ops, 74420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ }, 745e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik { /* chip_6042 */ 74691b1a84c10869e2e46a576e5367de3166bff8eccMark Lord .flags = MV_GEN_IIE_FLAGS, 747c361acbc59c434315f8649ab06e5b7d5b297d1b7Mark Lord .pio_mask = ATA_PIO4, 748bf6263a853c9c143bf03f0a6fdcc68ab714fb5f5Jeff Garzik .udma_mask = ATA_UDMA6, 749e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik .port_ops = &mv_iie_ops, 750e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik }, 751e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik { /* chip_7042 */ 75291b1a84c10869e2e46a576e5367de3166bff8eccMark Lord .flags = MV_GEN_IIE_FLAGS, 753c361acbc59c434315f8649ab06e5b7d5b297d1b7Mark Lord .pio_mask = ATA_PIO4, 754bf6263a853c9c143bf03f0a6fdcc68ab714fb5f5Jeff Garzik .udma_mask = ATA_UDMA6, 755e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik .port_ops = &mv_iie_ops, 756e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik }, 757f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara { /* chip_soc */ 75891b1a84c10869e2e46a576e5367de3166bff8eccMark Lord .flags = MV_GEN_IIE_FLAGS, 759c361acbc59c434315f8649ab06e5b7d5b297d1b7Mark Lord .pio_mask = ATA_PIO4, 76017c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord .udma_mask = ATA_UDMA6, 76117c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord .port_ops = &mv_iie_ops, 762f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara }, 76320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ}; 76420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 7653b7d697dfb7d03edb87e50b743a7ecff029618e9Jeff Garzikstatic const struct pci_device_id mv_pci_tbl[] = { 7662d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { PCI_VDEVICE(MARVELL, 0x5040), chip_504x }, 7672d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { PCI_VDEVICE(MARVELL, 0x5041), chip_504x }, 7682d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { PCI_VDEVICE(MARVELL, 0x5080), chip_5080 }, 7692d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { PCI_VDEVICE(MARVELL, 0x5081), chip_508x }, 77046c5784c8fa736c2bb42fe681189b86e99abdc2eMark Lord /* RocketRAID 1720/174x have different identifiers */ 77146c5784c8fa736c2bb42fe681189b86e99abdc2eMark Lord { PCI_VDEVICE(TTI, 0x1720), chip_6042 }, 7724462254ac6be9150aae87d54d388fc348d6fceadMark Lord { PCI_VDEVICE(TTI, 0x1740), chip_6042 }, 7734462254ac6be9150aae87d54d388fc348d6fceadMark Lord { PCI_VDEVICE(TTI, 0x1742), chip_6042 }, 7742d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik 7752d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { PCI_VDEVICE(MARVELL, 0x6040), chip_604x }, 7762d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { PCI_VDEVICE(MARVELL, 0x6041), chip_604x }, 7772d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { PCI_VDEVICE(MARVELL, 0x6042), chip_6042 }, 7782d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { PCI_VDEVICE(MARVELL, 0x6080), chip_608x }, 7792d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { PCI_VDEVICE(MARVELL, 0x6081), chip_608x }, 7802d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik 7812d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { PCI_VDEVICE(ADAPTEC2, 0x0241), chip_604x }, 7822d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik 783d9f9c6bc91c14f53ffa782ffcd42259ecae1d38cFlorian Attenberger /* Adaptec 1430SA */ 784d9f9c6bc91c14f53ffa782ffcd42259ecae1d38cFlorian Attenberger { PCI_VDEVICE(ADAPTEC2, 0x0243), chip_7042 }, 785d9f9c6bc91c14f53ffa782ffcd42259ecae1d38cFlorian Attenberger 78602a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord /* Marvell 7042 support */ 7876a3d586d8e8a50e4cfd7f8c36d82a53c5614e05bMorrison, Tom { PCI_VDEVICE(MARVELL, 0x7042), chip_7042 }, 7886a3d586d8e8a50e4cfd7f8c36d82a53c5614e05bMorrison, Tom 78902a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord /* Highpoint RocketRAID PCIe series */ 79002a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord { PCI_VDEVICE(TTI, 0x2300), chip_7042 }, 79102a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord { PCI_VDEVICE(TTI, 0x2310), chip_7042 }, 79202a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord 7932d2744fc8be620a2dc469cf48349e3e704119f1bJeff Garzik { } /* terminate list */ 79420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ}; 79520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 79647c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstatic const struct mv_hw_ops mv5xxx_ops = { 79747c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik .phy_errata = mv5_phy_errata, 79847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik .enable_leds = mv5_enable_leds, 79947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik .read_preamp = mv5_read_preamp, 80047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik .reset_hc = mv5_reset_hc, 801522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik .reset_flash = mv5_reset_flash, 802522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik .reset_bus = mv5_reset_bus, 80347c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik}; 80447c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 80547c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstatic const struct mv_hw_ops mv6xxx_ops = { 80647c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik .phy_errata = mv6_phy_errata, 80747c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik .enable_leds = mv6_enable_leds, 80847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik .read_preamp = mv6_read_preamp, 80947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik .reset_hc = mv6_reset_hc, 810522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik .reset_flash = mv6_reset_flash, 811522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik .reset_bus = mv_reset_pci_bus, 81247c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik}; 81347c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 814f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic const struct mv_hw_ops mv_soc_ops = { 815f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .phy_errata = mv6_phy_errata, 816f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .enable_leds = mv_soc_enable_leds, 817f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .read_preamp = mv_soc_read_preamp, 818f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .reset_hc = mv_soc_reset_hc, 819f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .reset_flash = mv_soc_reset_flash, 820f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .reset_bus = mv_soc_reset_bus, 821f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara}; 822f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 82329b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayrstatic const struct mv_hw_ops mv_soc_65n_ops = { 82429b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr .phy_errata = mv_soc_65n_phy_errata, 82529b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr .enable_leds = mv_soc_enable_leds, 82629b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr .reset_hc = mv_soc_reset_hc, 82729b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr .reset_flash = mv_soc_reset_flash, 82829b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr .reset_bus = mv_soc_reset_bus, 82929b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr}; 83029b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr 83120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ/* 83220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ * Functions 83320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ */ 83420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 83520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russstatic inline void writelfl(unsigned long data, void __iomem *addr) 83620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 83720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ writel(data, addr); 83820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ (void) readl(addr); /* flush to avoid PCI posted write */ 83920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 84020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 841c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic inline unsigned int mv_hc_from_port(unsigned int port) 842c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik{ 843c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik return port >> MV_PORT_HC_SHIFT; 844c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik} 845c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 846c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic inline unsigned int mv_hardport_from_port(unsigned int port) 847c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik{ 848c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik return port & MV_PORT_MASK; 849c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik} 850c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 8511cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord/* 8521cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord * Consolidate some rather tricky bit shift calculations. 8531cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord * This is hot-path stuff, so not a function. 8541cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord * Simple code, with two return values, so macro rather than inline. 8551cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord * 8561cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord * port is the sole input, in range 0..7. 8577368f91926a2870a8c3f9546d86535ce71ae0757Mark Lord * shift is one output, for use with main_irq_cause / main_irq_mask registers. 8587368f91926a2870a8c3f9546d86535ce71ae0757Mark Lord * hardport is the other output, in range 0..3. 8591cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord * 8601cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord * Note that port and hardport may be the same variable in some cases. 8611cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord */ 8621cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord#define MV_PORT_TO_SHIFT_AND_HARDPORT(port, shift, hardport) \ 8631cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord{ \ 8641cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord shift = mv_hc_from_port(port) * HC_SHIFT; \ 8651cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord hardport = mv_hardport_from_port(port); \ 8661cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord shift += hardport * 2; \ 8671cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord} 8681cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord 869352fab701ca4753dd005b67ce5e512be944eb591Mark Lordstatic inline void __iomem *mv_hc_base(void __iomem *base, unsigned int hc) 870352fab701ca4753dd005b67ce5e512be944eb591Mark Lord{ 871cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord return (base + SATAHC0_REG_BASE + (hc * MV_SATAHC_REG_SZ)); 872352fab701ca4753dd005b67ce5e512be944eb591Mark Lord} 873352fab701ca4753dd005b67ce5e512be944eb591Mark Lord 874c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic inline void __iomem *mv_hc_base_from_port(void __iomem *base, 875c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int port) 876c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik{ 877c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik return mv_hc_base(base, mv_hc_from_port(port)); 878c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik} 879c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 88020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russstatic inline void __iomem *mv_port_base(void __iomem *base, unsigned int port) 88120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 882c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik return mv_hc_base_from_port(base, port) + 8838b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik MV_SATAHC_ARBTR_REG_SZ + 884c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik (mv_hardport_from_port(port) * MV_PORT_REG_SZ); 88520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 88620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 887e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lordstatic void __iomem *mv5_phy_base(void __iomem *mmio, unsigned int port) 888e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord{ 889e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord void __iomem *hc_mmio = mv_hc_base_from_port(mmio, port); 890e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord unsigned long ofs = (mv_hardport_from_port(port) + 1) * 0x100UL; 891e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord 892e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord return hc_mmio + ofs; 893e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord} 894e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord 895f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic inline void __iomem *mv_host_base(struct ata_host *host) 896f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara{ 897f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara struct mv_host_priv *hpriv = host->private_data; 898f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return hpriv->base; 899f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara} 900f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 90120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russstatic inline void __iomem *mv_ap_base(struct ata_port *ap) 90220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 903f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return mv_port_base(mv_host_base(ap->host), ap->port_no); 90420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 90520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 906cca3974e48607c3775dc73b544a5700b2e37c21aJeff Garzikstatic inline int mv_get_hc_count(unsigned long port_flags) 90731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 908cca3974e48607c3775dc73b544a5700b2e37c21aJeff Garzik return ((port_flags & MV_FLAG_DUAL_HC) ? 2 : 1); 90931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 91031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 91108da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord/** 91208da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * mv_save_cached_regs - (re-)initialize cached port registers 91308da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * @ap: the port whose registers we are caching 91408da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * 91508da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * Initialize the local cache of port registers, 91608da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * so that reading them over and over again can 91708da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * be avoided on the hotter paths of this driver. 91808da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * This saves a few microseconds each time we switch 91908da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * to/from EDMA mode to perform (eg.) a drive cache flush. 92008da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord */ 92108da175937a35d34a83eaefbb3458472eb1a89d4Mark Lordstatic void mv_save_cached_regs(struct ata_port *ap) 92208da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord{ 92308da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 92408da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord struct mv_port_priv *pp = ap->private_data; 92508da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord 926cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord pp->cached.fiscfg = readl(port_mmio + FISCFG); 927cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord pp->cached.ltmode = readl(port_mmio + LTMODE); 928cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord pp->cached.haltcond = readl(port_mmio + EDMA_HALTCOND); 929cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord pp->cached.unknown_rsvd = readl(port_mmio + EDMA_UNKNOWN_RSVD); 93008da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord} 93108da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord 93208da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord/** 93308da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * mv_write_cached_reg - write to a cached port register 93408da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * @addr: hardware address of the register 93508da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * @old: pointer to cached value of the register 93608da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * @new: new value for the register 93708da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * 93808da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * Write a new value to a cached register, 93908da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord * but only if the value is different from before. 94008da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord */ 94108da175937a35d34a83eaefbb3458472eb1a89d4Mark Lordstatic inline void mv_write_cached_reg(void __iomem *addr, u32 *old, u32 new) 94208da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord{ 94308da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord if (new != *old) { 94412f3b6d7551306c00cf834540a33184de67c9187Mark Lord unsigned long laddr; 94508da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord *old = new; 94612f3b6d7551306c00cf834540a33184de67c9187Mark Lord /* 94712f3b6d7551306c00cf834540a33184de67c9187Mark Lord * Workaround for 88SX60x1-B2 FEr SATA#13: 94812f3b6d7551306c00cf834540a33184de67c9187Mark Lord * Read-after-write is needed to prevent generating 64-bit 94912f3b6d7551306c00cf834540a33184de67c9187Mark Lord * write cycles on the PCI bus for SATA interface registers 95012f3b6d7551306c00cf834540a33184de67c9187Mark Lord * at offsets ending in 0x4 or 0xc. 95112f3b6d7551306c00cf834540a33184de67c9187Mark Lord * 95212f3b6d7551306c00cf834540a33184de67c9187Mark Lord * Looks like a lot of fuss, but it avoids an unnecessary 95312f3b6d7551306c00cf834540a33184de67c9187Mark Lord * +1 usec read-after-write delay for unaffected registers. 95412f3b6d7551306c00cf834540a33184de67c9187Mark Lord */ 95512f3b6d7551306c00cf834540a33184de67c9187Mark Lord laddr = (long)addr & 0xffff; 95612f3b6d7551306c00cf834540a33184de67c9187Mark Lord if (laddr >= 0x300 && laddr <= 0x33c) { 95712f3b6d7551306c00cf834540a33184de67c9187Mark Lord laddr &= 0x000f; 95812f3b6d7551306c00cf834540a33184de67c9187Mark Lord if (laddr == 0x4 || laddr == 0xc) { 95912f3b6d7551306c00cf834540a33184de67c9187Mark Lord writelfl(new, addr); /* read after write */ 96012f3b6d7551306c00cf834540a33184de67c9187Mark Lord return; 96112f3b6d7551306c00cf834540a33184de67c9187Mark Lord } 96212f3b6d7551306c00cf834540a33184de67c9187Mark Lord } 96312f3b6d7551306c00cf834540a33184de67c9187Mark Lord writel(new, addr); /* unaffected by the errata */ 96408da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord } 96508da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord} 96608da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord 967c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzikstatic void mv_set_edma_ptrs(void __iomem *port_mmio, 968c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik struct mv_host_priv *hpriv, 969c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik struct mv_port_priv *pp) 970c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik{ 971bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik u32 index; 972bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 973c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik /* 974c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik * initialize request queue 975c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik */ 976fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord pp->req_idx &= MV_MAX_Q_DEPTH_MASK; /* paranoia */ 977fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord index = pp->req_idx << EDMA_REQ_Q_PTR_SHIFT; 978bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 979c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik WARN_ON(pp->crqb_dma & 0x3ff); 980cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel((pp->crqb_dma >> 16) >> 16, port_mmio + EDMA_REQ_Q_BASE_HI); 981bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik writelfl((pp->crqb_dma & EDMA_REQ_Q_BASE_LO_MASK) | index, 982cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord port_mmio + EDMA_REQ_Q_IN_PTR); 983cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(index, port_mmio + EDMA_REQ_Q_OUT_PTR); 984c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik 985c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik /* 986c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik * initialize response queue 987c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik */ 988fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord pp->resp_idx &= MV_MAX_Q_DEPTH_MASK; /* paranoia */ 989fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord index = pp->resp_idx << EDMA_RSP_Q_PTR_SHIFT; 990bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 991c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik WARN_ON(pp->crpb_dma & 0xff); 992cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel((pp->crpb_dma >> 16) >> 16, port_mmio + EDMA_RSP_Q_BASE_HI); 993cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(index, port_mmio + EDMA_RSP_Q_IN_PTR); 994bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik writelfl((pp->crpb_dma & EDMA_RSP_Q_BASE_LO_MASK) | index, 995cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord port_mmio + EDMA_RSP_Q_OUT_PTR); 996c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik} 997c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik 9982b748a0a344847fe6b924407bbe153e1878c9f09Mark Lordstatic void mv_write_main_irq_mask(u32 mask, struct mv_host_priv *hpriv) 9992b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord{ 10002b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* 10012b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * When writing to the main_irq_mask in hardware, 10022b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * we must ensure exclusivity between the interrupt coalescing bits 10032b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * and the corresponding individual port DONE_IRQ bits. 10042b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * 10052b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * Note that this register is really an "IRQ enable" register, 10062b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * not an "IRQ mask" register as Marvell's naming might suggest. 10072b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord */ 10082b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord if (mask & (ALL_PORTS_COAL_DONE | PORTS_0_3_COAL_DONE)) 10092b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord mask &= ~DONE_IRQ_0_3; 10102b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord if (mask & (ALL_PORTS_COAL_DONE | PORTS_4_7_COAL_DONE)) 10112b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord mask &= ~DONE_IRQ_4_7; 10122b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord writelfl(mask, hpriv->main_irq_mask_addr); 10132b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord} 10142b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 1015c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lordstatic void mv_set_main_irq_mask(struct ata_host *host, 1016c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord u32 disable_bits, u32 enable_bits) 1017c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord{ 1018c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord struct mv_host_priv *hpriv = host->private_data; 1019c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord u32 old_mask, new_mask; 1020c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord 102196e2c487933e5f69e98fffdcae2c35c78a671c07Mark Lord old_mask = hpriv->main_irq_mask; 1022c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord new_mask = (old_mask & ~disable_bits) | enable_bits; 102396e2c487933e5f69e98fffdcae2c35c78a671c07Mark Lord if (new_mask != old_mask) { 102496e2c487933e5f69e98fffdcae2c35c78a671c07Mark Lord hpriv->main_irq_mask = new_mask; 10252b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord mv_write_main_irq_mask(new_mask, hpriv); 102696e2c487933e5f69e98fffdcae2c35c78a671c07Mark Lord } 1027c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord} 1028c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord 1029c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lordstatic void mv_enable_port_irqs(struct ata_port *ap, 1030c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord unsigned int port_bits) 1031c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord{ 1032c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord unsigned int shift, hardport, port = ap->port_no; 1033c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord u32 disable_bits, enable_bits; 1034c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord 1035c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord MV_PORT_TO_SHIFT_AND_HARDPORT(port, shift, hardport); 1036c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord 1037c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord disable_bits = (DONE_IRQ | ERR_IRQ) << shift; 1038c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord enable_bits = port_bits << shift; 1039c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord mv_set_main_irq_mask(ap->host, disable_bits, enable_bits); 1040c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord} 1041c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord 104200b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lordstatic void mv_clear_and_enable_port_irqs(struct ata_port *ap, 104300b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord void __iomem *port_mmio, 104400b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord unsigned int port_irqs) 104500b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord{ 104600b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord struct mv_host_priv *hpriv = ap->host->private_data; 104700b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord int hardport = mv_hardport_from_port(ap->port_no); 104800b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord void __iomem *hc_mmio = mv_hc_base_from_port( 104900b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord mv_host_base(ap->host), ap->port_no); 105000b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord u32 hc_irq_cause; 105100b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord 105200b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord /* clear EDMA event indicators, if any */ 1053cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(0, port_mmio + EDMA_ERR_IRQ_CAUSE); 105400b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord 105500b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord /* clear pending irq events */ 105600b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord hc_irq_cause = ~((DEV_IRQ | DMA_IRQ) << hardport); 1057cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(hc_irq_cause, hc_mmio + HC_IRQ_CAUSE); 105800b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord 105900b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord /* clear FIS IRQ Cause */ 106000b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord if (IS_GEN_IIE(hpriv)) 1061cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(0, port_mmio + FIS_IRQ_CAUSE); 106200b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord 106300b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord mv_enable_port_irqs(ap, port_irqs); 106400b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord} 106500b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord 10662b748a0a344847fe6b924407bbe153e1878c9f09Mark Lordstatic void mv_set_irq_coalescing(struct ata_host *host, 10672b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord unsigned int count, unsigned int usecs) 10682b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord{ 10692b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord struct mv_host_priv *hpriv = host->private_data; 10702b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord void __iomem *mmio = hpriv->base, *hc_mmio; 10712b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord u32 coal_enable = 0; 10722b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord unsigned long flags; 10736abf4678261218938ccdac90767d34ce9937634fMark Lord unsigned int clks, is_dual_hc = hpriv->n_ports > MV_PORTS_PER_HC; 10742b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord const u32 coal_disable = PORTS_0_3_COAL_DONE | PORTS_4_7_COAL_DONE | 10752b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord ALL_PORTS_COAL_DONE; 10762b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 10772b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* Disable IRQ coalescing if either threshold is zero */ 10782b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord if (!usecs || !count) { 10792b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord clks = count = 0; 10802b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord } else { 10812b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* Respect maximum limits of the hardware */ 10822b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord clks = usecs * COAL_CLOCKS_PER_USEC; 10832b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord if (clks > MAX_COAL_TIME_THRESHOLD) 10842b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord clks = MAX_COAL_TIME_THRESHOLD; 10852b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord if (count > MAX_COAL_IO_COUNT) 10862b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord count = MAX_COAL_IO_COUNT; 10872b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord } 10882b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 10892b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord spin_lock_irqsave(&host->lock, flags); 10906abf4678261218938ccdac90767d34ce9937634fMark Lord mv_set_main_irq_mask(host, coal_disable, 0); 10912b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 10926abf4678261218938ccdac90767d34ce9937634fMark Lord if (is_dual_hc && !IS_GEN_I(hpriv)) { 10932b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* 10946abf4678261218938ccdac90767d34ce9937634fMark Lord * GEN_II/GEN_IIE with dual host controllers: 10956abf4678261218938ccdac90767d34ce9937634fMark Lord * one set of global thresholds for the entire chip. 10962b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord */ 1097cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(clks, mmio + IRQ_COAL_TIME_THRESHOLD); 1098cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(count, mmio + IRQ_COAL_IO_THRESHOLD); 10992b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* clear leftover coal IRQ bit */ 1100cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(~ALL_PORTS_COAL_IRQ, mmio + IRQ_COAL_CAUSE); 11016abf4678261218938ccdac90767d34ce9937634fMark Lord if (count) 11026abf4678261218938ccdac90767d34ce9937634fMark Lord coal_enable = ALL_PORTS_COAL_DONE; 11036abf4678261218938ccdac90767d34ce9937634fMark Lord clks = count = 0; /* force clearing of regular regs below */ 11042b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord } 11056abf4678261218938ccdac90767d34ce9937634fMark Lord 11062b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* 11072b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord * All chips: independent thresholds for each HC on the chip. 11082b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord */ 11092b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord hc_mmio = mv_hc_base_from_port(mmio, 0); 1110cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(clks, hc_mmio + HC_IRQ_COAL_TIME_THRESHOLD); 1111cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(count, hc_mmio + HC_IRQ_COAL_IO_THRESHOLD); 1112cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(~HC_COAL_IRQ, hc_mmio + HC_IRQ_CAUSE); 11136abf4678261218938ccdac90767d34ce9937634fMark Lord if (count) 11146abf4678261218938ccdac90767d34ce9937634fMark Lord coal_enable |= PORTS_0_3_COAL_DONE; 11156abf4678261218938ccdac90767d34ce9937634fMark Lord if (is_dual_hc) { 11162b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord hc_mmio = mv_hc_base_from_port(mmio, MV_PORTS_PER_HC); 1117cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(clks, hc_mmio + HC_IRQ_COAL_TIME_THRESHOLD); 1118cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(count, hc_mmio + HC_IRQ_COAL_IO_THRESHOLD); 1119cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(~HC_COAL_IRQ, hc_mmio + HC_IRQ_CAUSE); 11206abf4678261218938ccdac90767d34ce9937634fMark Lord if (count) 11216abf4678261218938ccdac90767d34ce9937634fMark Lord coal_enable |= PORTS_4_7_COAL_DONE; 11222b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord } 11232b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 11246abf4678261218938ccdac90767d34ce9937634fMark Lord mv_set_main_irq_mask(host, 0, coal_enable); 11252b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord spin_unlock_irqrestore(&host->lock, flags); 11262b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord} 11272b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 112805b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 112900b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord * mv_start_edma - Enable eDMA engine 113005b308e1df6d9d673daedb517969241f41278b52Brett Russ * @base: port base address 113105b308e1df6d9d673daedb517969241f41278b52Brett Russ * @pp: port private data 113205b308e1df6d9d673daedb517969241f41278b52Brett Russ * 1133beec7dbc6ff003bbc94de62b3323519c878fb2acTejun Heo * Verify the local cache of the eDMA state is accurate with a 1134beec7dbc6ff003bbc94de62b3323519c878fb2acTejun Heo * WARN_ON. 113505b308e1df6d9d673daedb517969241f41278b52Brett Russ * 113605b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 113705b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 113805b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 113900b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lordstatic void mv_start_edma(struct ata_port *ap, void __iomem *port_mmio, 1140721091685f853ba4e6c49f26f989db0b1a811250Mark Lord struct mv_port_priv *pp, u8 protocol) 114120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 1142721091685f853ba4e6c49f26f989db0b1a811250Mark Lord int want_ncq = (protocol == ATA_PROT_NCQ); 1143721091685f853ba4e6c49f26f989db0b1a811250Mark Lord 1144721091685f853ba4e6c49f26f989db0b1a811250Mark Lord if (pp->pp_flags & MV_PP_FLAG_EDMA_EN) { 1145721091685f853ba4e6c49f26f989db0b1a811250Mark Lord int using_ncq = ((pp->pp_flags & MV_PP_FLAG_NCQ_EN) != 0); 1146721091685f853ba4e6c49f26f989db0b1a811250Mark Lord if (want_ncq != using_ncq) 1147b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord mv_stop_edma(ap); 1148721091685f853ba4e6c49f26f989db0b1a811250Mark Lord } 1149c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik if (!(pp->pp_flags & MV_PP_FLAG_EDMA_EN)) { 11500c58912e192fc3a4835d772aafa40b72552b819fMark Lord struct mv_host_priv *hpriv = ap->host->private_data; 11510c58912e192fc3a4835d772aafa40b72552b819fMark Lord 115200b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord mv_edma_cfg(ap, want_ncq, 1); 11530c58912e192fc3a4835d772aafa40b72552b819fMark Lord 1154f630d562829fcd8160a118f98c1e5b9cdb4e703eMark Lord mv_set_edma_ptrs(port_mmio, hpriv, pp); 115500b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord mv_clear_and_enable_port_irqs(ap, port_mmio, DONE_IRQ|ERR_IRQ); 1156bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 1157cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(EDMA_EN, port_mmio + EDMA_CMD); 1158afb0edd922c7ed6e73678730921dfcccebec17e8Brett Russ pp->pp_flags |= MV_PP_FLAG_EDMA_EN; 1159afb0edd922c7ed6e73678730921dfcccebec17e8Brett Russ } 116020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 116120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 11629b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lordstatic void mv_wait_for_edma_empty_idle(struct ata_port *ap) 11639b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord{ 11649b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 11659b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord const u32 empty_idle = (EDMA_STATUS_CACHE_EMPTY | EDMA_STATUS_IDLE); 11669b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord const int per_loop = 5, timeout = (15 * 1000 / per_loop); 11679b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord int i; 11689b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord 11699b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord /* 11709b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord * Wait for the EDMA engine to finish transactions in progress. 1171c46938ccfe35a58a0873715ee4c26fc9eb8d87b3Mark Lord * No idea what a good "timeout" value might be, but measurements 1172c46938ccfe35a58a0873715ee4c26fc9eb8d87b3Mark Lord * indicate that it often requires hundreds of microseconds 1173c46938ccfe35a58a0873715ee4c26fc9eb8d87b3Mark Lord * with two drives in-use. So we use the 15msec value above 1174c46938ccfe35a58a0873715ee4c26fc9eb8d87b3Mark Lord * as a rough guess at what even more drives might require. 11759b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord */ 11769b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord for (i = 0; i < timeout; ++i) { 1177cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord u32 edma_stat = readl(port_mmio + EDMA_STATUS); 11789b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord if ((edma_stat & empty_idle) == empty_idle) 11799b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord break; 11809b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord udelay(per_loop); 11819b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord } 11829b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord /* ata_port_printk(ap, KERN_INFO, "%s: %u+ usecs\n", __func__, i); */ 11839b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord} 11849b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord 118505b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 1186e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord * mv_stop_edma_engine - Disable eDMA engine 1187b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord * @port_mmio: io base address 118805b308e1df6d9d673daedb517969241f41278b52Brett Russ * 118905b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 119005b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 119105b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 1192b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lordstatic int mv_stop_edma_engine(void __iomem *port_mmio) 119320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 1194b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord int i; 119531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 1196b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord /* Disable eDMA. The disable bit auto clears. */ 1197cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(EDMA_DS, port_mmio + EDMA_CMD); 11988b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik 1199b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord /* Wait for the chip to confirm eDMA is off. */ 1200b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord for (i = 10000; i > 0; i--) { 1201cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord u32 reg = readl(port_mmio + EDMA_CMD); 12024537deb5e90b717a725b3d74b58b4bb1d28443d0Jeff Garzik if (!(reg & EDMA_EN)) 1203b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord return 0; 1204b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord udelay(10); 120531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 1206b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord return -EIO; 120720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 120820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 1209e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lordstatic int mv_stop_edma(struct ata_port *ap) 12100ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik{ 1211b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord void __iomem *port_mmio = mv_ap_base(ap); 1212b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord struct mv_port_priv *pp = ap->private_data; 121366e57a2cb0c538d4f84a7233c224735fe1eaa672Mark Lord int err = 0; 12140ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik 1215b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord if (!(pp->pp_flags & MV_PP_FLAG_EDMA_EN)) 1216b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord return 0; 1217b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord pp->pp_flags &= ~MV_PP_FLAG_EDMA_EN; 12189b2c4e0bae854fb5e88c9cacc0dacf21631c5cb0Mark Lord mv_wait_for_edma_empty_idle(ap); 1219b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord if (mv_stop_edma_engine(port_mmio)) { 1220b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord ata_port_printk(ap, KERN_ERR, "Unable to stop eDMA\n"); 122166e57a2cb0c538d4f84a7233c224735fe1eaa672Mark Lord err = -EIO; 1222b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord } 122366e57a2cb0c538d4f84a7233c224735fe1eaa672Mark Lord mv_edma_cfg(ap, 0, 0); 122466e57a2cb0c538d4f84a7233c224735fe1eaa672Mark Lord return err; 12250ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik} 12260ea9e179f436f153fc19fdaef7abbc1e0da20762Jeff Garzik 12278a70f8dc08dd40b7f8ac77280eaa99a8c6bc46f4Jeff Garzik#ifdef ATA_DEBUG 122831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstatic void mv_dump_mem(void __iomem *start, unsigned bytes) 122920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 123031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ int b, w; 123131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ for (b = 0; b < bytes; ) { 123231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ DPRINTK("%p: ", start + b); 123331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ for (w = 0; b < bytes && w < 4; w++) { 12342dcb407e61458ded17503d6bd12b8c064965368bJeff Garzik printk("%08x ", readl(start + b)); 123531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ b += sizeof(u32); 123631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 123731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ printk("\n"); 123831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 123931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 12408a70f8dc08dd40b7f8ac77280eaa99a8c6bc46f4Jeff Garzik#endif 12418a70f8dc08dd40b7f8ac77280eaa99a8c6bc46f4Jeff Garzik 124231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstatic void mv_dump_pci_cfg(struct pci_dev *pdev, unsigned bytes) 124331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 124431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ#ifdef ATA_DEBUG 124531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ int b, w; 124631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ u32 dw; 124731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ for (b = 0; b < bytes; ) { 124831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ DPRINTK("%02x: ", b); 124931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ for (w = 0; b < bytes && w < 4; w++) { 12502dcb407e61458ded17503d6bd12b8c064965368bJeff Garzik (void) pci_read_config_dword(pdev, b, &dw); 12512dcb407e61458ded17503d6bd12b8c064965368bJeff Garzik printk("%08x ", dw); 125231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ b += sizeof(u32); 125331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 125431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ printk("\n"); 125531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 125631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ#endif 125731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 125831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstatic void mv_dump_all_regs(void __iomem *mmio_base, int port, 125931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ struct pci_dev *pdev) 126031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 126131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ#ifdef ATA_DEBUG 12628b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik void __iomem *hc_base = mv_hc_base(mmio_base, 126331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ port >> MV_PORT_HC_SHIFT); 126431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ void __iomem *port_base; 126531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ int start_port, num_ports, p, start_hc, num_hcs, hc; 126631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 126731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ if (0 > port) { 126831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ start_hc = start_port = 0; 126931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ num_ports = 8; /* shld be benign for 4 port devs */ 127031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ num_hcs = 2; 127131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } else { 127231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ start_hc = port >> MV_PORT_HC_SHIFT; 127331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ start_port = port; 127431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ num_ports = num_hcs = 1; 127531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 12768b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik DPRINTK("All registers for port(s) %u-%u:\n", start_port, 127731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ num_ports > 1 ? num_ports - 1 : start_port); 127831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 127931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ if (NULL != pdev) { 128031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ DPRINTK("PCI config space regs:\n"); 128131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_dump_pci_cfg(pdev, 0x68); 128231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 128331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ DPRINTK("PCI regs:\n"); 128431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_dump_mem(mmio_base+0xc00, 0x3c); 128531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_dump_mem(mmio_base+0xd00, 0x34); 128631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_dump_mem(mmio_base+0xf00, 0x4); 128731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_dump_mem(mmio_base+0x1d00, 0x6c); 128831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ for (hc = start_hc; hc < start_hc + num_hcs; hc++) { 1289d220c37e0a3c9a47ae00e87e044d963b3ea040bcDan Aloni hc_base = mv_hc_base(mmio_base, hc); 129031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ DPRINTK("HC regs (HC %i):\n", hc); 129131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_dump_mem(hc_base, 0x1c); 129231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 129331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ for (p = start_port; p < start_port + num_ports; p++) { 129431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ port_base = mv_port_base(mmio_base, p); 12952dcb407e61458ded17503d6bd12b8c064965368bJeff Garzik DPRINTK("EDMA regs (port %i):\n", p); 129631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_dump_mem(port_base, 0x54); 12972dcb407e61458ded17503d6bd12b8c064965368bJeff Garzik DPRINTK("SATA regs (port %i):\n", p); 129831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_dump_mem(port_base+0x300, 0x60); 129931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 130031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ#endif 130120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 130220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 130320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russstatic unsigned int mv_scr_offset(unsigned int sc_reg_in) 130420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 130520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ unsigned int ofs; 130620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 130720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ switch (sc_reg_in) { 130820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ case SCR_STATUS: 130920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ case SCR_CONTROL: 131020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ case SCR_ERROR: 1311cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord ofs = SATA_STATUS + (sc_reg_in * sizeof(u32)); 131220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ break; 131320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ case SCR_ACTIVE: 1314cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord ofs = SATA_ACTIVE; /* active is not with the others */ 131520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ break; 131620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ default: 131720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ ofs = 0xffffffffU; 131820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ break; 131920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ } 132020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ return ofs; 132120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 132220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 132382ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heostatic int mv_scr_read(struct ata_link *link, unsigned int sc_reg_in, u32 *val) 132420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 132520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ unsigned int ofs = mv_scr_offset(sc_reg_in); 132620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 1327da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo if (ofs != 0xffffffffU) { 132882ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heo *val = readl(mv_ap_base(link->ap) + ofs); 1329da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo return 0; 1330da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo } else 1331da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo return -EINVAL; 133220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 133320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 133482ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heostatic int mv_scr_write(struct ata_link *link, unsigned int sc_reg_in, u32 val) 133520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 133620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ unsigned int ofs = mv_scr_offset(sc_reg_in); 133720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 1338da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo if (ofs != 0xffffffffU) { 13392009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord void __iomem *addr = mv_ap_base(link->ap) + ofs; 13402009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord if (sc_reg_in == SCR_CONTROL) { 13412009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord /* 13422009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * Workaround for 88SX60x1 FEr SATA#26: 13432009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * 13442009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * COMRESETs have to take care not to accidently 13452009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * put the drive to sleep when writing SCR_CONTROL. 13462009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * Setting bits 12..15 prevents this problem. 13472009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * 13482009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * So if we see an outbound COMMRESET, set those bits. 13492009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * Ditto for the followup write that clears the reset. 13502009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * 13512009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * The proprietary driver does this for 13522009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord * all chip versions, and so do we. 13532009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord */ 13542009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord if ((val & 0xf) == 1 || (readl(addr) & 0xf) == 1) 13552009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord val |= 0xf000; 13562009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord } 13572009177329ae565d9e9efd31b399d2f4ed4f0c44Mark Lord writelfl(val, addr); 1358da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo return 0; 1359da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo } else 1360da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo return -EINVAL; 136120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 136220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 1363f273827e2aadcf2f74a7bdc9ad715a1b20ea7ddaMark Lordstatic void mv6_dev_config(struct ata_device *adev) 1364f273827e2aadcf2f74a7bdc9ad715a1b20ea7ddaMark Lord{ 1365f273827e2aadcf2f74a7bdc9ad715a1b20ea7ddaMark Lord /* 1366e49856d82a887ce365637176f9f99ab68076eae8Mark Lord * Deal with Gen-II ("mv6") hardware quirks/restrictions: 1367e49856d82a887ce365637176f9f99ab68076eae8Mark Lord * 1368e49856d82a887ce365637176f9f99ab68076eae8Mark Lord * Gen-II does not support NCQ over a port multiplier 1369e49856d82a887ce365637176f9f99ab68076eae8Mark Lord * (no FIS-based switching). 1370f273827e2aadcf2f74a7bdc9ad715a1b20ea7ddaMark Lord */ 1371e49856d82a887ce365637176f9f99ab68076eae8Mark Lord if (adev->flags & ATA_DFLAG_NCQ) { 1372352fab701ca4753dd005b67ce5e512be944eb591Mark Lord if (sata_pmp_attached(adev->link->ap)) { 1373e49856d82a887ce365637176f9f99ab68076eae8Mark Lord adev->flags &= ~ATA_DFLAG_NCQ; 1374352fab701ca4753dd005b67ce5e512be944eb591Mark Lord ata_dev_printk(adev, KERN_INFO, 1375352fab701ca4753dd005b67ce5e512be944eb591Mark Lord "NCQ disabled for command-based switching\n"); 1376352fab701ca4753dd005b67ce5e512be944eb591Mark Lord } 1377e49856d82a887ce365637176f9f99ab68076eae8Mark Lord } 1378f273827e2aadcf2f74a7bdc9ad715a1b20ea7ddaMark Lord} 1379f273827e2aadcf2f74a7bdc9ad715a1b20ea7ddaMark Lord 13803e4a139107e497a741c26f8a377a10f214d63ec1Mark Lordstatic int mv_qc_defer(struct ata_queued_cmd *qc) 13813e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord{ 13823e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord struct ata_link *link = qc->dev->link; 13833e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord struct ata_port *ap = link->ap; 13843e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord struct mv_port_priv *pp = ap->private_data; 13853e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord 13863e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord /* 138729d187bb1e30682e228ce461c487d78d945c3e4fMark Lord * Don't allow new commands if we're in a delayed EH state 138829d187bb1e30682e228ce461c487d78d945c3e4fMark Lord * for NCQ and/or FIS-based switching. 138929d187bb1e30682e228ce461c487d78d945c3e4fMark Lord */ 139029d187bb1e30682e228ce461c487d78d945c3e4fMark Lord if (pp->pp_flags & MV_PP_FLAG_DELAYED_EH) 139129d187bb1e30682e228ce461c487d78d945c3e4fMark Lord return ATA_DEFER_PORT; 1392159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou 1393159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou /* PIO commands need exclusive link: no other commands [DMA or PIO] 1394159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou * can run concurrently. 1395159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou * set excl_link when we want to send a PIO command in DMA mode 1396159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou * or a non-NCQ command in NCQ mode. 1397159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou * When we receive a command from that link, and there are no 1398159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou * outstanding commands, mark a flag to clear excl_link and let 1399159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou * the command go through. 1400159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou */ 1401159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou if (unlikely(ap->excl_link)) { 1402159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou if (link == ap->excl_link) { 1403159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou if (ap->nr_active_links) 1404159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou return ATA_DEFER_PORT; 1405159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou qc->flags |= ATA_QCFLAG_CLEAR_EXCL; 1406159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou return 0; 1407159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou } else 1408159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou return ATA_DEFER_PORT; 1409159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou } 1410159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou 141129d187bb1e30682e228ce461c487d78d945c3e4fMark Lord /* 14123e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord * If the port is completely idle, then allow the new qc. 14133e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord */ 14143e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord if (ap->nr_active_links == 0) 14153e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord return 0; 14163e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord 14174bdee6c5103696a2729d3db2f235d202191788e4Tejun Heo /* 14184bdee6c5103696a2729d3db2f235d202191788e4Tejun Heo * The port is operating in host queuing mode (EDMA) with NCQ 14194bdee6c5103696a2729d3db2f235d202191788e4Tejun Heo * enabled, allow multiple NCQ commands. EDMA also allows 14204bdee6c5103696a2729d3db2f235d202191788e4Tejun Heo * queueing multiple DMA commands but libata core currently 14214bdee6c5103696a2729d3db2f235d202191788e4Tejun Heo * doesn't allow it. 14224bdee6c5103696a2729d3db2f235d202191788e4Tejun Heo */ 14234bdee6c5103696a2729d3db2f235d202191788e4Tejun Heo if ((pp->pp_flags & MV_PP_FLAG_EDMA_EN) && 1424159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou (pp->pp_flags & MV_PP_FLAG_NCQ_EN)) { 1425159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou if (ata_is_ncq(qc->tf.protocol)) 1426159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou return 0; 1427159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou else { 1428159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou ap->excl_link = link; 1429159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou return ATA_DEFER_PORT; 1430159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou } 1431159a7ff7a13f9a02c75006f40c0561a3a81aefcdGwendal Grignou } 14324bdee6c5103696a2729d3db2f235d202191788e4Tejun Heo 14333e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord return ATA_DEFER_PORT; 14343e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord} 14353e4a139107e497a741c26f8a377a10f214d63ec1Mark Lord 143608da175937a35d34a83eaefbb3458472eb1a89d4Mark Lordstatic void mv_config_fbs(struct ata_port *ap, int want_ncq, int want_fbs) 1437e49856d82a887ce365637176f9f99ab68076eae8Mark Lord{ 143808da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord struct mv_port_priv *pp = ap->private_data; 143908da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord void __iomem *port_mmio; 144000f42eabb204c68fa64ef72de834e74aca15c81fMark Lord 144108da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord u32 fiscfg, *old_fiscfg = &pp->cached.fiscfg; 144208da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord u32 ltmode, *old_ltmode = &pp->cached.ltmode; 144308da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord u32 haltcond, *old_haltcond = &pp->cached.haltcond; 144400f42eabb204c68fa64ef72de834e74aca15c81fMark Lord 144508da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord ltmode = *old_ltmode & ~LTMODE_BIT8; 144608da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord haltcond = *old_haltcond | EDMA_ERR_DEV; 144700f42eabb204c68fa64ef72de834e74aca15c81fMark Lord 144800f42eabb204c68fa64ef72de834e74aca15c81fMark Lord if (want_fbs) { 144908da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord fiscfg = *old_fiscfg | FISCFG_SINGLE_SYNC; 145008da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord ltmode = *old_ltmode | LTMODE_BIT8; 14514c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (want_ncq) 145208da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord haltcond &= ~EDMA_ERR_DEV; 14534c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord else 145408da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord fiscfg |= FISCFG_WAIT_DEV_ERR; 145508da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord } else { 145608da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord fiscfg = *old_fiscfg & ~(FISCFG_SINGLE_SYNC | FISCFG_WAIT_DEV_ERR); 1457e49856d82a887ce365637176f9f99ab68076eae8Mark Lord } 145800f42eabb204c68fa64ef72de834e74aca15c81fMark Lord 145908da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord port_mmio = mv_ap_base(ap); 1460cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord mv_write_cached_reg(port_mmio + FISCFG, old_fiscfg, fiscfg); 1461cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord mv_write_cached_reg(port_mmio + LTMODE, old_ltmode, ltmode); 1462cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord mv_write_cached_reg(port_mmio + EDMA_HALTCOND, old_haltcond, haltcond); 1463f273827e2aadcf2f74a7bdc9ad715a1b20ea7ddaMark Lord} 1464f273827e2aadcf2f74a7bdc9ad715a1b20ea7ddaMark Lord 1465dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lordstatic void mv_60x1_errata_sata25(struct ata_port *ap, int want_ncq) 1466dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord{ 1467dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord struct mv_host_priv *hpriv = ap->host->private_data; 1468dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord u32 old, new; 1469dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord 1470dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord /* workaround for 88SX60x1 FEr SATA#25 (part 1) */ 1471cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord old = readl(hpriv->base + GPIO_PORT_CTL); 1472dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord if (want_ncq) 1473dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord new = old | (1 << 22); 1474dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord else 1475dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord new = old & ~(1 << 22); 1476dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord if (new != old) 1477cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(new, hpriv->base + GPIO_PORT_CTL); 1478dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord} 1479dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord 1480c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord/** 148140f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord * mv_bmdma_enable - set a magic bit on GEN_IIE to allow bmdma 148240f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord * @ap: Port being initialized 1483c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord * 1484c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord * There are two DMA modes on these chips: basic DMA, and EDMA. 1485c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord * 1486c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord * Bit-0 of the "EDMA RESERVED" register enables/disables use 1487c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord * of basic DMA on the GEN_IIE versions of the chips. 1488c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord * 1489c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord * This bit survives EDMA resets, and must be set for basic DMA 1490c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord * to function, and should be cleared when EDMA is active. 1491c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord */ 1492c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lordstatic void mv_bmdma_enable_iie(struct ata_port *ap, int enable_bmdma) 1493c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord{ 1494c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord struct mv_port_priv *pp = ap->private_data; 1495c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord u32 new, *old = &pp->cached.unknown_rsvd; 1496c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord 1497c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord if (enable_bmdma) 1498c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord new = *old | 1; 1499c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord else 1500c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord new = *old & ~1; 1501cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord mv_write_cached_reg(mv_ap_base(ap) + EDMA_UNKNOWN_RSVD, old, new); 1502c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord} 1503c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord 1504000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord/* 1505000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * SOC chips have an issue whereby the HDD LEDs don't always blink 1506000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * during I/O when NCQ is enabled. Enabling a special "LED blink" mode 1507000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * of the SOC takes care of it, generating a steady blink rate when 1508000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * any drive on the chip is active. 1509000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * 1510000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * Unfortunately, the blink mode is a global hardware setting for the SOC, 1511000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * so we must use it whenever at least one port on the SOC has NCQ enabled. 1512000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * 1513000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * We turn "LED blink" off when NCQ is not in use anywhere, because the normal 1514000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * LED operation works then, and provides better (more accurate) feedback. 1515000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * 1516000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord * Note that this code assumes that an SOC never has more than one HC onboard. 1517000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord */ 1518000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lordstatic void mv_soc_led_blink_enable(struct ata_port *ap) 1519000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord{ 1520000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord struct ata_host *host = ap->host; 1521000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord struct mv_host_priv *hpriv = host->private_data; 1522000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord void __iomem *hc_mmio; 1523000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord u32 led_ctrl; 1524000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord 1525000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord if (hpriv->hp_flags & MV_HP_QUIRK_LED_BLINK_EN) 1526000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord return; 1527000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord hpriv->hp_flags |= MV_HP_QUIRK_LED_BLINK_EN; 1528000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord hc_mmio = mv_hc_base_from_port(mv_host_base(host), ap->port_no); 1529cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord led_ctrl = readl(hc_mmio + SOC_LED_CTRL); 1530cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(led_ctrl | SOC_LED_CTRL_BLINK, hc_mmio + SOC_LED_CTRL); 1531000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord} 1532000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord 1533000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lordstatic void mv_soc_led_blink_disable(struct ata_port *ap) 1534000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord{ 1535000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord struct ata_host *host = ap->host; 1536000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord struct mv_host_priv *hpriv = host->private_data; 1537000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord void __iomem *hc_mmio; 1538000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord u32 led_ctrl; 1539000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord unsigned int port; 1540000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord 1541000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord if (!(hpriv->hp_flags & MV_HP_QUIRK_LED_BLINK_EN)) 1542000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord return; 1543000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord 1544000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord /* disable led-blink only if no ports are using NCQ */ 1545000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord for (port = 0; port < hpriv->n_ports; port++) { 1546000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord struct ata_port *this_ap = host->ports[port]; 1547000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord struct mv_port_priv *pp = this_ap->private_data; 1548000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord 1549000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord if (pp->pp_flags & MV_PP_FLAG_NCQ_EN) 1550000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord return; 1551000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord } 1552000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord 1553000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord hpriv->hp_flags &= ~MV_HP_QUIRK_LED_BLINK_EN; 1554000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord hc_mmio = mv_hc_base_from_port(mv_host_base(host), ap->port_no); 1555cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord led_ctrl = readl(hc_mmio + SOC_LED_CTRL); 1556cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(led_ctrl & ~SOC_LED_CTRL_BLINK, hc_mmio + SOC_LED_CTRL); 1557000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord} 1558000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord 155900b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lordstatic void mv_edma_cfg(struct ata_port *ap, int want_ncq, int want_edma) 1560e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik{ 15610c58912e192fc3a4835d772aafa40b72552b819fMark Lord u32 cfg; 1562e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord struct mv_port_priv *pp = ap->private_data; 1563e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord struct mv_host_priv *hpriv = ap->host->private_data; 1564e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 1565e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 1566e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik /* set up non-NCQ EDMA configuration */ 15670c58912e192fc3a4835d772aafa40b72552b819fMark Lord cfg = EDMA_CFG_Q_DEPTH; /* always 0x1f for *all* chips */ 1568d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord pp->pp_flags &= 1569d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord ~(MV_PP_FLAG_FBS_EN | MV_PP_FLAG_NCQ_EN | MV_PP_FLAG_FAKE_ATA_BUSY); 1570e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 15710c58912e192fc3a4835d772aafa40b72552b819fMark Lord if (IS_GEN_I(hpriv)) 1572e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik cfg |= (1 << 8); /* enab config burst size mask */ 1573e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 1574dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord else if (IS_GEN_II(hpriv)) { 1575e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik cfg |= EDMA_CFG_RD_BRST_EXT | EDMA_CFG_WR_BUFF_LEN; 1576dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord mv_60x1_errata_sata25(ap, want_ncq); 1577e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 1578dd2890f60f8e15f14c8eb132779b2f15c49d1203Mark Lord } else if (IS_GEN_IIE(hpriv)) { 157900f42eabb204c68fa64ef72de834e74aca15c81fMark Lord int want_fbs = sata_pmp_attached(ap); 158000f42eabb204c68fa64ef72de834e74aca15c81fMark Lord /* 158100f42eabb204c68fa64ef72de834e74aca15c81fMark Lord * Possible future enhancement: 158200f42eabb204c68fa64ef72de834e74aca15c81fMark Lord * 158300f42eabb204c68fa64ef72de834e74aca15c81fMark Lord * The chip can use FBS with non-NCQ, if we allow it, 158400f42eabb204c68fa64ef72de834e74aca15c81fMark Lord * But first we need to have the error handling in place 158500f42eabb204c68fa64ef72de834e74aca15c81fMark Lord * for this mode (datasheet section 7.3.15.4.2.3). 158600f42eabb204c68fa64ef72de834e74aca15c81fMark Lord * So disallow non-NCQ FBS for now. 158700f42eabb204c68fa64ef72de834e74aca15c81fMark Lord */ 158800f42eabb204c68fa64ef72de834e74aca15c81fMark Lord want_fbs &= want_ncq; 158900f42eabb204c68fa64ef72de834e74aca15c81fMark Lord 159008da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord mv_config_fbs(ap, want_ncq, want_fbs); 159100f42eabb204c68fa64ef72de834e74aca15c81fMark Lord 159200f42eabb204c68fa64ef72de834e74aca15c81fMark Lord if (want_fbs) { 159300f42eabb204c68fa64ef72de834e74aca15c81fMark Lord pp->pp_flags |= MV_PP_FLAG_FBS_EN; 159400f42eabb204c68fa64ef72de834e74aca15c81fMark Lord cfg |= EDMA_CFG_EDMA_FBS; /* FIS-based switching */ 159500f42eabb204c68fa64ef72de834e74aca15c81fMark Lord } 159600f42eabb204c68fa64ef72de834e74aca15c81fMark Lord 1597e728eabea110da90e69c05855e3a11174edb77efJeff Garzik cfg |= (1 << 23); /* do not mask PM field in rx'd FIS */ 159800b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord if (want_edma) { 159900b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord cfg |= (1 << 22); /* enab 4-entry host queue cache */ 160000b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord if (!IS_SOC(hpriv)) 160100b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord cfg |= (1 << 18); /* enab early completion */ 160200b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord } 1603616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord if (hpriv->hp_flags & MV_HP_CUT_THROUGH) 1604616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord cfg |= (1 << 17); /* enab cut-thru (dis stor&forwrd) */ 1605c01e8a23128c746f23088db836bd4c820f3eb0b4Mark Lord mv_bmdma_enable_iie(ap, !want_edma); 1606000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord 1607000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord if (IS_SOC(hpriv)) { 1608000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord if (want_ncq) 1609000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord mv_soc_led_blink_enable(ap); 1610000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord else 1611000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord mv_soc_led_blink_disable(ap); 1612000b344f4ca7828ee43940255c8bbb32e2c7dbecMark Lord } 1613e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik } 1614e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 1615721091685f853ba4e6c49f26f989db0b1a811250Mark Lord if (want_ncq) { 1616721091685f853ba4e6c49f26f989db0b1a811250Mark Lord cfg |= EDMA_CFG_NCQ; 1617721091685f853ba4e6c49f26f989db0b1a811250Mark Lord pp->pp_flags |= MV_PP_FLAG_NCQ_EN; 161800b81235aa0368f84c0e704bec4142cd8c516ad5Mark Lord } 1619721091685f853ba4e6c49f26f989db0b1a811250Mark Lord 1620cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(cfg, port_mmio + EDMA_CFG); 1621e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik} 1622e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 1623da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lordstatic void mv_port_free_dma_mem(struct ata_port *ap) 1624da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord{ 1625da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord struct mv_host_priv *hpriv = ap->host->private_data; 1626da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord struct mv_port_priv *pp = ap->private_data; 1627eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord int tag; 1628da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord 1629da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord if (pp->crqb) { 1630da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord dma_pool_free(hpriv->crqb_pool, pp->crqb, pp->crqb_dma); 1631da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord pp->crqb = NULL; 1632da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord } 1633da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord if (pp->crpb) { 1634da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord dma_pool_free(hpriv->crpb_pool, pp->crpb, pp->crpb_dma); 1635da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord pp->crpb = NULL; 1636da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord } 1637eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord /* 1638eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord * For GEN_I, there's no NCQ, so we have only a single sg_tbl. 1639eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord * For later hardware, we have one unique sg_tbl per NCQ tag. 1640eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord */ 1641eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord for (tag = 0; tag < MV_MAX_Q_DEPTH; ++tag) { 1642eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord if (pp->sg_tbl[tag]) { 1643eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord if (tag == 0 || !IS_GEN_I(hpriv)) 1644eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord dma_pool_free(hpriv->sg_tbl_pool, 1645eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord pp->sg_tbl[tag], 1646eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord pp->sg_tbl_dma[tag]); 1647eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord pp->sg_tbl[tag] = NULL; 1648eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord } 1649da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord } 1650da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord} 1651da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord 165205b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 165305b308e1df6d9d673daedb517969241f41278b52Brett Russ * mv_port_start - Port specific init/start routine. 165405b308e1df6d9d673daedb517969241f41278b52Brett Russ * @ap: ATA channel to manipulate 165505b308e1df6d9d673daedb517969241f41278b52Brett Russ * 165605b308e1df6d9d673daedb517969241f41278b52Brett Russ * Allocate and point to DMA memory, init port private memory, 165705b308e1df6d9d673daedb517969241f41278b52Brett Russ * zero indices. 165805b308e1df6d9d673daedb517969241f41278b52Brett Russ * 165905b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 166005b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 166105b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 166231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstatic int mv_port_start(struct ata_port *ap) 166331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 1664cca3974e48607c3775dc73b544a5700b2e37c21aJeff Garzik struct device *dev = ap->host->dev; 1665cca3974e48607c3775dc73b544a5700b2e37c21aJeff Garzik struct mv_host_priv *hpriv = ap->host->private_data; 166631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ struct mv_port_priv *pp; 1667933cb8e5fcdebd4b666165e3f039f814d62b0e52Mark Lord unsigned long flags; 1668dde2020754aeb14e17052d61784dcb37f252aac2James Bottomley int tag; 166931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 167024dc5f33ea4b504cfbd23fa159a4cacba8e4d800Tejun Heo pp = devm_kzalloc(dev, sizeof(*pp), GFP_KERNEL); 16716037d6bbdff65eb5a84fe35e140f4da4f7cc103aJeff Garzik if (!pp) 167224dc5f33ea4b504cfbd23fa159a4cacba8e4d800Tejun Heo return -ENOMEM; 1673da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord ap->private_data = pp; 167431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 1675da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord pp->crqb = dma_pool_alloc(hpriv->crqb_pool, GFP_KERNEL, &pp->crqb_dma); 1676da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord if (!pp->crqb) 1677da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord return -ENOMEM; 1678da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord memset(pp->crqb, 0, MV_CRQB_Q_SZ); 167931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 1680da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord pp->crpb = dma_pool_alloc(hpriv->crpb_pool, GFP_KERNEL, &pp->crpb_dma); 1681da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord if (!pp->crpb) 1682da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord goto out_port_free_dma_mem; 1683da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord memset(pp->crpb, 0, MV_CRPB_Q_SZ); 168431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 16853bd0a70ee9cc30ae81b39cb5ecad0fa7bcb4675bMark Lord /* 6041/6081 Rev. "C0" (and newer) are okay with async notify */ 16863bd0a70ee9cc30ae81b39cb5ecad0fa7bcb4675bMark Lord if (hpriv->hp_flags & MV_HP_ERRATA_60X1C0) 16873bd0a70ee9cc30ae81b39cb5ecad0fa7bcb4675bMark Lord ap->flags |= ATA_FLAG_AN; 1688eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord /* 1689eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord * For GEN_I, there's no NCQ, so we only allocate a single sg_tbl. 1690eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord * For later hardware, we need one unique sg_tbl per NCQ tag. 1691eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord */ 1692eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord for (tag = 0; tag < MV_MAX_Q_DEPTH; ++tag) { 1693eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord if (tag == 0 || !IS_GEN_I(hpriv)) { 1694eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord pp->sg_tbl[tag] = dma_pool_alloc(hpriv->sg_tbl_pool, 1695eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord GFP_KERNEL, &pp->sg_tbl_dma[tag]); 1696eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord if (!pp->sg_tbl[tag]) 1697eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord goto out_port_free_dma_mem; 1698eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord } else { 1699eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord pp->sg_tbl[tag] = pp->sg_tbl[0]; 1700eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord pp->sg_tbl_dma[tag] = pp->sg_tbl_dma[0]; 1701eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord } 1702eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord } 1703933cb8e5fcdebd4b666165e3f039f814d62b0e52Mark Lord 1704933cb8e5fcdebd4b666165e3f039f814d62b0e52Mark Lord spin_lock_irqsave(ap->lock, flags); 170508da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord mv_save_cached_regs(ap); 170666e57a2cb0c538d4f84a7233c224735fe1eaa672Mark Lord mv_edma_cfg(ap, 0, 0); 1707933cb8e5fcdebd4b666165e3f039f814d62b0e52Mark Lord spin_unlock_irqrestore(ap->lock, flags); 1708933cb8e5fcdebd4b666165e3f039f814d62b0e52Mark Lord 170931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ return 0; 1710da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord 1711da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lordout_port_free_dma_mem: 1712da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord mv_port_free_dma_mem(ap); 1713da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord return -ENOMEM; 171431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 171531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 171605b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 171705b308e1df6d9d673daedb517969241f41278b52Brett Russ * mv_port_stop - Port specific cleanup/stop routine. 171805b308e1df6d9d673daedb517969241f41278b52Brett Russ * @ap: ATA channel to manipulate 171905b308e1df6d9d673daedb517969241f41278b52Brett Russ * 172005b308e1df6d9d673daedb517969241f41278b52Brett Russ * Stop DMA, cleanup port memory. 172105b308e1df6d9d673daedb517969241f41278b52Brett Russ * 172205b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 1723cca3974e48607c3775dc73b544a5700b2e37c21aJeff Garzik * This routine uses the host lock to protect the DMA stop. 172405b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 172531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstatic void mv_port_stop(struct ata_port *ap) 172631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 1727933cb8e5fcdebd4b666165e3f039f814d62b0e52Mark Lord unsigned long flags; 1728933cb8e5fcdebd4b666165e3f039f814d62b0e52Mark Lord 1729933cb8e5fcdebd4b666165e3f039f814d62b0e52Mark Lord spin_lock_irqsave(ap->lock, flags); 1730e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord mv_stop_edma(ap); 173188e675e193159b9891c1c576de4348eaf490f5d0Mark Lord mv_enable_port_irqs(ap, 0); 1732933cb8e5fcdebd4b666165e3f039f814d62b0e52Mark Lord spin_unlock_irqrestore(ap->lock, flags); 1733da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord mv_port_free_dma_mem(ap); 173431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 173531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 173605b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 173705b308e1df6d9d673daedb517969241f41278b52Brett Russ * mv_fill_sg - Fill out the Marvell ePRD (scatter gather) entries 173805b308e1df6d9d673daedb517969241f41278b52Brett Russ * @qc: queued command whose SG list to source from 173905b308e1df6d9d673daedb517969241f41278b52Brett Russ * 174005b308e1df6d9d673daedb517969241f41278b52Brett Russ * Populate the SG list and mark the last entry. 174105b308e1df6d9d673daedb517969241f41278b52Brett Russ * 174205b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 174305b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 174405b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 17456c08772e49622e90d39903e7ff0be1a0f463ac86Jeff Garzikstatic void mv_fill_sg(struct ata_queued_cmd *qc) 174631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 174731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ struct mv_port_priv *pp = qc->ap->private_data; 1748972c26bdd6b58e7534473c4f7928584578cf43f4Jeff Garzik struct scatterlist *sg; 17493be6cbd73f74b4a3da82cc7d6e1688a4ae595fc7Jeff Garzik struct mv_sg *mv_sg, *last_sg = NULL; 1750ff2aeb1eb64c8a4770a6304f9addbae9f9828646Tejun Heo unsigned int si; 175131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 1752eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord mv_sg = pp->sg_tbl[qc->tag]; 1753ff2aeb1eb64c8a4770a6304f9addbae9f9828646Tejun Heo for_each_sg(qc->sg, sg, qc->n_elem, si) { 1754d88184fb2348a50f7c34f5d49a901c875b2e0114Jeff Garzik dma_addr_t addr = sg_dma_address(sg); 1755d88184fb2348a50f7c34f5d49a901c875b2e0114Jeff Garzik u32 sg_len = sg_dma_len(sg); 175622374677d18c5eeefd3a283431d312b8c44fef02Jeff Garzik 17574007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson while (sg_len) { 17584007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson u32 offset = addr & 0xffff; 17594007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson u32 len = sg_len; 176022374677d18c5eeefd3a283431d312b8c44fef02Jeff Garzik 176132cd11a61007511ddb38783deec8bb1aa6735789Mark Lord if (offset + len > 0x10000) 17624007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson len = 0x10000 - offset; 17634007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson 17644007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson mv_sg->addr = cpu_to_le32(addr & 0xffffffff); 17654007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson mv_sg->addr_hi = cpu_to_le32((addr >> 16) >> 16); 17666c08772e49622e90d39903e7ff0be1a0f463ac86Jeff Garzik mv_sg->flags_size = cpu_to_le32(len & 0xffff); 176732cd11a61007511ddb38783deec8bb1aa6735789Mark Lord mv_sg->reserved = 0; 17684007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson 17694007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson sg_len -= len; 17704007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson addr += len; 17714007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson 17723be6cbd73f74b4a3da82cc7d6e1688a4ae595fc7Jeff Garzik last_sg = mv_sg; 17734007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson mv_sg++; 17744007b493ee6e4a52c2b618ab8361847fba5bf116Olof Johansson } 177531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 17763be6cbd73f74b4a3da82cc7d6e1688a4ae595fc7Jeff Garzik 17773be6cbd73f74b4a3da82cc7d6e1688a4ae595fc7Jeff Garzik if (likely(last_sg)) 17783be6cbd73f74b4a3da82cc7d6e1688a4ae595fc7Jeff Garzik last_sg->flags_size |= cpu_to_le32(EPRD_FLAG_END_OF_TBL); 177932cd11a61007511ddb38783deec8bb1aa6735789Mark Lord mb(); /* ensure data structure is visible to the chipset */ 178031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 178131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 17825796d1c4c89efff823259fda35b08ea66ebf8b23Jeff Garzikstatic void mv_crqb_pack_cmd(__le16 *cmdw, u8 data, u8 addr, unsigned last) 178331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 1784559eedad7f7764dacca33980127b4615011230e4Mark Lord u16 tmp = data | (addr << CRQB_CMD_ADDR_SHIFT) | CRQB_CMD_CS | 178531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ (last ? CRQB_CMD_LAST : 0); 1786559eedad7f7764dacca33980127b4615011230e4Mark Lord *cmdw = cpu_to_le16(tmp); 178731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 178831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 178905b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 1790da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * mv_sff_irq_clear - Clear hardware interrupt after DMA. 1791da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * @ap: Port associated with this ATA transaction. 1792da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * 1793da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * We need this only for ATAPI bmdma transactions, 1794da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * as otherwise we experience spurious interrupts 1795da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * after libata-sff handles the bmdma interrupts. 1796da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord */ 1797da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic void mv_sff_irq_clear(struct ata_port *ap) 1798da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord{ 1799da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord mv_clear_and_enable_port_irqs(ap, mv_ap_base(ap), ERR_IRQ); 1800da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord} 1801da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1802da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord/** 1803da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * mv_check_atapi_dma - Filter ATAPI cmds which are unsuitable for DMA. 1804da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * @qc: queued command to check for chipset/DMA compatibility. 1805da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * 1806da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * The bmdma engines cannot handle speculative data sizes 1807da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * (bytecount under/over flow). So only allow DMA for 1808da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * data transfer commands with known data sizes. 1809da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * 1810da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * LOCKING: 1811da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * Inherited from caller. 1812da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord */ 1813da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic int mv_check_atapi_dma(struct ata_queued_cmd *qc) 1814da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord{ 1815da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord struct scsi_cmnd *scmd = qc->scsicmd; 1816da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1817da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord if (scmd) { 1818da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord switch (scmd->cmnd[0]) { 1819da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord case READ_6: 1820da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord case READ_10: 1821da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord case READ_12: 1822da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord case WRITE_6: 1823da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord case WRITE_10: 1824da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord case WRITE_12: 1825da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord case GPCMD_READ_CD: 1826da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord case GPCMD_SEND_DVD_STRUCTURE: 1827da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord case GPCMD_SEND_CUE_SHEET: 1828da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord return 0; /* DMA is safe */ 1829da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord } 1830da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord } 1831da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord return -EOPNOTSUPP; /* use PIO instead */ 1832da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord} 1833da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1834da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord/** 1835da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * mv_bmdma_setup - Set up BMDMA transaction 1836da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * @qc: queued command to prepare DMA for. 1837da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * 1838da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * LOCKING: 1839da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * Inherited from caller. 1840da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord */ 1841da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic void mv_bmdma_setup(struct ata_queued_cmd *qc) 1842da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord{ 1843da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord struct ata_port *ap = qc->ap; 1844da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 1845da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord struct mv_port_priv *pp = ap->private_data; 1846da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1847da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord mv_fill_sg(qc); 1848da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1849da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord /* clear all DMA cmd bits */ 1850cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(0, port_mmio + BMDMA_CMD); 1851da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1852da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord /* load PRD table addr. */ 1853da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord writel((pp->sg_tbl_dma[qc->tag] >> 16) >> 16, 1854cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord port_mmio + BMDMA_PRD_HIGH); 1855da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord writelfl(pp->sg_tbl_dma[qc->tag], 1856cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord port_mmio + BMDMA_PRD_LOW); 1857da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1858da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord /* issue r/w command */ 1859da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord ap->ops->sff_exec_command(ap, &qc->tf); 1860da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord} 1861da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1862da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord/** 1863da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * mv_bmdma_start - Start a BMDMA transaction 1864da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * @qc: queued command to start DMA on. 1865da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * 1866da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * LOCKING: 1867da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * Inherited from caller. 1868da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord */ 1869da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic void mv_bmdma_start(struct ata_queued_cmd *qc) 1870da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord{ 1871da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord struct ata_port *ap = qc->ap; 1872da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 1873da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord unsigned int rw = (qc->tf.flags & ATA_TFLAG_WRITE); 1874da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord u32 cmd = (rw ? 0 : ATA_DMA_WR) | ATA_DMA_START; 1875da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1876da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord /* start host DMA transaction */ 1877cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(cmd, port_mmio + BMDMA_CMD); 1878da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord} 1879da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1880da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord/** 1881da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * mv_bmdma_stop - Stop BMDMA transfer 1882da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * @qc: queued command to stop DMA on. 1883da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * 1884da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * Clears the ATA_DMA_START flag in the bmdma control register 1885da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * 1886da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * LOCKING: 1887da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * Inherited from caller. 1888da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord */ 1889da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic void mv_bmdma_stop(struct ata_queued_cmd *qc) 1890da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord{ 1891da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord struct ata_port *ap = qc->ap; 1892da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 1893da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord u32 cmd; 1894da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1895da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord /* clear start/stop bit */ 1896cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord cmd = readl(port_mmio + BMDMA_CMD); 1897da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord cmd &= ~ATA_DMA_START; 1898cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(cmd, port_mmio + BMDMA_CMD); 1899da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1900da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord /* one-PIO-cycle guaranteed wait, per spec, for HDMA1:0 transition */ 1901da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord ata_sff_dma_pause(ap); 1902da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord} 1903da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1904da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord/** 1905da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * mv_bmdma_status - Read BMDMA status 1906da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * @ap: port for which to retrieve DMA status. 1907da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * 1908da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * Read and return equivalent of the sff BMDMA status register. 1909da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * 1910da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * LOCKING: 1911da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * Inherited from caller. 1912da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord */ 1913da14265e776f35067045b8555b5f5f7521e50bc4Mark Lordstatic u8 mv_bmdma_status(struct ata_port *ap) 1914da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord{ 1915da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 1916da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord u32 reg, status; 1917da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1918da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord /* 1919da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * Other bits are valid only if ATA_DMA_ACTIVE==0, 1920da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord * and the ATA_DMA_INTR bit doesn't exist. 1921da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord */ 1922cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord reg = readl(port_mmio + BMDMA_STATUS); 1923da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord if (reg & ATA_DMA_ACTIVE) 1924da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord status = ATA_DMA_ACTIVE; 1925da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord else 1926da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord status = (reg & ATA_DMA_ERR) | ATA_DMA_INTR; 1927da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord return status; 1928da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord} 1929da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord 1930299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lordstatic void mv_rw_multi_errata_sata24(struct ata_queued_cmd *qc) 1931299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord{ 1932299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord struct ata_taskfile *tf = &qc->tf; 1933299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord /* 1934299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * Workaround for 88SX60x1 FEr SATA#24. 1935299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * 1936299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * Chip may corrupt WRITEs if multi_count >= 4kB. 1937299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * Note that READs are unaffected. 1938299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * 1939299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * It's not clear if this errata really means "4K bytes", 1940299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * or if it always happens for multi_count > 7 1941299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * regardless of device sector_size. 1942299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * 1943299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * So, for safety, any write with multi_count > 7 1944299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord * gets converted here into a regular PIO write instead: 1945299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord */ 1946299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord if ((tf->flags & ATA_TFLAG_WRITE) && is_multi_taskfile(tf)) { 1947299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord if (qc->dev->multi_count > 7) { 1948299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord switch (tf->command) { 1949299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord case ATA_CMD_WRITE_MULTI: 1950299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord tf->command = ATA_CMD_PIO_WRITE; 1951299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord break; 1952299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord case ATA_CMD_WRITE_MULTI_FUA_EXT: 1953299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord tf->flags &= ~ATA_TFLAG_FUA; /* ugh */ 1954299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord /* fall through */ 1955299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord case ATA_CMD_WRITE_MULTI_EXT: 1956299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord tf->command = ATA_CMD_PIO_WRITE_EXT; 1957299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord break; 1958299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord } 1959299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord } 1960299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord } 1961299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord} 1962299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord 1963da14265e776f35067045b8555b5f5f7521e50bc4Mark Lord/** 196405b308e1df6d9d673daedb517969241f41278b52Brett Russ * mv_qc_prep - Host specific command preparation. 196505b308e1df6d9d673daedb517969241f41278b52Brett Russ * @qc: queued command to prepare 196605b308e1df6d9d673daedb517969241f41278b52Brett Russ * 196705b308e1df6d9d673daedb517969241f41278b52Brett Russ * This routine simply redirects to the general purpose routine 196805b308e1df6d9d673daedb517969241f41278b52Brett Russ * if command is not DMA. Else, it handles prep of the CRQB 196905b308e1df6d9d673daedb517969241f41278b52Brett Russ * (command request block), does some sanity checking, and calls 197005b308e1df6d9d673daedb517969241f41278b52Brett Russ * the SG load routine. 197105b308e1df6d9d673daedb517969241f41278b52Brett Russ * 197205b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 197305b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 197405b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 197531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstatic void mv_qc_prep(struct ata_queued_cmd *qc) 197631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 197731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ struct ata_port *ap = qc->ap; 197831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ struct mv_port_priv *pp = ap->private_data; 1979e14698745dd0de1ddbf5cd0cca4313a90f8c1cc1Mark Lord __le16 *cw; 19808d2b450d0f9233f221d545f26720eebbc468e857Mark Lord struct ata_taskfile *tf = &qc->tf; 198131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ u16 flags = 0; 1982a6432436c5e14b416f27c8f87c5bf0bc36771f49Mark Lord unsigned in_index; 198331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 1984299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord switch (tf->protocol) { 1985299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord case ATA_PROT_DMA: 1986299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord case ATA_PROT_NCQ: 1987299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord break; /* continue below */ 1988299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord case ATA_PROT_PIO: 1989299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord mv_rw_multi_errata_sata24(qc); 199031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ return; 1991299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord default: 1992299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord return; 1993299b3f8df90a3f7416d8df121d8a42b1a2aeced4Mark Lord } 199420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 199531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ /* Fill in command request block 199631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ */ 19978d2b450d0f9233f221d545f26720eebbc468e857Mark Lord if (!(tf->flags & ATA_TFLAG_WRITE)) 199831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ flags |= CRQB_FLAG_READ; 1999beec7dbc6ff003bbc94de62b3323519c878fb2acTejun Heo WARN_ON(MV_MAX_Q_DEPTH <= qc->tag); 200031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ flags |= qc->tag << CRQB_TAG_SHIFT; 2001e49856d82a887ce365637176f9f99ab68076eae8Mark Lord flags |= (qc->dev->link->pmp & 0xf) << CRQB_PMP_SHIFT; 200231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 2003bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik /* get current queue index from software */ 2004fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord in_index = pp->req_idx; 2005a6432436c5e14b416f27c8f87c5bf0bc36771f49Mark Lord 2006a6432436c5e14b416f27c8f87c5bf0bc36771f49Mark Lord pp->crqb[in_index].sg_addr = 2007eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord cpu_to_le32(pp->sg_tbl_dma[qc->tag] & 0xffffffff); 2008a6432436c5e14b416f27c8f87c5bf0bc36771f49Mark Lord pp->crqb[in_index].sg_addr_hi = 2009eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord cpu_to_le32((pp->sg_tbl_dma[qc->tag] >> 16) >> 16); 2010a6432436c5e14b416f27c8f87c5bf0bc36771f49Mark Lord pp->crqb[in_index].ctrl_flags = cpu_to_le16(flags); 201131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 2012a6432436c5e14b416f27c8f87c5bf0bc36771f49Mark Lord cw = &pp->crqb[in_index].ata_cmd[0]; 201331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 201431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ /* Sadly, the CRQB cannot accomodate all registers--there are 201531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * only 11 bytes...so we must pick and choose required 201631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * registers based on the command. So, we drop feature and 201731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * hob_feature for [RW] DMA commands, but they are needed for 2018cd12e1f7a2c28917c89d65c0d4a52d3919b4c125Mark Lord * NCQ. NCQ will drop hob_nsect, which is not needed there 2019cd12e1f7a2c28917c89d65c0d4a52d3919b4c125Mark Lord * (nsect is used only for the tag; feat/hob_feat hold true nsect). 202020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ */ 202131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ switch (tf->command) { 202231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ case ATA_CMD_READ: 202331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ case ATA_CMD_READ_EXT: 202431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ case ATA_CMD_WRITE: 202531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ case ATA_CMD_WRITE_EXT: 2026c15d85c8f3f73b5f20aae7928e25b6996f16b328Jens Axboe case ATA_CMD_WRITE_FUA_EXT: 202731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->hob_nsect, ATA_REG_NSECT, 0); 202831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ break; 202931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ case ATA_CMD_FPDMA_READ: 203031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ case ATA_CMD_FPDMA_WRITE: 20318b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik mv_crqb_pack_cmd(cw++, tf->hob_feature, ATA_REG_FEATURE, 0); 203231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->feature, ATA_REG_FEATURE, 0); 203331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ break; 203431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ default: 203531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ /* The only other commands EDMA supports in non-queued and 203631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * non-NCQ mode are: [RW] STREAM DMA and W DMA FUA EXT, none 203731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * of which are defined/used by Linux. If we get here, this 203831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * driver needs work. 203931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * 204031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * FIXME: modify libata to give qc_prep a return value and 204131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * return error here. 204231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ */ 204331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ BUG_ON(tf->command); 204431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ break; 204531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 204631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->nsect, ATA_REG_NSECT, 0); 204731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->hob_lbal, ATA_REG_LBAL, 0); 204831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->lbal, ATA_REG_LBAL, 0); 204931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->hob_lbam, ATA_REG_LBAM, 0); 205031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->lbam, ATA_REG_LBAM, 0); 205131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->hob_lbah, ATA_REG_LBAH, 0); 205231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->lbah, ATA_REG_LBAH, 0); 205331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->device, ATA_REG_DEVICE, 0); 205431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_crqb_pack_cmd(cw++, tf->command, ATA_REG_CMD, 1); /* last */ 205531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 2056e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik if (!(qc->flags & ATA_QCFLAG_DMAMAP)) 2057e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik return; 2058e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik mv_fill_sg(qc); 2059e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik} 2060e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 2061e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik/** 2062e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik * mv_qc_prep_iie - Host specific command preparation. 2063e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik * @qc: queued command to prepare 2064e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik * 2065e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik * This routine simply redirects to the general purpose routine 2066e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik * if command is not DMA. Else, it handles prep of the CRQB 2067e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik * (command request block), does some sanity checking, and calls 2068e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik * the SG load routine. 2069e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik * 2070e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik * LOCKING: 2071e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik * Inherited from caller. 2072e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik */ 2073e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzikstatic void mv_qc_prep_iie(struct ata_queued_cmd *qc) 2074e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik{ 2075e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik struct ata_port *ap = qc->ap; 2076e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik struct mv_port_priv *pp = ap->private_data; 2077e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik struct mv_crqb_iie *crqb; 20788d2b450d0f9233f221d545f26720eebbc468e857Mark Lord struct ata_taskfile *tf = &qc->tf; 2079a6432436c5e14b416f27c8f87c5bf0bc36771f49Mark Lord unsigned in_index; 2080e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik u32 flags = 0; 2081e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 20828d2b450d0f9233f221d545f26720eebbc468e857Mark Lord if ((tf->protocol != ATA_PROT_DMA) && 20838d2b450d0f9233f221d545f26720eebbc468e857Mark Lord (tf->protocol != ATA_PROT_NCQ)) 2084e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik return; 2085e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 2086e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord /* Fill in Gen IIE command request block */ 20878d2b450d0f9233f221d545f26720eebbc468e857Mark Lord if (!(tf->flags & ATA_TFLAG_WRITE)) 2088e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik flags |= CRQB_FLAG_READ; 2089e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 2090beec7dbc6ff003bbc94de62b3323519c878fb2acTejun Heo WARN_ON(MV_MAX_Q_DEPTH <= qc->tag); 2091e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik flags |= qc->tag << CRQB_TAG_SHIFT; 20928c0aeb4a483334613336ef895f34cecc0ecbbfa6Mark Lord flags |= qc->tag << CRQB_HOSTQ_SHIFT; 2093e49856d82a887ce365637176f9f99ab68076eae8Mark Lord flags |= (qc->dev->link->pmp & 0xf) << CRQB_PMP_SHIFT; 2094e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 2095bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik /* get current queue index from software */ 2096fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord in_index = pp->req_idx; 2097a6432436c5e14b416f27c8f87c5bf0bc36771f49Mark Lord 2098a6432436c5e14b416f27c8f87c5bf0bc36771f49Mark Lord crqb = (struct mv_crqb_iie *) &pp->crqb[in_index]; 2099eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord crqb->addr = cpu_to_le32(pp->sg_tbl_dma[qc->tag] & 0xffffffff); 2100eb73d558d1c1c931de0b3a86af962c77d74ef688Mark Lord crqb->addr_hi = cpu_to_le32((pp->sg_tbl_dma[qc->tag] >> 16) >> 16); 2101e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik crqb->flags = cpu_to_le32(flags); 2102e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 2103e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik crqb->ata_cmd[0] = cpu_to_le32( 2104e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->command << 16) | 2105e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->feature << 24) 2106e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik ); 2107e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik crqb->ata_cmd[1] = cpu_to_le32( 2108e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->lbal << 0) | 2109e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->lbam << 8) | 2110e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->lbah << 16) | 2111e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->device << 24) 2112e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik ); 2113e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik crqb->ata_cmd[2] = cpu_to_le32( 2114e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->hob_lbal << 0) | 2115e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->hob_lbam << 8) | 2116e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->hob_lbah << 16) | 2117e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->hob_feature << 24) 2118e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik ); 2119e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik crqb->ata_cmd[3] = cpu_to_le32( 2120e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->nsect << 0) | 2121e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik (tf->hob_nsect << 8) 2122e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik ); 2123e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 2124e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik if (!(qc->flags & ATA_QCFLAG_DMAMAP)) 212531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ return; 212631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_fill_sg(qc); 212731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 212831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 212905b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 2130d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * mv_sff_check_status - fetch device status, if valid 2131d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * @ap: ATA port to fetch status from 2132d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * 2133d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * When using command issue via mv_qc_issue_fis(), 2134d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * the initial ATA_BUSY state does not show up in the 2135d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * ATA status (shadow) register. This can confuse libata! 2136d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * 2137d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * So we have a hook here to fake ATA_BUSY for that situation, 2138d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * until the first time a BUSY, DRQ, or ERR bit is seen. 2139d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * 2140d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord * The rest of the time, it simply returns the ATA status register. 2141d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord */ 2142d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lordstatic u8 mv_sff_check_status(struct ata_port *ap) 2143d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord{ 2144d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord u8 stat = ioread8(ap->ioaddr.status_addr); 2145d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord struct mv_port_priv *pp = ap->private_data; 2146d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord 2147d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord if (pp->pp_flags & MV_PP_FLAG_FAKE_ATA_BUSY) { 2148d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord if (stat & (ATA_BUSY | ATA_DRQ | ATA_ERR)) 2149d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord pp->pp_flags &= ~MV_PP_FLAG_FAKE_ATA_BUSY; 2150d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord else 2151d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord stat = ATA_BUSY; 2152d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord } 2153d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord return stat; 2154d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord} 2155d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord 2156d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord/** 215770f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * mv_send_fis - Send a FIS, using the "Vendor-Unique FIS" register 215870f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * @fis: fis to be sent 215970f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * @nwords: number of 32-bit words in the fis 216070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord */ 216170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lordstatic unsigned int mv_send_fis(struct ata_port *ap, u32 *fis, int nwords) 216270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord{ 216370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 216470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord u32 ifctl, old_ifctl, ifstat; 216570f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord int i, timeout = 200, final_word = nwords - 1; 216670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 216770f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord /* Initiate FIS transmission mode */ 2168cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord old_ifctl = readl(port_mmio + SATA_IFCTL); 216970f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord ifctl = 0x100 | (old_ifctl & 0xf); 2170cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(ifctl, port_mmio + SATA_IFCTL); 217170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 217270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord /* Send all words of the FIS except for the final word */ 217370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord for (i = 0; i < final_word; ++i) 2174cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(fis[i], port_mmio + VENDOR_UNIQUE_FIS); 217570f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 217670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord /* Flag end-of-transmission, and then send the final word */ 2177cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(ifctl | 0x200, port_mmio + SATA_IFCTL); 2178cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(fis[final_word], port_mmio + VENDOR_UNIQUE_FIS); 217970f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 218070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord /* 218170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * Wait for FIS transmission to complete. 218270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * This typically takes just a single iteration. 218370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord */ 218470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord do { 2185cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord ifstat = readl(port_mmio + SATA_IFSTAT); 218670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord } while (!(ifstat & 0x1000) && --timeout); 218770f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 218870f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord /* Restore original port configuration */ 2189cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(old_ifctl, port_mmio + SATA_IFCTL); 219070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 219170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord /* See if it worked */ 219270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord if ((ifstat & 0x3000) != 0x1000) { 219370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord ata_port_printk(ap, KERN_WARNING, 219470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord "%s transmission error, ifstat=%08x\n", 219570f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord __func__, ifstat); 219670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord return AC_ERR_OTHER; 219770f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord } 219870f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord return 0; 219970f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord} 220070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 220170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord/** 220270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * mv_qc_issue_fis - Issue a command directly as a FIS 220370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * @qc: queued command to start 220470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * 220570f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * Note that the ATA shadow registers are not updated 220670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * after command issue, so the device will appear "READY" 220770f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * if polled, even while it is BUSY processing the command. 220870f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * 220970f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * So we use a status hook to fake ATA_BUSY until the drive changes state. 221070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * 221170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * Note: we don't get updated shadow regs on *completion* 221270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * of non-data commands. So avoid sending them via this function, 221370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * as they will appear to have completed immediately. 221470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * 221570f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * GEN_IIE has special registers that we could get the result tf from, 221670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * but earlier chipsets do not. For now, we ignore those registers. 221770f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord */ 221870f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lordstatic unsigned int mv_qc_issue_fis(struct ata_queued_cmd *qc) 221970f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord{ 222070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord struct ata_port *ap = qc->ap; 222170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord struct mv_port_priv *pp = ap->private_data; 222270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord struct ata_link *link = qc->dev->link; 222370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord u32 fis[5]; 222470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord int err = 0; 222570f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 222670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord ata_tf_to_fis(&qc->tf, link->pmp, 1, (void *)fis); 22274c4a90fd2b9d1f5c0d33df3fcfaa8a3dae9abc53Thiago Farina err = mv_send_fis(ap, fis, ARRAY_SIZE(fis)); 222870f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord if (err) 222970f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord return err; 223070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 223170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord switch (qc->tf.protocol) { 223270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord case ATAPI_PROT_PIO: 223370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord pp->pp_flags |= MV_PP_FLAG_FAKE_ATA_BUSY; 223470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord /* fall through */ 223570f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord case ATAPI_PROT_NODATA: 223670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord ap->hsm_task_state = HSM_ST_FIRST; 223770f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord break; 223870f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord case ATA_PROT_PIO: 223970f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord pp->pp_flags |= MV_PP_FLAG_FAKE_ATA_BUSY; 224070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord if (qc->tf.flags & ATA_TFLAG_WRITE) 224170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord ap->hsm_task_state = HSM_ST_FIRST; 224270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord else 224370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord ap->hsm_task_state = HSM_ST; 224470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord break; 224570f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord default: 224670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord ap->hsm_task_state = HSM_ST_LAST; 224770f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord break; 224870f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord } 224970f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 225070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord if (qc->tf.flags & ATA_TFLAG_POLLING) 225170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord ata_pio_queue_task(ap, qc, 0); 225270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord return 0; 225370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord} 225470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 225570f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord/** 225605b308e1df6d9d673daedb517969241f41278b52Brett Russ * mv_qc_issue - Initiate a command to the host 225705b308e1df6d9d673daedb517969241f41278b52Brett Russ * @qc: queued command to start 225805b308e1df6d9d673daedb517969241f41278b52Brett Russ * 225905b308e1df6d9d673daedb517969241f41278b52Brett Russ * This routine simply redirects to the general purpose routine 226005b308e1df6d9d673daedb517969241f41278b52Brett Russ * if command is not DMA. Else, it sanity checks our local 226105b308e1df6d9d673daedb517969241f41278b52Brett Russ * caches of the request producer/consumer indices then enables 226205b308e1df6d9d673daedb517969241f41278b52Brett Russ * DMA and bumps the request producer index. 226305b308e1df6d9d673daedb517969241f41278b52Brett Russ * 226405b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 226505b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 226605b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 22679a3d9eb0177eb10500d49cd283b35576082a522dTejun Heostatic unsigned int mv_qc_issue(struct ata_queued_cmd *qc) 226831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 2269f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord static int limit_warnings = 10; 2270c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik struct ata_port *ap = qc->ap; 2271c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik void __iomem *port_mmio = mv_ap_base(ap); 2272c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik struct mv_port_priv *pp = ap->private_data; 2273bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik u32 in_index; 227442ed893d8011264f9945c2f54055b47c298ac53eMark Lord unsigned int port_irqs; 2275f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord 2276d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord pp->pp_flags &= ~MV_PP_FLAG_FAKE_ATA_BUSY; /* paranoia */ 2277d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord 2278f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord switch (qc->tf.protocol) { 2279f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord case ATA_PROT_DMA: 2280f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord case ATA_PROT_NCQ: 2281f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord mv_start_edma(ap, port_mmio, pp, qc->tf.protocol); 2282f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord pp->req_idx = (pp->req_idx + 1) & MV_MAX_Q_DEPTH_MASK; 2283f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord in_index = pp->req_idx << EDMA_REQ_Q_PTR_SHIFT; 2284f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord 2285f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord /* Write the request in pointer to kick the EDMA to life */ 2286f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord writelfl((pp->crqb_dma & EDMA_REQ_Q_BASE_LO_MASK) | in_index, 2287cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord port_mmio + EDMA_REQ_Q_IN_PTR); 2288f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord return 0; 228931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 2290f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord case ATA_PROT_PIO: 2291c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord /* 2292c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord * Errata SATA#16, SATA#24: warn if multiple DRQs expected. 2293c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord * 2294c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord * Someday, we might implement special polling workarounds 2295c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord * for these, but it all seems rather unnecessary since we 2296c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord * normally use only DMA for commands which transfer more 2297c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord * than a single block of data. 2298c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord * 2299c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord * Much of the time, this could just work regardless. 2300c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord * So for now, just log the incident, and allow the attempt. 2301c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord */ 2302c7843e8f565f624b0cff7cad1370fad4cb84dfbcMark Lord if (limit_warnings > 0 && (qc->nbytes / qc->sect_size) > 1) { 2303c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord --limit_warnings; 2304c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord ata_link_printk(qc->dev->link, KERN_WARNING, DRV_NAME 2305c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord ": attempting PIO w/multiple DRQ: " 2306c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord "this may fail due to h/w errata\n"); 2307c6112bd86bc8f727bb732a47f2133e0ff12beda9Mark Lord } 2308f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord /* drop through */ 230942ed893d8011264f9945c2f54055b47c298ac53eMark Lord case ATA_PROT_NODATA: 2310f48765ccb48a62596b664aa88a2b0f943c12c0e1Mark Lord case ATAPI_PROT_PIO: 231142ed893d8011264f9945c2f54055b47c298ac53eMark Lord case ATAPI_PROT_NODATA: 231242ed893d8011264f9945c2f54055b47c298ac53eMark Lord if (ap->flags & ATA_FLAG_PIO_POLLING) 231342ed893d8011264f9945c2f54055b47c298ac53eMark Lord qc->tf.flags |= ATA_TFLAG_POLLING; 231442ed893d8011264f9945c2f54055b47c298ac53eMark Lord break; 231531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ } 231642ed893d8011264f9945c2f54055b47c298ac53eMark Lord 231742ed893d8011264f9945c2f54055b47c298ac53eMark Lord if (qc->tf.flags & ATA_TFLAG_POLLING) 231842ed893d8011264f9945c2f54055b47c298ac53eMark Lord port_irqs = ERR_IRQ; /* mask device interrupt when polling */ 231942ed893d8011264f9945c2f54055b47c298ac53eMark Lord else 232042ed893d8011264f9945c2f54055b47c298ac53eMark Lord port_irqs = ERR_IRQ | DONE_IRQ; /* unmask all interrupts */ 232142ed893d8011264f9945c2f54055b47c298ac53eMark Lord 232242ed893d8011264f9945c2f54055b47c298ac53eMark Lord /* 232342ed893d8011264f9945c2f54055b47c298ac53eMark Lord * We're about to send a non-EDMA capable command to the 232442ed893d8011264f9945c2f54055b47c298ac53eMark Lord * port. Turn off EDMA so there won't be problems accessing 232542ed893d8011264f9945c2f54055b47c298ac53eMark Lord * shadow block, etc registers. 232642ed893d8011264f9945c2f54055b47c298ac53eMark Lord */ 232742ed893d8011264f9945c2f54055b47c298ac53eMark Lord mv_stop_edma(ap); 232842ed893d8011264f9945c2f54055b47c298ac53eMark Lord mv_clear_and_enable_port_irqs(ap, mv_ap_base(ap), port_irqs); 232942ed893d8011264f9945c2f54055b47c298ac53eMark Lord mv_pmp_select(ap, qc->dev->link->pmp); 233070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord 233170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord if (qc->tf.command == ATA_CMD_READ_LOG_EXT) { 233270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord struct mv_host_priv *hpriv = ap->host->private_data; 233370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord /* 233470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * Workaround for 88SX60x1 FEr SATA#25 (part 2). 233540f21b1124a9552bc093469280eb8239dc5f73d7Mark Lord * 233670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * After any NCQ error, the READ_LOG_EXT command 233770f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * from libata-eh *must* use mv_qc_issue_fis(). 233870f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * Otherwise it might fail, due to chip errata. 233970f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * 234070f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * Rather than special-case it, we'll just *always* 234170f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * use this method here for READ_LOG_EXT, making for 234270f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord * easier testing. 234370f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord */ 234470f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord if (IS_GEN_II(hpriv)) 234570f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord return mv_qc_issue_fis(qc); 234670f8b79cf3a2eb892a01271fdfbb1903c0c982a8Mark Lord } 234742ed893d8011264f9945c2f54055b47c298ac53eMark Lord return ata_sff_qc_issue(qc); 234831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 234931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 23508f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lordstatic struct ata_queued_cmd *mv_get_active_qc(struct ata_port *ap) 23518f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord{ 23528f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord struct mv_port_priv *pp = ap->private_data; 23538f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord struct ata_queued_cmd *qc; 23548f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord 23558f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord if (pp->pp_flags & MV_PP_FLAG_NCQ_EN) 23568f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord return NULL; 23578f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord qc = ata_qc_from_tag(ap, ap->link.active_tag); 23583e4ec3443f70fbe144799ccf0b1c3797f78d1715Tejun Heo if (qc && !(qc->tf.flags & ATA_TFLAG_POLLING)) 23593e4ec3443f70fbe144799ccf0b1c3797f78d1715Tejun Heo return qc; 23603e4ec3443f70fbe144799ccf0b1c3797f78d1715Tejun Heo return NULL; 23618f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord} 23628f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord 236329d187bb1e30682e228ce461c487d78d945c3e4fMark Lordstatic void mv_pmp_error_handler(struct ata_port *ap) 236429d187bb1e30682e228ce461c487d78d945c3e4fMark Lord{ 236529d187bb1e30682e228ce461c487d78d945c3e4fMark Lord unsigned int pmp, pmp_map; 236629d187bb1e30682e228ce461c487d78d945c3e4fMark Lord struct mv_port_priv *pp = ap->private_data; 236729d187bb1e30682e228ce461c487d78d945c3e4fMark Lord 236829d187bb1e30682e228ce461c487d78d945c3e4fMark Lord if (pp->pp_flags & MV_PP_FLAG_DELAYED_EH) { 236929d187bb1e30682e228ce461c487d78d945c3e4fMark Lord /* 237029d187bb1e30682e228ce461c487d78d945c3e4fMark Lord * Perform NCQ error analysis on failed PMPs 237129d187bb1e30682e228ce461c487d78d945c3e4fMark Lord * before we freeze the port entirely. 237229d187bb1e30682e228ce461c487d78d945c3e4fMark Lord * 237329d187bb1e30682e228ce461c487d78d945c3e4fMark Lord * The failed PMPs are marked earlier by mv_pmp_eh_prep(). 237429d187bb1e30682e228ce461c487d78d945c3e4fMark Lord */ 237529d187bb1e30682e228ce461c487d78d945c3e4fMark Lord pmp_map = pp->delayed_eh_pmp_map; 237629d187bb1e30682e228ce461c487d78d945c3e4fMark Lord pp->pp_flags &= ~MV_PP_FLAG_DELAYED_EH; 237729d187bb1e30682e228ce461c487d78d945c3e4fMark Lord for (pmp = 0; pmp_map != 0; pmp++) { 237829d187bb1e30682e228ce461c487d78d945c3e4fMark Lord unsigned int this_pmp = (1 << pmp); 237929d187bb1e30682e228ce461c487d78d945c3e4fMark Lord if (pmp_map & this_pmp) { 238029d187bb1e30682e228ce461c487d78d945c3e4fMark Lord struct ata_link *link = &ap->pmp_link[pmp]; 238129d187bb1e30682e228ce461c487d78d945c3e4fMark Lord pmp_map &= ~this_pmp; 238229d187bb1e30682e228ce461c487d78d945c3e4fMark Lord ata_eh_analyze_ncq_error(link); 238329d187bb1e30682e228ce461c487d78d945c3e4fMark Lord } 238429d187bb1e30682e228ce461c487d78d945c3e4fMark Lord } 238529d187bb1e30682e228ce461c487d78d945c3e4fMark Lord ata_port_freeze(ap); 238629d187bb1e30682e228ce461c487d78d945c3e4fMark Lord } 238729d187bb1e30682e228ce461c487d78d945c3e4fMark Lord sata_pmp_error_handler(ap); 238829d187bb1e30682e228ce461c487d78d945c3e4fMark Lord} 238929d187bb1e30682e228ce461c487d78d945c3e4fMark Lord 23904c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lordstatic unsigned int mv_get_err_pmp_map(struct ata_port *ap) 23914c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord{ 23924c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 23934c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 2394cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord return readl(port_mmio + SATA_TESTCTL) >> 16; 23954c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord} 23964c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 23974c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lordstatic void mv_pmp_eh_prep(struct ata_port *ap, unsigned int pmp_map) 23984c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord{ 23994c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord struct ata_eh_info *ehi; 24004c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord unsigned int pmp; 24014c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 24024c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord /* 24034c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * Initialize EH info for PMPs which saw device errors 24044c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord */ 24054c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ehi = &ap->link.eh_info; 24064c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord for (pmp = 0; pmp_map != 0; pmp++) { 24074c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord unsigned int this_pmp = (1 << pmp); 24084c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (pmp_map & this_pmp) { 24094c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord struct ata_link *link = &ap->pmp_link[pmp]; 24104c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 24114c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord pmp_map &= ~this_pmp; 24124c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ehi = &link->eh_info; 24134c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ata_ehi_clear_desc(ehi); 24144c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ata_ehi_push_desc(ehi, "dev err"); 24154c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ehi->err_mask |= AC_ERR_DEV; 24164c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ehi->action |= ATA_EH_RESET; 24174c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ata_link_abort(link); 24184c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord } 24194c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord } 24204c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord} 24214c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 242206aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lordstatic int mv_req_q_empty(struct ata_port *ap) 242306aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lord{ 242406aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 242506aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lord u32 in_ptr, out_ptr; 242606aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lord 2427cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord in_ptr = (readl(port_mmio + EDMA_REQ_Q_IN_PTR) 242806aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lord >> EDMA_REQ_Q_PTR_SHIFT) & MV_MAX_Q_DEPTH_MASK; 2429cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord out_ptr = (readl(port_mmio + EDMA_REQ_Q_OUT_PTR) 243006aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lord >> EDMA_REQ_Q_PTR_SHIFT) & MV_MAX_Q_DEPTH_MASK; 243106aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lord return (in_ptr == out_ptr); /* 1 == queue_is_empty */ 243206aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lord} 243306aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lord 24344c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lordstatic int mv_handle_fbs_ncq_dev_err(struct ata_port *ap) 24354c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord{ 24364c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord struct mv_port_priv *pp = ap->private_data; 24374c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord int failed_links; 24384c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord unsigned int old_map, new_map; 24394c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 24404c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord /* 24414c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * Device error during FBS+NCQ operation: 24424c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * 24434c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * Set a port flag to prevent further I/O being enqueued. 24444c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * Leave the EDMA running to drain outstanding commands from this port. 24454c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * Perform the post-mortem/EH only when all responses are complete. 24464c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * Follow recovery sequence from 6042/7042 datasheet (7.3.15.4.2.2). 24474c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord */ 24484c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (!(pp->pp_flags & MV_PP_FLAG_DELAYED_EH)) { 24494c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord pp->pp_flags |= MV_PP_FLAG_DELAYED_EH; 24504c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord pp->delayed_eh_pmp_map = 0; 24514c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord } 24524c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord old_map = pp->delayed_eh_pmp_map; 24534c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord new_map = old_map | mv_get_err_pmp_map(ap); 24544c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 24554c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (old_map != new_map) { 24564c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord pp->delayed_eh_pmp_map = new_map; 24574c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord mv_pmp_eh_prep(ap, new_map & ~old_map); 24584c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord } 2459c46938ccfe35a58a0873715ee4c26fc9eb8d87b3Mark Lord failed_links = hweight16(new_map); 24604c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 24614c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ata_port_printk(ap, KERN_INFO, "%s: pmp_map=%04x qc_map=%04x " 24624c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord "failed_links=%d nr_active_links=%d\n", 24634c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord __func__, pp->delayed_eh_pmp_map, 24644c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ap->qc_active, failed_links, 24654c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ap->nr_active_links); 24664c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 246706aaca3f6301d04463b1ee0eb75c0352147159f2Mark Lord if (ap->nr_active_links <= failed_links && mv_req_q_empty(ap)) { 24684c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord mv_process_crpb_entries(ap, pp); 24694c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord mv_stop_edma(ap); 24704c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord mv_eh_freeze(ap); 24714c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ata_port_printk(ap, KERN_INFO, "%s: done\n", __func__); 24724c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return 1; /* handled */ 24734c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord } 24744c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ata_port_printk(ap, KERN_INFO, "%s: waiting\n", __func__); 24754c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return 1; /* handled */ 24764c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord} 24774c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 24784c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lordstatic int mv_handle_fbs_non_ncq_dev_err(struct ata_port *ap) 24794c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord{ 24804c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord /* 24814c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * Possible future enhancement: 24824c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * 24834c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * FBS+non-NCQ operation is not yet implemented. 24844c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * See related notes in mv_edma_cfg(). 24854c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * 24864c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * Device error during FBS+non-NCQ operation: 24874c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * 24884c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * We need to snapshot the shadow registers for each failed command. 24894c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * Follow recovery sequence from 6042/7042 datasheet (7.3.15.4.2.3). 24904c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord */ 24914c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return 0; /* not handled */ 24924c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord} 24934c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 24944c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lordstatic int mv_handle_dev_err(struct ata_port *ap, u32 edma_err_cause) 24954c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord{ 24964c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord struct mv_port_priv *pp = ap->private_data; 24974c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 24984c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (!(pp->pp_flags & MV_PP_FLAG_EDMA_EN)) 24994c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return 0; /* EDMA was not active: not handled */ 25004c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (!(pp->pp_flags & MV_PP_FLAG_FBS_EN)) 25014c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return 0; /* FBS was not active: not handled */ 25024c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 25034c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (!(edma_err_cause & EDMA_ERR_DEV)) 25044c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return 0; /* non DEV error: not handled */ 25054c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord edma_err_cause &= ~EDMA_ERR_IRQ_TRANSIENT; 25064c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (edma_err_cause & ~(EDMA_ERR_DEV | EDMA_ERR_SELF_DIS)) 25074c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return 0; /* other problems: not handled */ 25084c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 25094c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (pp->pp_flags & MV_PP_FLAG_NCQ_EN) { 25104c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord /* 25114c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * EDMA should NOT have self-disabled for this case. 25124c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * If it did, then something is wrong elsewhere, 25134c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * and we cannot handle it here. 25144c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord */ 25154c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (edma_err_cause & EDMA_ERR_SELF_DIS) { 25164c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ata_port_printk(ap, KERN_WARNING, 25174c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord "%s: err_cause=0x%x pp_flags=0x%x\n", 25184c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord __func__, edma_err_cause, pp->pp_flags); 25194c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return 0; /* not handled */ 25204c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord } 25214c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return mv_handle_fbs_ncq_dev_err(ap); 25224c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord } else { 25234c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord /* 25244c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * EDMA should have self-disabled for this case. 25254c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * If it did not, then something is wrong elsewhere, 25264c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * and we cannot handle it here. 25274c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord */ 25284c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (!(edma_err_cause & EDMA_ERR_SELF_DIS)) { 25294c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord ata_port_printk(ap, KERN_WARNING, 25304c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord "%s: err_cause=0x%x pp_flags=0x%x\n", 25314c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord __func__, edma_err_cause, pp->pp_flags); 25324c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return 0; /* not handled */ 25334c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord } 25344c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return mv_handle_fbs_non_ncq_dev_err(ap); 25354c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord } 25364c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return 0; /* not handled */ 25374c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord} 25384c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 2539a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lordstatic void mv_unexpected_intr(struct ata_port *ap, int edma_was_enabled) 25408f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord{ 25418f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord struct ata_eh_info *ehi = &ap->link.eh_info; 2542a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord char *when = "idle"; 25438f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord 25448f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord ata_ehi_clear_desc(ehi); 25453e4ec3443f70fbe144799ccf0b1c3797f78d1715Tejun Heo if (edma_was_enabled) { 2546a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord when = "EDMA enabled"; 25478f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord } else { 25488f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord struct ata_queued_cmd *qc = ata_qc_from_tag(ap, ap->link.active_tag); 25498f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord if (qc && (qc->tf.flags & ATA_TFLAG_POLLING)) 2550a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord when = "polling"; 25518f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord } 2552a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord ata_ehi_push_desc(ehi, "unexpected device interrupt while %s", when); 25538f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord ehi->err_mask |= AC_ERR_OTHER; 25548f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord ehi->action |= ATA_EH_RESET; 25558f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord ata_port_freeze(ap); 25568f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord} 25578f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord 255805b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 255905b308e1df6d9d673daedb517969241f41278b52Brett Russ * mv_err_intr - Handle error interrupts on the port 256005b308e1df6d9d673daedb517969241f41278b52Brett Russ * @ap: ATA channel to manipulate 256105b308e1df6d9d673daedb517969241f41278b52Brett Russ * 25628d07379d251ab24d937e6cb0748b71106dddbc74Mark Lord * Most cases require a full reset of the chip's state machine, 25638d07379d251ab24d937e6cb0748b71106dddbc74Mark Lord * which also performs a COMRESET. 25648d07379d251ab24d937e6cb0748b71106dddbc74Mark Lord * Also, if the port disabled DMA, update our cached copy to match. 256505b308e1df6d9d673daedb517969241f41278b52Brett Russ * 256605b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 256705b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 256805b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 256937b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lordstatic void mv_err_intr(struct ata_port *ap) 257031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 257131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ void __iomem *port_mmio = mv_ap_base(ap); 2572bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik u32 edma_err_cause, eh_freeze_mask, serr = 0; 2573e40060772d85f3534d3d517197696e24bb01f45bMark Lord u32 fis_cause = 0; 2574bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik struct mv_port_priv *pp = ap->private_data; 2575bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik struct mv_host_priv *hpriv = ap->host->private_data; 2576bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik unsigned int action = 0, err_mask = 0; 25779af5c9c97dc9d599281778864c72b385f0c63341Tejun Heo struct ata_eh_info *ehi = &ap->link.eh_info; 257837b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord struct ata_queued_cmd *qc; 257937b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord int abort = 0; 258020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 25818d07379d251ab24d937e6cb0748b71106dddbc74Mark Lord /* 258237b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord * Read and clear the SError and err_cause bits. 2583e40060772d85f3534d3d517197696e24bb01f45bMark Lord * For GenIIe, if EDMA_ERR_TRANS_IRQ_7 is set, we also must read/clear 2584e40060772d85f3534d3d517197696e24bb01f45bMark Lord * the FIS_IRQ_CAUSE register before clearing edma_err_cause. 25858d07379d251ab24d937e6cb0748b71106dddbc74Mark Lord */ 258637b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord sata_scr_read(&ap->link, SCR_ERROR, &serr); 258737b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord sata_scr_write_flush(&ap->link, SCR_ERROR, serr); 258837b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord 2589cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord edma_err_cause = readl(port_mmio + EDMA_ERR_IRQ_CAUSE); 2590e40060772d85f3534d3d517197696e24bb01f45bMark Lord if (IS_GEN_IIE(hpriv) && (edma_err_cause & EDMA_ERR_TRANS_IRQ_7)) { 2591cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord fis_cause = readl(port_mmio + FIS_IRQ_CAUSE); 2592cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(~fis_cause, port_mmio + FIS_IRQ_CAUSE); 2593e40060772d85f3534d3d517197696e24bb01f45bMark Lord } 2594cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(~edma_err_cause, port_mmio + EDMA_ERR_IRQ_CAUSE); 2595bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 25964c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (edma_err_cause & EDMA_ERR_DEV) { 25974c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord /* 25984c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * Device errors during FIS-based switching operation 25994c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord * require special handling. 26004c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord */ 26014c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (mv_handle_dev_err(ap, edma_err_cause)) 26024c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord return; 26034c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord } 26044c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord 260537b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord qc = mv_get_active_qc(ap); 260637b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord ata_ehi_clear_desc(ehi); 260737b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord ata_ehi_push_desc(ehi, "edma_err_cause=%08x pp_flags=%08x", 260837b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord edma_err_cause, pp->pp_flags); 2609e40060772d85f3534d3d517197696e24bb01f45bMark Lord 2610c443c5002b24ff5d2f4efcc25a861f0cb835130aMark Lord if (IS_GEN_IIE(hpriv) && (edma_err_cause & EDMA_ERR_TRANS_IRQ_7)) { 2611e40060772d85f3534d3d517197696e24bb01f45bMark Lord ata_ehi_push_desc(ehi, "fis_cause=%08x", fis_cause); 2612cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord if (fis_cause & FIS_IRQ_CAUSE_AN) { 2613c443c5002b24ff5d2f4efcc25a861f0cb835130aMark Lord u32 ec = edma_err_cause & 2614c443c5002b24ff5d2f4efcc25a861f0cb835130aMark Lord ~(EDMA_ERR_TRANS_IRQ_7 | EDMA_ERR_IRQ_TRANSIENT); 2615c443c5002b24ff5d2f4efcc25a861f0cb835130aMark Lord sata_async_notification(ap); 2616c443c5002b24ff5d2f4efcc25a861f0cb835130aMark Lord if (!ec) 2617c443c5002b24ff5d2f4efcc25a861f0cb835130aMark Lord return; /* Just an AN; no need for the nukes */ 2618c443c5002b24ff5d2f4efcc25a861f0cb835130aMark Lord ata_ehi_push_desc(ehi, "SDB notify"); 2619c443c5002b24ff5d2f4efcc25a861f0cb835130aMark Lord } 2620c443c5002b24ff5d2f4efcc25a861f0cb835130aMark Lord } 2621bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik /* 2622352fab701ca4753dd005b67ce5e512be944eb591Mark Lord * All generations share these EDMA error cause bits: 2623bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik */ 262437b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord if (edma_err_cause & EDMA_ERR_DEV) { 2625bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik err_mask |= AC_ERR_DEV; 262637b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord action |= ATA_EH_RESET; 262737b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord ata_ehi_push_desc(ehi, "dev error"); 262837b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord } 2629bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik if (edma_err_cause & (EDMA_ERR_D_PAR | EDMA_ERR_PRD_PAR | 26306c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik EDMA_ERR_CRQB_PAR | EDMA_ERR_CRPB_PAR | 2631bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik EDMA_ERR_INTRL_PAR)) { 2632bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik err_mask |= AC_ERR_ATA_BUS; 2633cf48062658e7ab3bc55e10c65676c3c73c16f8bfTejun Heo action |= ATA_EH_RESET; 2634b64bbc39f2122a2276578e40144af69ef01decd4Tejun Heo ata_ehi_push_desc(ehi, "parity error"); 2635bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 2636bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik if (edma_err_cause & (EDMA_ERR_DEV_DCON | EDMA_ERR_DEV_CON)) { 2637bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ata_ehi_hotplugged(ehi); 2638bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ata_ehi_push_desc(ehi, edma_err_cause & EDMA_ERR_DEV_DCON ? 2639b64bbc39f2122a2276578e40144af69ef01decd4Tejun Heo "dev disconnect" : "dev connect"); 2640cf48062658e7ab3bc55e10c65676c3c73c16f8bfTejun Heo action |= ATA_EH_RESET; 2641bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 2642bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2643352fab701ca4753dd005b67ce5e512be944eb591Mark Lord /* 2644352fab701ca4753dd005b67ce5e512be944eb591Mark Lord * Gen-I has a different SELF_DIS bit, 2645352fab701ca4753dd005b67ce5e512be944eb591Mark Lord * different FREEZE bits, and no SERR bit: 2646352fab701ca4753dd005b67ce5e512be944eb591Mark Lord */ 2647ee9ccdf70163ca6408f6965e0fbc65baeac7312cJeff Garzik if (IS_GEN_I(hpriv)) { 2648bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik eh_freeze_mask = EDMA_EH_FREEZE_5; 2649bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik if (edma_err_cause & EDMA_ERR_SELF_DIS_5) { 2650bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik pp->pp_flags &= ~MV_PP_FLAG_EDMA_EN; 2651b64bbc39f2122a2276578e40144af69ef01decd4Tejun Heo ata_ehi_push_desc(ehi, "EDMA self-disable"); 2652bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 2653bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } else { 2654bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik eh_freeze_mask = EDMA_EH_FREEZE; 2655bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik if (edma_err_cause & EDMA_ERR_SELF_DIS) { 2656bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik pp->pp_flags &= ~MV_PP_FLAG_EDMA_EN; 2657b64bbc39f2122a2276578e40144af69ef01decd4Tejun Heo ata_ehi_push_desc(ehi, "EDMA self-disable"); 2658bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 2659bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik if (edma_err_cause & EDMA_ERR_SERR) { 26608d07379d251ab24d937e6cb0748b71106dddbc74Mark Lord ata_ehi_push_desc(ehi, "SError=%08x", serr); 26618d07379d251ab24d937e6cb0748b71106dddbc74Mark Lord err_mask |= AC_ERR_ATA_BUS; 2662cf48062658e7ab3bc55e10c65676c3c73c16f8bfTejun Heo action |= ATA_EH_RESET; 2663bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 2664afb0edd922c7ed6e73678730921dfcccebec17e8Brett Russ } 266520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 2666bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik if (!err_mask) { 2667bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik err_mask = AC_ERR_OTHER; 2668cf48062658e7ab3bc55e10c65676c3c73c16f8bfTejun Heo action |= ATA_EH_RESET; 2669bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 2670bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2671bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ehi->serror |= serr; 2672bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ehi->action |= action; 2673bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2674bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik if (qc) 2675bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik qc->err_mask |= err_mask; 2676bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik else 2677bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ehi->err_mask |= err_mask; 2678bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 267937b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord if (err_mask == AC_ERR_DEV) { 268037b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord /* 268137b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord * Cannot do ata_port_freeze() here, 268237b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord * because it would kill PIO access, 268337b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord * which is needed for further diagnosis. 268437b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord */ 268537b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord mv_eh_freeze(ap); 268637b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord abort = 1; 268737b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord } else if (edma_err_cause & eh_freeze_mask) { 268837b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord /* 268937b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord * Note to self: ata_port_freeze() calls ata_port_abort() 269037b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord */ 2691bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ata_port_freeze(ap); 269237b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord } else { 269337b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord abort = 1; 269437b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord } 269537b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord 269637b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord if (abort) { 269737b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord if (qc) 269837b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord ata_link_abort(qc->dev->link); 269937b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord else 270037b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord ata_port_abort(ap); 270137b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord } 2702bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik} 2703bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2704fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lordstatic void mv_process_crpb_response(struct ata_port *ap, 2705fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord struct mv_crpb *response, unsigned int tag, int ncq_enabled) 2706fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord{ 2707fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord struct ata_queued_cmd *qc = ata_qc_from_tag(ap, tag); 2708fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord 2709fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord if (qc) { 2710fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord u8 ata_status; 2711fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord u16 edma_status = le16_to_cpu(response->flags); 2712fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord /* 2713fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord * edma_status from a response queue entry: 2714cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord * LSB is from EDMA_ERR_IRQ_CAUSE (non-NCQ only). 2715fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord * MSB is saved ATA status from command completion. 2716fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord */ 2717fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord if (!ncq_enabled) { 2718fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord u8 err_cause = edma_status & 0xff & ~EDMA_ERR_DEV; 2719fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord if (err_cause) { 2720fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord /* 2721fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord * Error will be seen/handled by mv_err_intr(). 2722fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord * So do nothing at all here. 2723fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord */ 2724fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord return; 2725fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord } 2726fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord } 2727fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord ata_status = edma_status >> CRPB_FLAG_STATUS_SHIFT; 272837b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord if (!ac_err_mask(ata_status)) 272937b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord ata_qc_complete(qc); 273037b9046a3e433a0b0c39ad1e81ec187d5be800baMark Lord /* else: leave it for mv_err_intr() */ 2731fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord } else { 2732fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord ata_port_printk(ap, KERN_ERR, "%s: no qc for tag=%d\n", 2733fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord __func__, tag); 2734fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord } 2735fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord} 2736fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord 2737fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lordstatic void mv_process_crpb_entries(struct ata_port *ap, struct mv_port_priv *pp) 2738bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik{ 2739bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik void __iomem *port_mmio = mv_ap_base(ap); 2740bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik struct mv_host_priv *hpriv = ap->host->private_data; 2741fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord u32 in_index; 2742bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik bool work_done = false; 2743fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord int ncq_enabled = (pp->pp_flags & MV_PP_FLAG_NCQ_EN); 2744bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2745fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord /* Get the hardware queue position index */ 2746cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord in_index = (readl(port_mmio + EDMA_RSP_Q_IN_PTR) 2747bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik >> EDMA_RSP_Q_PTR_SHIFT) & MV_MAX_Q_DEPTH_MASK; 2748bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2749fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord /* Process new responses from since the last time we looked */ 2750fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord while (in_index != pp->resp_idx) { 27516c1153e00af8de755ec278d873a97c9ce2a72d10Jeff Garzik unsigned int tag; 2752fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord struct mv_crpb *response = &pp->crpb[pp->resp_idx]; 2753bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2754fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord pp->resp_idx = (pp->resp_idx + 1) & MV_MAX_Q_DEPTH_MASK; 2755bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2756fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord if (IS_GEN_I(hpriv)) { 2757fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord /* 50xx: no NCQ, only one command active at a time */ 27589af5c9c97dc9d599281778864c72b385f0c63341Tejun Heo tag = ap->link.active_tag; 2759fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord } else { 2760fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord /* Gen II/IIE: get command tag from CRPB entry */ 2761fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord tag = le16_to_cpu(response->id) & 0x1f; 2762bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 2763fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord mv_process_crpb_response(ap, response, tag, ncq_enabled); 2764bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik work_done = true; 2765bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 2766bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2767352fab701ca4753dd005b67ce5e512be944eb591Mark Lord /* Update the software queue position index in hardware */ 2768bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik if (work_done) 2769bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik writelfl((pp->crpb_dma & EDMA_RSP_Q_BASE_LO_MASK) | 2770fcfb1f77cea81f74d865b4d33f2e452ffa1973e8Mark Lord (pp->resp_idx << EDMA_RSP_Q_PTR_SHIFT), 2771cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord port_mmio + EDMA_RSP_Q_OUT_PTR); 277220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 277320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 2774a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lordstatic void mv_port_intr(struct ata_port *ap, u32 port_cause) 2775a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord{ 2776a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord struct mv_port_priv *pp; 2777a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord int edma_was_enabled; 2778a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord 2779a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord /* 2780a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord * Grab a snapshot of the EDMA_EN flag setting, 2781a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord * so that we have a consistent view for this port, 2782a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord * even if something we call of our routines changes it. 2783a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord */ 2784a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord pp = ap->private_data; 2785a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord edma_was_enabled = (pp->pp_flags & MV_PP_FLAG_EDMA_EN); 2786a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord /* 2787a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord * Process completed CRPB response(s) before other events. 2788a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord */ 2789a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord if (edma_was_enabled && (port_cause & DONE_IRQ)) { 2790a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord mv_process_crpb_entries(ap, pp); 27914c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord if (pp->pp_flags & MV_PP_FLAG_DELAYED_EH) 27924c299ca3649ccf666819e7d4a27a68c39fa174f1Mark Lord mv_handle_fbs_ncq_dev_err(ap); 2793a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord } 2794a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord /* 2795a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord * Handle chip-reported errors, or continue on to handle PIO. 2796a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord */ 2797a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord if (unlikely(port_cause & ERR_IRQ)) { 2798a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord mv_err_intr(ap); 2799a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord } else if (!edma_was_enabled) { 2800a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord struct ata_queued_cmd *qc = mv_get_active_qc(ap); 2801a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord if (qc) 2802a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord ata_sff_host_intr(ap, qc); 2803a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord else 2804a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord mv_unexpected_intr(ap, edma_was_enabled); 2805a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord } 2806a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord} 2807a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord 280805b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 280905b308e1df6d9d673daedb517969241f41278b52Brett Russ * mv_host_intr - Handle all interrupts on the given host controller 2810cca3974e48607c3775dc73b544a5700b2e37c21aJeff Garzik * @host: host specific structure 28117368f91926a2870a8c3f9546d86535ce71ae0757Mark Lord * @main_irq_cause: Main interrupt cause register for the chip. 281205b308e1df6d9d673daedb517969241f41278b52Brett Russ * 281305b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 281405b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 281505b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 28167368f91926a2870a8c3f9546d86535ce71ae0757Mark Lordstatic int mv_host_intr(struct ata_host *host, u32 main_irq_cause) 281720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 2818f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara struct mv_host_priv *hpriv = host->private_data; 2819eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord void __iomem *mmio = hpriv->base, *hc_mmio; 2820a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord unsigned int handled = 0, port; 282120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 28222b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord /* If asserted, clear the "all ports" IRQ coalescing bit */ 28232b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord if (main_irq_cause & ALL_PORTS_COAL_DONE) 2824cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(~ALL_PORTS_COAL_IRQ, mmio + IRQ_COAL_CAUSE); 28252b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord 2826a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord for (port = 0; port < hpriv->n_ports; port++) { 2827cca3974e48607c3775dc73b544a5700b2e37c21aJeff Garzik struct ata_port *ap = host->ports[port]; 2828eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord unsigned int p, shift, hardport, port_cause; 2829eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord 2830a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord MV_PORT_TO_SHIFT_AND_HARDPORT(port, shift, hardport); 2831a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord /* 2832eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * Each hc within the host has its own hc_irq_cause register, 2833eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * where the interrupting ports bits get ack'd. 2834a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord */ 2835eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord if (hardport == 0) { /* first port on this hc ? */ 2836eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord u32 hc_cause = (main_irq_cause >> shift) & HC0_IRQ_PEND; 2837eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord u32 port_mask, ack_irqs; 2838eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord /* 2839eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * Skip this entire hc if nothing pending for any ports 2840eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord */ 2841eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord if (!hc_cause) { 2842eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord port += MV_PORTS_PER_HC - 1; 2843eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord continue; 2844eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord } 2845eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord /* 2846eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * We don't need/want to read the hc_irq_cause register, 2847eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * because doing so hurts performance, and 2848eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * main_irq_cause already gives us everything we need. 2849eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * 2850eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * But we do have to *write* to the hc_irq_cause to ack 2851eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * the ports that we are handling this time through. 2852eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * 2853eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * This requires that we create a bitmap for those 2854eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * ports which interrupted us, and use that bitmap 2855eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord * to ack (only) those ports via hc_irq_cause. 2856eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord */ 2857eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord ack_irqs = 0; 28582b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord if (hc_cause & PORTS_0_3_COAL_DONE) 28592b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord ack_irqs = HC_COAL_IRQ; 2860eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord for (p = 0; p < MV_PORTS_PER_HC; ++p) { 2861eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord if ((port + p) >= hpriv->n_ports) 2862eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord break; 2863eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord port_mask = (DONE_IRQ | ERR_IRQ) << (p * 2); 2864eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord if (hc_cause & port_mask) 2865eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord ack_irqs |= (DMA_IRQ | DEV_IRQ) << p; 2866eabd5eb1cb59bfb162e7aa23007248f2bb480816Mark Lord } 2867a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord hc_mmio = mv_hc_base_from_port(mmio, port); 2868cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(~ack_irqs, hc_mmio + HC_IRQ_CAUSE); 2869a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord handled = 1; 2870a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord } 28718f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord /* 2872a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord * Handle interrupts signalled for this port: 28738f767f8a02e6c65d393fd0f2ca19a91c9898cc2dMark Lord */ 2874a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord port_cause = (main_irq_cause >> shift) & (DONE_IRQ | ERR_IRQ); 2875a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord if (port_cause) 2876a90103298fd5ccd9a9df6d47bde9a3f371707037Mark Lord mv_port_intr(ap, port_cause); 287720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ } 2878a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord return handled; 287920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 288020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 2881a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lordstatic int mv_pci_error(struct ata_host *host, void __iomem *mmio) 2882bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik{ 288302a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord struct mv_host_priv *hpriv = host->private_data; 2884bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik struct ata_port *ap; 2885bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik struct ata_queued_cmd *qc; 2886bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik struct ata_eh_info *ehi; 2887bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik unsigned int i, err_mask, printed = 0; 2888bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik u32 err_cause; 2889bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2890cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord err_cause = readl(mmio + hpriv->irq_cause_offset); 2891bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2892bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik dev_printk(KERN_ERR, host->dev, "PCI ERROR; PCI IRQ cause=0x%08x\n", 2893bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik err_cause); 2894bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2895bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik DPRINTK("All regs @ PCI error\n"); 2896bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik mv_dump_all_regs(mmio, -1, to_pci_dev(host->dev)); 2897bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2898cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(0, mmio + hpriv->irq_cause_offset); 2899bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2900bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik for (i = 0; i < host->n_ports; i++) { 2901bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ap = host->ports[i]; 2902936fd7328657884d5a69a55666c74a55aa83ca27Tejun Heo if (!ata_link_offline(&ap->link)) { 29039af5c9c97dc9d599281778864c72b385f0c63341Tejun Heo ehi = &ap->link.eh_info; 2904bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ata_ehi_clear_desc(ehi); 2905bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik if (!printed++) 2906bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ata_ehi_push_desc(ehi, 2907bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik "PCI err cause 0x%08x", err_cause); 2908bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik err_mask = AC_ERR_HOST_BUS; 2909cf48062658e7ab3bc55e10c65676c3c73c16f8bfTejun Heo ehi->action = ATA_EH_RESET; 29109af5c9c97dc9d599281778864c72b385f0c63341Tejun Heo qc = ata_qc_from_tag(ap, ap->link.active_tag); 2911bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik if (qc) 2912bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik qc->err_mask |= err_mask; 2913bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik else 2914bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ehi->err_mask |= err_mask; 2915bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 2916bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik ata_port_freeze(ap); 2917bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 2918bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 2919a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord return 1; /* handled */ 2920bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik} 2921bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 292205b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 2923c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik * mv_interrupt - Main interrupt event handler 292405b308e1df6d9d673daedb517969241f41278b52Brett Russ * @irq: unused 292505b308e1df6d9d673daedb517969241f41278b52Brett Russ * @dev_instance: private data; in this case the host structure 292605b308e1df6d9d673daedb517969241f41278b52Brett Russ * 292705b308e1df6d9d673daedb517969241f41278b52Brett Russ * Read the read only register to determine if any host 292805b308e1df6d9d673daedb517969241f41278b52Brett Russ * controllers have pending interrupts. If so, call lower level 292905b308e1df6d9d673daedb517969241f41278b52Brett Russ * routine to handle. Also check for PCI errors which are only 293005b308e1df6d9d673daedb517969241f41278b52Brett Russ * reported here. 293105b308e1df6d9d673daedb517969241f41278b52Brett Russ * 29328b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik * LOCKING: 2933cca3974e48607c3775dc73b544a5700b2e37c21aJeff Garzik * This routine holds the host lock while processing pending 293405b308e1df6d9d673daedb517969241f41278b52Brett Russ * interrupts. 293505b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 29367d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t mv_interrupt(int irq, void *dev_instance) 293720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 2938cca3974e48607c3775dc73b544a5700b2e37c21aJeff Garzik struct ata_host *host = dev_instance; 2939f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara struct mv_host_priv *hpriv = host->private_data; 2940a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord unsigned int handled = 0; 29416d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord int using_msi = hpriv->hp_flags & MV_HP_FLAG_MSI; 294296e2c487933e5f69e98fffdcae2c35c78a671c07Mark Lord u32 main_irq_cause, pending_irqs; 294320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 2944646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord spin_lock(&host->lock); 29456d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord 29466d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord /* for MSI: block new interrupts while in here */ 29476d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord if (using_msi) 29482b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord mv_write_main_irq_mask(0, hpriv); 29496d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord 29507368f91926a2870a8c3f9546d86535ce71ae0757Mark Lord main_irq_cause = readl(hpriv->main_irq_cause_addr); 295196e2c487933e5f69e98fffdcae2c35c78a671c07Mark Lord pending_irqs = main_irq_cause & hpriv->main_irq_mask; 2952352fab701ca4753dd005b67ce5e512be944eb591Mark Lord /* 2953352fab701ca4753dd005b67ce5e512be944eb591Mark Lord * Deal with cases where we either have nothing pending, or have read 2954352fab701ca4753dd005b67ce5e512be944eb591Mark Lord * a bogus register value which can indicate HW removal or PCI fault. 295520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ */ 2956a44253d24a97ec3efe601267274a5fb64d8696c1Mark Lord if (pending_irqs && main_irq_cause != 0xffffffffU) { 29571f39847255a02c69190ae30c33b8ccf4c10840dfMark Lord if (unlikely((pending_irqs & PCI_ERR) && !IS_SOC(hpriv))) 2958a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord handled = mv_pci_error(host, hpriv->base); 2959a3718c1f230240361ed92d3e53342df0ff7efa8cMark Lord else 2960a44253d24a97ec3efe601267274a5fb64d8696c1Mark Lord handled = mv_host_intr(host, pending_irqs); 2961bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik } 29626d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord 29636d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord /* for MSI: unmask; interrupt cause bits will retrigger now */ 29646d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord if (using_msi) 29652b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord mv_write_main_irq_mask(hpriv->main_irq_mask, hpriv); 29666d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord 29679d51af7bd2f1d730cb6eeeb9ff837e3441ad4e07Mark Lord spin_unlock(&host->lock); 29689d51af7bd2f1d730cb6eeeb9ff837e3441ad4e07Mark Lord 296920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ return IRQ_RETVAL(handled); 297020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 297120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 2972c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic unsigned int mv5_scr_offset(unsigned int sc_reg_in) 2973c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik{ 2974c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int ofs; 2975c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 2976c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik switch (sc_reg_in) { 2977c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik case SCR_STATUS: 2978c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik case SCR_ERROR: 2979c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik case SCR_CONTROL: 2980c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ofs = sc_reg_in * sizeof(u32); 2981c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik break; 2982c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik default: 2983c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ofs = 0xffffffffU; 2984c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik break; 2985c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik } 2986c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik return ofs; 2987c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik} 2988c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 298982ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heostatic int mv5_scr_read(struct ata_link *link, unsigned int sc_reg_in, u32 *val) 2990c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik{ 299182ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heo struct mv_host_priv *hpriv = link->ap->host->private_data; 2992f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio = hpriv->base; 299382ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heo void __iomem *addr = mv5_phy_base(mmio, link->ap->port_no); 2994c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int ofs = mv5_scr_offset(sc_reg_in); 2995c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 2996da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo if (ofs != 0xffffffffU) { 2997da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo *val = readl(addr + ofs); 2998da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo return 0; 2999da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo } else 3000da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo return -EINVAL; 3001c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik} 3002c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 300382ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heostatic int mv5_scr_write(struct ata_link *link, unsigned int sc_reg_in, u32 val) 3004c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik{ 300582ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heo struct mv_host_priv *hpriv = link->ap->host->private_data; 3006f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio = hpriv->base; 300782ef04fb4c82542b3eda81cca461f0594ce9cd0bTejun Heo void __iomem *addr = mv5_phy_base(mmio, link->ap->port_no); 3008c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int ofs = mv5_scr_offset(sc_reg_in); 3009c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3010da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo if (ofs != 0xffffffffU) { 30110d5ff566779f894ca9937231a181eb31e4adff0eTejun Heo writelfl(val, addr + ofs); 3012da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo return 0; 3013da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo } else 3014da3dbb17a0e9a9ec7f5aed95f1fddadb790edc9dTejun Heo return -EINVAL; 3015c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik} 3016c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 30177bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bisharastatic void mv5_reset_bus(struct ata_host *host, void __iomem *mmio) 3018522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik{ 30197bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara struct pci_dev *pdev = to_pci_dev(host->dev); 3020522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik int early_5080; 3021522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik 302244c10138fd4bbc4b6d6bff0873c24902f2a9da65Auke Kok early_5080 = (pdev->device == 0x5080) && (pdev->revision == 0); 3023522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik 3024522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik if (!early_5080) { 3025522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik u32 tmp = readl(mmio + MV_PCI_EXP_ROM_BAR_CTL); 3026522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik tmp |= (1 << 0); 3027522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik writel(tmp, mmio + MV_PCI_EXP_ROM_BAR_CTL); 3028522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik } 3029522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik 30307bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara mv_reset_pci_bus(host, mmio); 3031522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik} 3032522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik 3033522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzikstatic void mv5_reset_flash(struct mv_host_priv *hpriv, void __iomem *mmio) 3034522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik{ 3035cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(0x0fcfffff, mmio + FLASH_CTL); 3036522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik} 3037522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik 303847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstatic void mv5_read_preamp(struct mv_host_priv *hpriv, int idx, 3039ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik void __iomem *mmio) 3040ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik{ 3041c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik void __iomem *phy_mmio = mv5_phy_base(mmio, idx); 3042c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik u32 tmp; 3043c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3044c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp = readl(phy_mmio + MV5_PHY_MODE); 3045c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3046c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik hpriv->signal[idx].pre = tmp & 0x1800; /* bits 12:11 */ 3047c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik hpriv->signal[idx].amps = tmp & 0xe0; /* bits 7:5 */ 3048ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik} 3049ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik 305047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstatic void mv5_enable_leds(struct mv_host_priv *hpriv, void __iomem *mmio) 3051ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik{ 3052522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik u32 tmp; 3053522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik 3054cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(0, mmio + GPIO_PORT_CTL); 3055522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik 3056522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik /* FIXME: handle MV_HP_ERRATA_50XXB2 errata */ 3057522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik 3058522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik tmp = readl(mmio + MV_PCI_EXP_ROM_BAR_CTL); 3059522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik tmp |= ~(1 << 0); 3060522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik writel(tmp, mmio + MV_PCI_EXP_ROM_BAR_CTL); 3061ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik} 3062ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik 30632a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzikstatic void mv5_phy_errata(struct mv_host_priv *hpriv, void __iomem *mmio, 30642a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzik unsigned int port) 3065bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik{ 3066c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik void __iomem *phy_mmio = mv5_phy_base(mmio, port); 3067c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik const u32 mask = (1<<12) | (1<<11) | (1<<7) | (1<<6) | (1<<5); 3068c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik u32 tmp; 3069c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik int fix_apm_sq = (hpriv->hp_flags & MV_HP_ERRATA_50XXB0); 3070c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3071c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik if (fix_apm_sq) { 3072cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord tmp = readl(phy_mmio + MV5_LTMODE); 3073c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp |= (1 << 19); 3074cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(tmp, phy_mmio + MV5_LTMODE); 3075c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3076cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord tmp = readl(phy_mmio + MV5_PHY_CTL); 3077c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp &= ~0x3; 3078c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp |= 0x1; 3079cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(tmp, phy_mmio + MV5_PHY_CTL); 3080c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik } 3081c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3082c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp = readl(phy_mmio + MV5_PHY_MODE); 3083c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp &= ~mask; 3084c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp |= hpriv->signal[port].pre; 3085c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp |= hpriv->signal[port].amps; 3086c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik writel(tmp, phy_mmio + MV5_PHY_MODE); 3087bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik} 3088bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 3089c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3090c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik#undef ZERO 3091c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik#define ZERO(reg) writel(0, port_mmio + (reg)) 3092c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic void mv5_reset_hc_port(struct mv_host_priv *hpriv, void __iomem *mmio, 3093c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int port) 3094c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik{ 3095c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik void __iomem *port_mmio = mv_port_base(mmio, port); 3096c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3097e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord mv_reset_channel(hpriv, mmio, port); 3098c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3099c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x028); /* command */ 3100cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(0x11f, port_mmio + EDMA_CFG); 3101c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x004); /* timer */ 3102c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x008); /* irq err cause */ 3103c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x00c); /* irq err mask */ 3104c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x010); /* rq bah */ 3105c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x014); /* rq inp */ 3106c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x018); /* rq outp */ 3107c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x01c); /* respq bah */ 3108c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x024); /* respq outp */ 3109c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x020); /* respq inp */ 3110c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x02c); /* test control */ 3111cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(0xbc, port_mmio + EDMA_IORDY_TMOUT); 3112c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik} 3113c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik#undef ZERO 3114c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3115c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik#define ZERO(reg) writel(0, hc_mmio + (reg)) 3116c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic void mv5_reset_one_hc(struct mv_host_priv *hpriv, void __iomem *mmio, 3117c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int hc) 311847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik{ 3119c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik void __iomem *hc_mmio = mv_hc_base(mmio, hc); 3120c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik u32 tmp; 3121c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3122c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x00c); 3123c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x010); 3124c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x014); 3125c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik ZERO(0x018); 3126c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3127c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp = readl(hc_mmio + 0x20); 3128c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp &= 0x1c1c1c1c; 3129c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik tmp |= 0x03030303; 3130c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik writel(tmp, hc_mmio + 0x20); 3131c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik} 3132c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik#undef ZERO 3133c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3134c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic int mv5_reset_hc(struct mv_host_priv *hpriv, void __iomem *mmio, 3135c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int n_hc) 3136c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik{ 3137c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int hc, port; 3138c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3139c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik for (hc = 0; hc < n_hc; hc++) { 3140c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik for (port = 0; port < MV_PORTS_PER_HC; port++) 3141c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik mv5_reset_hc_port(hpriv, mmio, 3142c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik (hc * MV_PORTS_PER_HC) + port); 3143c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3144c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik mv5_reset_one_hc(hpriv, mmio, hc); 3145c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik } 3146c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3147c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik return 0; 314847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik} 314947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 3150101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik#undef ZERO 3151101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik#define ZERO(reg) writel(0, mmio + (reg)) 31527bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bisharastatic void mv_reset_pci_bus(struct ata_host *host, void __iomem *mmio) 3153101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik{ 315402a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord struct mv_host_priv *hpriv = host->private_data; 3155101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik u32 tmp; 3156101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3157cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord tmp = readl(mmio + MV_PCI_MODE); 3158101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik tmp &= 0xff00ffff; 3159cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(tmp, mmio + MV_PCI_MODE); 3160101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3161101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik ZERO(MV_PCI_DISC_TIMER); 3162101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik ZERO(MV_PCI_MSI_TRIGGER); 3163cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(0x000100ff, mmio + MV_PCI_XBAR_TMOUT); 3164101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik ZERO(MV_PCI_SERR_MASK); 3165cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord ZERO(hpriv->irq_cause_offset); 3166cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord ZERO(hpriv->irq_mask_offset); 3167101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik ZERO(MV_PCI_ERR_LOW_ADDRESS); 3168101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik ZERO(MV_PCI_ERR_HIGH_ADDRESS); 3169101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik ZERO(MV_PCI_ERR_ATTRIBUTE); 3170101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik ZERO(MV_PCI_ERR_COMMAND); 3171101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik} 3172101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik#undef ZERO 3173101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3174101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzikstatic void mv6_reset_flash(struct mv_host_priv *hpriv, void __iomem *mmio) 3175101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik{ 3176101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik u32 tmp; 3177101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3178101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik mv5_reset_flash(hpriv, mmio); 3179101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3180cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord tmp = readl(mmio + GPIO_PORT_CTL); 3181101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik tmp &= 0x3; 3182101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik tmp |= (1 << 5) | (1 << 6); 3183cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(tmp, mmio + GPIO_PORT_CTL); 3184101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik} 3185101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3186101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik/** 3187101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik * mv6_reset_hc - Perform the 6xxx global soft reset 3188101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik * @mmio: base address of the HBA 3189101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik * 3190101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik * This routine only applies to 6xxx parts. 3191101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik * 3192101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik * LOCKING: 3193101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik * Inherited from caller. 3194101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik */ 3195c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic int mv6_reset_hc(struct mv_host_priv *hpriv, void __iomem *mmio, 3196c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int n_hc) 3197101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik{ 3198cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord void __iomem *reg = mmio + PCI_MAIN_CMD_STS; 3199101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik int i, rc = 0; 3200101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik u32 t; 3201101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3202101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik /* Following procedure defined in PCI "main command and status 3203101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik * register" table. 3204101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik */ 3205101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik t = readl(reg); 3206101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik writel(t | STOP_PCI_MASTER, reg); 3207101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3208101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik for (i = 0; i < 1000; i++) { 3209101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik udelay(1); 3210101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik t = readl(reg); 32112dcb407e61458ded17503d6bd12b8c064965368bJeff Garzik if (PCI_MASTER_EMPTY & t) 3212101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik break; 3213101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik } 3214101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik if (!(PCI_MASTER_EMPTY & t)) { 3215101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik printk(KERN_ERR DRV_NAME ": PCI master won't flush\n"); 3216101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik rc = 1; 3217101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik goto done; 3218101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik } 3219101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3220101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik /* set reset */ 3221101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik i = 5; 3222101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik do { 3223101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik writel(t | GLOB_SFT_RST, reg); 3224101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik t = readl(reg); 3225101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik udelay(1); 3226101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik } while (!(GLOB_SFT_RST & t) && (i-- > 0)); 3227101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3228101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik if (!(GLOB_SFT_RST & t)) { 3229101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik printk(KERN_ERR DRV_NAME ": can't set global reset\n"); 3230101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik rc = 1; 3231101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik goto done; 3232101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik } 3233101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3234101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik /* clear reset and *reenable the PCI master* (not mentioned in spec) */ 3235101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik i = 5; 3236101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik do { 3237101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik writel(t & ~(GLOB_SFT_RST | STOP_PCI_MASTER), reg); 3238101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik t = readl(reg); 3239101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik udelay(1); 3240101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik } while ((GLOB_SFT_RST & t) && (i-- > 0)); 3241101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 3242101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik if (GLOB_SFT_RST & t) { 3243101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik printk(KERN_ERR DRV_NAME ": can't clear global reset\n"); 3244101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik rc = 1; 3245101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik } 3246101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzikdone: 3247101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik return rc; 3248101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik} 3249101ffae26c23ea928fce6d31a8b4901327d91a15Jeff Garzik 325047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstatic void mv6_read_preamp(struct mv_host_priv *hpriv, int idx, 3251ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik void __iomem *mmio) 3252ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik{ 3253ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik void __iomem *port_mmio; 3254ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik u32 tmp; 3255ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik 3256cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord tmp = readl(mmio + RESET_CFG); 3257ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik if ((tmp & (1 << 0)) == 0) { 325847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hpriv->signal[idx].amps = 0x7 << 8; 3259ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik hpriv->signal[idx].pre = 0x1 << 5; 3260ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik return; 3261ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik } 3262ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik 3263ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik port_mmio = mv_port_base(mmio, idx); 3264ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik tmp = readl(port_mmio + PHY_MODE2); 3265ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik 3266ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik hpriv->signal[idx].amps = tmp & 0x700; /* bits 10:8 */ 3267ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik hpriv->signal[idx].pre = tmp & 0xe0; /* bits 7:5 */ 3268ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik} 3269ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik 327047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzikstatic void mv6_enable_leds(struct mv_host_priv *hpriv, void __iomem *mmio) 3271ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik{ 3272cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(0x00000060, mmio + GPIO_PORT_CTL); 3273ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik} 3274ba3fe8fb6a469390a14379519915f3c39a973d99Jeff Garzik 3275c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzikstatic void mv6_phy_errata(struct mv_host_priv *hpriv, void __iomem *mmio, 32762a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzik unsigned int port) 3277bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik{ 3278c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik void __iomem *port_mmio = mv_port_base(mmio, port); 3279c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3280bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik u32 hp_flags = hpriv->hp_flags; 328147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik int fix_phy_mode2 = 328247c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags & (MV_HP_ERRATA_60X1B2 | MV_HP_ERRATA_60X1C0); 3283bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik int fix_phy_mode4 = 328447c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags & (MV_HP_ERRATA_60X1B2 | MV_HP_ERRATA_60X1C0); 32858c30a8b9b574cf6c51e207464b852a6f559da153Mark Lord u32 m2, m3; 328647c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 328747c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik if (fix_phy_mode2) { 328847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik m2 = readl(port_mmio + PHY_MODE2); 328947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik m2 &= ~(1 << 16); 329047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik m2 |= (1 << 31); 329147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik writel(m2, port_mmio + PHY_MODE2); 329247c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 329347c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik udelay(200); 329447c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 329547c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik m2 = readl(port_mmio + PHY_MODE2); 329647c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik m2 &= ~((1 << 16) | (1 << 31)); 329747c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik writel(m2, port_mmio + PHY_MODE2); 329847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 329947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik udelay(200); 330047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik } 330147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 33028c30a8b9b574cf6c51e207464b852a6f559da153Mark Lord /* 33038c30a8b9b574cf6c51e207464b852a6f559da153Mark Lord * Gen-II/IIe PHY_MODE3 errata RM#2: 33048c30a8b9b574cf6c51e207464b852a6f559da153Mark Lord * Achieves better receiver noise performance than the h/w default: 33058c30a8b9b574cf6c51e207464b852a6f559da153Mark Lord */ 33068c30a8b9b574cf6c51e207464b852a6f559da153Mark Lord m3 = readl(port_mmio + PHY_MODE3); 33078c30a8b9b574cf6c51e207464b852a6f559da153Mark Lord m3 = (m3 & 0x1f) | (0x5555601 << 5); 3308bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 33090388a8c0d54aa039758a8eca68d82325a563f8dbMark Lord /* Guideline 88F5182 (GL# SATA-S11) */ 33100388a8c0d54aa039758a8eca68d82325a563f8dbMark Lord if (IS_SOC(hpriv)) 33110388a8c0d54aa039758a8eca68d82325a563f8dbMark Lord m3 &= ~0x1c; 33120388a8c0d54aa039758a8eca68d82325a563f8dbMark Lord 3313bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik if (fix_phy_mode4) { 3314ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord u32 m4 = readl(port_mmio + PHY_MODE4); 3315ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord /* 3316ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord * Enforce reserved-bit restrictions on GenIIe devices only. 3317ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord * For earlier chipsets, force only the internal config field 3318ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord * (workaround for errata FEr SATA#10 part 1). 3319ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord */ 33208c30a8b9b574cf6c51e207464b852a6f559da153Mark Lord if (IS_GEN_IIE(hpriv)) 3321ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord m4 = (m4 & ~PHY_MODE4_RSVD_ZEROS) | PHY_MODE4_RSVD_ONES; 3322ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord else 3323ba069e376cc0801cd28352ca5986ce20413acb21Mark Lord m4 = (m4 & ~PHY_MODE4_CFG_MASK) | PHY_MODE4_CFG_VALUE; 33248c30a8b9b574cf6c51e207464b852a6f559da153Mark Lord writel(m4, port_mmio + PHY_MODE4); 3325bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik } 3326b406c7a6655da7a2fcd9f72e41262f93ff707748Mark Lord /* 3327b406c7a6655da7a2fcd9f72e41262f93ff707748Mark Lord * Workaround for 60x1-B2 errata SATA#13: 3328b406c7a6655da7a2fcd9f72e41262f93ff707748Mark Lord * Any write to PHY_MODE4 (above) may corrupt PHY_MODE3, 3329b406c7a6655da7a2fcd9f72e41262f93ff707748Mark Lord * so we must always rewrite PHY_MODE3 after PHY_MODE4. 3330ba68460b8e019dfd9c73ab69f5ed163a8b24e296Mark Lord * Or ensure we use writelfl() when writing PHY_MODE4. 3331b406c7a6655da7a2fcd9f72e41262f93ff707748Mark Lord */ 3332b406c7a6655da7a2fcd9f72e41262f93ff707748Mark Lord writel(m3, port_mmio + PHY_MODE3); 3333bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 3334bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik /* Revert values of pre-emphasis and signal amps to the saved ones */ 3335bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik m2 = readl(port_mmio + PHY_MODE2); 3336bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 3337bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik m2 &= ~MV_M2_PREAMP_MASK; 33382a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzik m2 |= hpriv->signal[port].amps; 33392a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzik m2 |= hpriv->signal[port].pre; 334047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik m2 &= ~(1 << 16); 3341bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 3342e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik /* according to mvSata 3.6.1, some IIE values are fixed */ 3343e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik if (IS_GEN_IIE(hpriv)) { 3344e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik m2 &= ~0xC30FF01F; 3345e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik m2 |= 0x0000900F; 3346e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik } 3347e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 3348bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik writel(m2, port_mmio + PHY_MODE2); 3349bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik} 3350bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 3351f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara/* TODO: use the generic LED interface to configure the SATA Presence */ 3352f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara/* & Acitivy LEDs on the board */ 3353f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic void mv_soc_enable_leds(struct mv_host_priv *hpriv, 3354f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio) 3355f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara{ 3356f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return; 3357f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara} 3358f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3359f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic void mv_soc_read_preamp(struct mv_host_priv *hpriv, int idx, 3360f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio) 3361f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara{ 3362f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *port_mmio; 3363f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara u32 tmp; 3364f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3365f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara port_mmio = mv_port_base(mmio, idx); 3366f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara tmp = readl(port_mmio + PHY_MODE2); 3367f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3368f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara hpriv->signal[idx].amps = tmp & 0x700; /* bits 10:8 */ 3369f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara hpriv->signal[idx].pre = tmp & 0xe0; /* bits 7:5 */ 3370f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara} 3371f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3372f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara#undef ZERO 3373f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara#define ZERO(reg) writel(0, port_mmio + (reg)) 3374f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic void mv_soc_reset_hc_port(struct mv_host_priv *hpriv, 3375f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio, unsigned int port) 3376f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara{ 3377f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *port_mmio = mv_port_base(mmio, port); 3378f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3379e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord mv_reset_channel(hpriv, mmio, port); 3380f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3381f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x028); /* command */ 3382cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(0x101f, port_mmio + EDMA_CFG); 3383f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x004); /* timer */ 3384f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x008); /* irq err cause */ 3385f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x00c); /* irq err mask */ 3386f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x010); /* rq bah */ 3387f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x014); /* rq inp */ 3388f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x018); /* rq outp */ 3389f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x01c); /* respq bah */ 3390f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x024); /* respq outp */ 3391f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x020); /* respq inp */ 3392f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x02c); /* test control */ 3393d7b0c143693bcbf391d2be235e150b97bfd8f9baSaeed Bishara writel(0x800, port_mmio + EDMA_IORDY_TMOUT); 3394f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara} 3395f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3396f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara#undef ZERO 3397f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3398f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara#define ZERO(reg) writel(0, hc_mmio + (reg)) 3399f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic void mv_soc_reset_one_hc(struct mv_host_priv *hpriv, 3400f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio) 3401f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara{ 3402f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *hc_mmio = mv_hc_base(mmio, 0); 3403f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3404f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x00c); 3405f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x010); 3406f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ZERO(0x014); 3407f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3408f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara} 3409f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3410f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara#undef ZERO 3411f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3412f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic int mv_soc_reset_hc(struct mv_host_priv *hpriv, 3413f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio, unsigned int n_hc) 3414f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara{ 3415f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara unsigned int port; 3416f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3417f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara for (port = 0; port < hpriv->n_ports; port++) 3418f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara mv_soc_reset_hc_port(hpriv, mmio, port); 3419f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3420f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara mv_soc_reset_one_hc(hpriv, mmio); 3421f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3422f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return 0; 3423f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara} 3424f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3425f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic void mv_soc_reset_flash(struct mv_host_priv *hpriv, 3426f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio) 3427f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara{ 3428f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return; 3429f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara} 3430f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 3431f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic void mv_soc_reset_bus(struct ata_host *host, void __iomem *mmio) 3432f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara{ 3433f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return; 3434f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara} 3435f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 343629b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayrstatic void mv_soc_65n_phy_errata(struct mv_host_priv *hpriv, 343729b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr void __iomem *mmio, unsigned int port) 343829b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr{ 343929b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr void __iomem *port_mmio = mv_port_base(mmio, port); 344029b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr u32 reg; 344129b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr 344229b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg = readl(port_mmio + PHY_MODE3); 344329b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg &= ~(0x3 << 27); /* SELMUPF (bits 28:27) to 1 */ 344429b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg |= (0x1 << 27); 344529b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg &= ~(0x3 << 29); /* SELMUPI (bits 30:29) to 1 */ 344629b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg |= (0x1 << 29); 344729b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr writel(reg, port_mmio + PHY_MODE3); 344829b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr 344929b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg = readl(port_mmio + PHY_MODE4); 345029b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg &= ~0x1; /* SATU_OD8 (bit 0) to 0, reserved bit 16 must be set */ 345129b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg |= (0x1 << 16); 345229b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr writel(reg, port_mmio + PHY_MODE4); 345329b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr 345429b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg = readl(port_mmio + PHY_MODE9_GEN2); 345529b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg &= ~0xf; /* TXAMP[3:0] (bits 3:0) to 8 */ 345629b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg |= 0x8; 345729b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg &= ~(0x1 << 14); /* TXAMP[4] (bit 14) to 0 */ 345829b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr writel(reg, port_mmio + PHY_MODE9_GEN2); 345929b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr 346029b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg = readl(port_mmio + PHY_MODE9_GEN1); 346129b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg &= ~0xf; /* TXAMP[3:0] (bits 3:0) to 8 */ 346229b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg |= 0x8; 346329b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr reg &= ~(0x1 << 14); /* TXAMP[4] (bit 14) to 0 */ 346429b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr writel(reg, port_mmio + PHY_MODE9_GEN1); 346529b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr} 346629b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr 346729b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr/** 346829b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr * soc_is_65 - check if the soc is 65 nano device 346929b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr * 347029b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr * Detect the type of the SoC, this is done by reading the PHYCFG_OFS 347129b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr * register, this register should contain non-zero value and it exists only 347229b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr * in the 65 nano devices, when reading it from older devices we get 0. 347329b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr */ 347429b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayrstatic bool soc_is_65n(struct mv_host_priv *hpriv) 347529b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr{ 347629b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr void __iomem *port0_mmio = mv_port_base(hpriv->base, 0); 347729b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr 347829b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr if (readl(port0_mmio + PHYCFG_OFS)) 347929b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr return true; 348029b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr return false; 348129b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr} 348229b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr 34838e7decdb8b132ee970a2636931b7653dec6af472Mark Lordstatic void mv_setup_ifcfg(void __iomem *port_mmio, int want_gen2i) 3484b67a1064cb1c1d3b43e01e8b43a6a8dcdefed733Mark Lord{ 3485cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord u32 ifcfg = readl(port_mmio + SATA_IFCFG); 3486b67a1064cb1c1d3b43e01e8b43a6a8dcdefed733Mark Lord 34878e7decdb8b132ee970a2636931b7653dec6af472Mark Lord ifcfg = (ifcfg & 0xf7f) | 0x9b1000; /* from chip spec */ 3488b67a1064cb1c1d3b43e01e8b43a6a8dcdefed733Mark Lord if (want_gen2i) 34898e7decdb8b132ee970a2636931b7653dec6af472Mark Lord ifcfg |= (1 << 7); /* enable gen2i speed */ 3490cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(ifcfg, port_mmio + SATA_IFCFG); 3491b67a1064cb1c1d3b43e01e8b43a6a8dcdefed733Mark Lord} 3492b67a1064cb1c1d3b43e01e8b43a6a8dcdefed733Mark Lord 3493e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lordstatic void mv_reset_channel(struct mv_host_priv *hpriv, void __iomem *mmio, 3494c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik unsigned int port_no) 3495c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik{ 3496c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik void __iomem *port_mmio = mv_port_base(mmio, port_no); 3497c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 34988e7decdb8b132ee970a2636931b7653dec6af472Mark Lord /* 34998e7decdb8b132ee970a2636931b7653dec6af472Mark Lord * The datasheet warns against setting EDMA_RESET when EDMA is active 35008e7decdb8b132ee970a2636931b7653dec6af472Mark Lord * (but doesn't say what the problem might be). So we first try 35018e7decdb8b132ee970a2636931b7653dec6af472Mark Lord * to disable the EDMA engine before doing the EDMA_RESET operation. 35028e7decdb8b132ee970a2636931b7653dec6af472Mark Lord */ 35030d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord mv_stop_edma_engine(port_mmio); 3504cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(EDMA_RESET, port_mmio + EDMA_CMD); 3505c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3506b67a1064cb1c1d3b43e01e8b43a6a8dcdefed733Mark Lord if (!IS_GEN_I(hpriv)) { 35078e7decdb8b132ee970a2636931b7653dec6af472Mark Lord /* Enable 3.0gb/s link speed: this survives EDMA_RESET */ 35088e7decdb8b132ee970a2636931b7653dec6af472Mark Lord mv_setup_ifcfg(port_mmio, 1); 3509c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik } 3510b67a1064cb1c1d3b43e01e8b43a6a8dcdefed733Mark Lord /* 35118e7decdb8b132ee970a2636931b7653dec6af472Mark Lord * Strobing EDMA_RESET here causes a hard reset of the SATA transport, 3512b67a1064cb1c1d3b43e01e8b43a6a8dcdefed733Mark Lord * link, and physical layers. It resets all SATA interface registers 3513cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord * (except for SATA_IFCFG), and issues a COMRESET to the dev. 3514c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik */ 3515cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(EDMA_RESET, port_mmio + EDMA_CMD); 3516b67a1064cb1c1d3b43e01e8b43a6a8dcdefed733Mark Lord udelay(25); /* allow reset propagation */ 3517cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(0, port_mmio + EDMA_CMD); 3518c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3519c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik hpriv->ops->phy_errata(hpriv, mmio, port_no); 3520c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3521ee9ccdf70163ca6408f6965e0fbc65baeac7312cJeff Garzik if (IS_GEN_I(hpriv)) 3522c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik mdelay(1); 3523c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik} 3524c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik 3525e49856d82a887ce365637176f9f99ab68076eae8Mark Lordstatic void mv_pmp_select(struct ata_port *ap, int pmp) 352620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 3527e49856d82a887ce365637176f9f99ab68076eae8Mark Lord if (sata_pmp_supported(ap)) { 3528e49856d82a887ce365637176f9f99ab68076eae8Mark Lord void __iomem *port_mmio = mv_ap_base(ap); 3529cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord u32 reg = readl(port_mmio + SATA_IFCTL); 3530e49856d82a887ce365637176f9f99ab68076eae8Mark Lord int old = reg & 0xf; 353122374677d18c5eeefd3a283431d312b8c44fef02Jeff Garzik 3532e49856d82a887ce365637176f9f99ab68076eae8Mark Lord if (old != pmp) { 3533e49856d82a887ce365637176f9f99ab68076eae8Mark Lord reg = (reg & ~0xf) | pmp; 3534cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(reg, port_mmio + SATA_IFCTL); 3535e49856d82a887ce365637176f9f99ab68076eae8Mark Lord } 353622374677d18c5eeefd3a283431d312b8c44fef02Jeff Garzik } 353720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 353820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 3539e49856d82a887ce365637176f9f99ab68076eae8Mark Lordstatic int mv_pmp_hardreset(struct ata_link *link, unsigned int *class, 3540e49856d82a887ce365637176f9f99ab68076eae8Mark Lord unsigned long deadline) 354122374677d18c5eeefd3a283431d312b8c44fef02Jeff Garzik{ 3542e49856d82a887ce365637176f9f99ab68076eae8Mark Lord mv_pmp_select(link->ap, sata_srst_pmp(link)); 3543e49856d82a887ce365637176f9f99ab68076eae8Mark Lord return sata_std_hardreset(link, class, deadline); 3544e49856d82a887ce365637176f9f99ab68076eae8Mark Lord} 3545bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 3546e49856d82a887ce365637176f9f99ab68076eae8Mark Lordstatic int mv_softreset(struct ata_link *link, unsigned int *class, 3547e49856d82a887ce365637176f9f99ab68076eae8Mark Lord unsigned long deadline) 3548e49856d82a887ce365637176f9f99ab68076eae8Mark Lord{ 3549e49856d82a887ce365637176f9f99ab68076eae8Mark Lord mv_pmp_select(link->ap, sata_srst_pmp(link)); 3550e49856d82a887ce365637176f9f99ab68076eae8Mark Lord return ata_sff_softreset(link, class, deadline); 355122374677d18c5eeefd3a283431d312b8c44fef02Jeff Garzik} 355222374677d18c5eeefd3a283431d312b8c44fef02Jeff Garzik 3553cc0680a580b5be81a1ca321b58f8e9b80b5c1052Tejun Heostatic int mv_hardreset(struct ata_link *link, unsigned int *class, 3554bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik unsigned long deadline) 355531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 3556cc0680a580b5be81a1ca321b58f8e9b80b5c1052Tejun Heo struct ata_port *ap = link->ap; 3557bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik struct mv_host_priv *hpriv = ap->host->private_data; 3558b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord struct mv_port_priv *pp = ap->private_data; 3559f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio = hpriv->base; 35600d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord int rc, attempts = 0, extra = 0; 35610d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord u32 sstatus; 35620d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord bool online; 356331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 3564e12bef50b7660cf7c19d1cd3eac381b9eff734d7Mark Lord mv_reset_channel(hpriv, mmio, ap->port_no); 3565b562468cc3bd0c81decba1f5f39a7173f839e57eMark Lord pp->pp_flags &= ~MV_PP_FLAG_EDMA_EN; 3566d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord pp->pp_flags &= 3567d16ab3f633b75aac1cf42b00355cd9aa65033dccMark Lord ~(MV_PP_FLAG_FBS_EN | MV_PP_FLAG_NCQ_EN | MV_PP_FLAG_FAKE_ATA_BUSY); 3568bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 35690d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord /* Workaround for errata FEr SATA#10 (part 2) */ 35700d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord do { 357117c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord const unsigned long *timing = 357217c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord sata_ehc_deb_timing(&link->eh_context); 3573bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 357417c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord rc = sata_link_hardreset(link, timing, deadline + extra, 357517c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord &online, NULL); 35769dcffd99d0b1c0c1b8b2c0f85d240e791eca1055Mark Lord rc = online ? -EAGAIN : rc; 357717c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord if (rc) 35780d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord return rc; 35790d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord sata_scr_read(link, SCR_STATUS, &sstatus); 35800d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord if (!IS_GEN_I(hpriv) && ++attempts >= 5 && sstatus == 0x121) { 35810d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord /* Force 1.5gb/s link speed and try again */ 35828e7decdb8b132ee970a2636931b7653dec6af472Mark Lord mv_setup_ifcfg(mv_ap_base(ap), 0); 35830d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord if (time_after(jiffies + HZ, deadline)) 35840d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord extra = HZ; /* only extend it once, max */ 35850d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord } 35860d8be5cbff8fd95da72d749a64e150b851f470c6Mark Lord } while (sstatus != 0x0 && sstatus != 0x113 && sstatus != 0x123); 358708da175937a35d34a83eaefbb3458472eb1a89d4Mark Lord mv_save_cached_regs(ap); 358866e57a2cb0c538d4f84a7233c224735fe1eaa672Mark Lord mv_edma_cfg(ap, 0, 0); 3589bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 359017c5aab5b34e351531466e35b154ca86db7d46a9Mark Lord return rc; 3591bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik} 3592bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 3593bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzikstatic void mv_eh_freeze(struct ata_port *ap) 3594bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik{ 35951cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord mv_stop_edma(ap); 3596c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord mv_enable_port_irqs(ap, 0); 3597bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik} 3598bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 3599bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzikstatic void mv_eh_thaw(struct ata_port *ap) 3600bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik{ 3601f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara struct mv_host_priv *hpriv = ap->host->private_data; 3602c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord unsigned int port = ap->port_no; 3603c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord unsigned int hardport = mv_hardport_from_port(port); 36041cfd19aeb8c8b6291a9d11143b4d8f3dac508ed4Mark Lord void __iomem *hc_mmio = mv_hc_base_from_port(hpriv->base, port); 3605bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik void __iomem *port_mmio = mv_ap_base(ap); 3606c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord u32 hc_irq_cause; 3607bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 3608bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik /* clear EDMA errors on this port */ 3609cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writel(0, port_mmio + EDMA_ERR_IRQ_CAUSE); 3610bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 3611bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik /* clear pending irq events */ 3612cae6edc3b5a536119374a5439d9b253cb26f05e1Mark Lord hc_irq_cause = ~((DEV_IRQ | DMA_IRQ) << hardport); 3613cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(hc_irq_cause, hc_mmio + HC_IRQ_CAUSE); 3614bdd4dddee325a7dce3e84cf48201a06aa8508aa4Jeff Garzik 361588e675e193159b9891c1c576de4348eaf490f5d0Mark Lord mv_enable_port_irqs(ap, ERR_IRQ); 361631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 361731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 361805b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 361905b308e1df6d9d673daedb517969241f41278b52Brett Russ * mv_port_init - Perform some early initialization on a single port. 362005b308e1df6d9d673daedb517969241f41278b52Brett Russ * @port: libata data structure storing shadow register addresses 362105b308e1df6d9d673daedb517969241f41278b52Brett Russ * @port_mmio: base address of the port 362205b308e1df6d9d673daedb517969241f41278b52Brett Russ * 362305b308e1df6d9d673daedb517969241f41278b52Brett Russ * Initialize shadow register mmio addresses, clear outstanding 362405b308e1df6d9d673daedb517969241f41278b52Brett Russ * interrupts on the port, and unmask interrupts for the future 362505b308e1df6d9d673daedb517969241f41278b52Brett Russ * start of the port. 362605b308e1df6d9d673daedb517969241f41278b52Brett Russ * 362705b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 362805b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 362905b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 363031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russstatic void mv_port_init(struct ata_ioports *port, void __iomem *port_mmio) 363120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 3632cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord void __iomem *serr, *shd_base = port_mmio + SHD_BLK; 363331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 36348b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik /* PIO related setup 363531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ */ 363631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ port->data_addr = shd_base + (sizeof(u32) * ATA_REG_DATA); 36378b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik port->error_addr = 363831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ port->feature_addr = shd_base + (sizeof(u32) * ATA_REG_ERR); 363931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ port->nsect_addr = shd_base + (sizeof(u32) * ATA_REG_NSECT); 364031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ port->lbal_addr = shd_base + (sizeof(u32) * ATA_REG_LBAL); 364131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ port->lbam_addr = shd_base + (sizeof(u32) * ATA_REG_LBAM); 364231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ port->lbah_addr = shd_base + (sizeof(u32) * ATA_REG_LBAH); 364331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ port->device_addr = shd_base + (sizeof(u32) * ATA_REG_DEVICE); 36448b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik port->status_addr = 364531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ port->command_addr = shd_base + (sizeof(u32) * ATA_REG_STATUS); 364631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ /* special case: control/altstatus doesn't have ATA_REG_ address */ 3647cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord port->altstatus_addr = port->ctl_addr = shd_base + SHD_CTL_AST; 364831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 364931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ /* Clear any currently outstanding port interrupt conditions */ 3650cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord serr = port_mmio + mv_scr_offset(SCR_ERROR); 3651cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(readl(serr), serr); 3652cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(0, port_mmio + EDMA_ERR_IRQ_CAUSE); 365331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 3654646a4da514f2555298481cb00dc5b3eb02b21b72Mark Lord /* unmask all non-transient EDMA error interrupts */ 3655cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(~EDMA_ERR_IRQ_TRANSIENT, port_mmio + EDMA_ERR_IRQ_MASK); 365620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 36578b260248d9e0e8b64bb72fd4dee03ad86984c344Jeff Garzik VPRINTK("EDMA cfg=0x%08x EDMA IRQ err cause/mask=0x%08x/0x%08x\n", 3658cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord readl(port_mmio + EDMA_CFG), 3659cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord readl(port_mmio + EDMA_ERR_IRQ_CAUSE), 3660cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord readl(port_mmio + EDMA_ERR_IRQ_MASK)); 366120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 366220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 3663616d4a98ad8749ebe17a8fcac67df65c321350acMark Lordstatic unsigned int mv_in_pcix_mode(struct ata_host *host) 3664616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord{ 3665616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord struct mv_host_priv *hpriv = host->private_data; 3666616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord void __iomem *mmio = hpriv->base; 3667616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord u32 reg; 3668616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord 36691f39847255a02c69190ae30c33b8ccf4c10840dfMark Lord if (IS_SOC(hpriv) || !IS_PCIE(hpriv)) 3670616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord return 0; /* not PCI-X capable */ 3671cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord reg = readl(mmio + MV_PCI_MODE); 3672616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord if ((reg & MV_PCI_MODE_MASK) == 0) 3673616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord return 0; /* conventional PCI mode */ 3674616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord return 1; /* chip is in PCI-X mode */ 3675616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord} 3676616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord 3677616d4a98ad8749ebe17a8fcac67df65c321350acMark Lordstatic int mv_pci_cut_through_okay(struct ata_host *host) 3678616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord{ 3679616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord struct mv_host_priv *hpriv = host->private_data; 3680616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord void __iomem *mmio = hpriv->base; 3681616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord u32 reg; 3682616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord 3683616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord if (!mv_in_pcix_mode(host)) { 3684cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord reg = readl(mmio + MV_PCI_COMMAND); 3685cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord if (reg & MV_PCI_COMMAND_MRDTRIG) 3686616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord return 0; /* not okay */ 3687616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord } 3688616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord return 1; /* okay */ 3689616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord} 3690616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord 369165ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lordstatic void mv_60x1b2_errata_pci7(struct ata_host *host) 369265ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord{ 369365ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord struct mv_host_priv *hpriv = host->private_data; 369465ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord void __iomem *mmio = hpriv->base; 369565ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord 369665ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord /* workaround for 60x1-B2 errata PCI#7 */ 369765ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord if (mv_in_pcix_mode(host)) { 3698cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord u32 reg = readl(mmio + MV_PCI_COMMAND); 3699cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(reg & ~MV_PCI_COMMAND_MWRCOM, mmio + MV_PCI_COMMAND); 370065ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord } 370165ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord} 370265ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord 37034447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heostatic int mv_chip_id(struct ata_host *host, unsigned int board_idx) 3704bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik{ 37054447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo struct pci_dev *pdev = to_pci_dev(host->dev); 37064447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo struct mv_host_priv *hpriv = host->private_data; 3707bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik u32 hp_flags = hpriv->hp_flags; 3708bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 37095796d1c4c89efff823259fda35b08ea66ebf8b23Jeff Garzik switch (board_idx) { 371047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik case chip_5080: 371147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hpriv->ops = &mv5xxx_ops; 3712ee9ccdf70163ca6408f6965e0fbc65baeac7312cJeff Garzik hp_flags |= MV_HP_GEN_I; 371347c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 371444c10138fd4bbc4b6d6bff0873c24902f2a9da65Auke Kok switch (pdev->revision) { 371547c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik case 0x1: 371647c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags |= MV_HP_ERRATA_50XXB0; 371747c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik break; 371847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik case 0x3: 371947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags |= MV_HP_ERRATA_50XXB2; 372047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik break; 372147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik default: 372247c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik dev_printk(KERN_WARNING, &pdev->dev, 372347c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik "Applying 50XXB2 workarounds to unknown rev\n"); 372447c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags |= MV_HP_ERRATA_50XXB2; 372547c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik break; 372647c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik } 372747c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik break; 372847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 3729bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik case chip_504x: 3730bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik case chip_508x: 373147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hpriv->ops = &mv5xxx_ops; 3732ee9ccdf70163ca6408f6965e0fbc65baeac7312cJeff Garzik hp_flags |= MV_HP_GEN_I; 3733bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 373444c10138fd4bbc4b6d6bff0873c24902f2a9da65Auke Kok switch (pdev->revision) { 373547c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik case 0x0: 373647c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags |= MV_HP_ERRATA_50XXB0; 373747c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik break; 373847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik case 0x3: 373947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags |= MV_HP_ERRATA_50XXB2; 374047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik break; 374147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik default: 374247c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik dev_printk(KERN_WARNING, &pdev->dev, 374347c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik "Applying B2 workarounds to unknown rev\n"); 374447c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags |= MV_HP_ERRATA_50XXB2; 374547c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik break; 3746bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik } 3747bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik break; 3748bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 3749bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik case chip_604x: 3750bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik case chip_608x: 375147c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hpriv->ops = &mv6xxx_ops; 3752ee9ccdf70163ca6408f6965e0fbc65baeac7312cJeff Garzik hp_flags |= MV_HP_GEN_II; 375347c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 375444c10138fd4bbc4b6d6bff0873c24902f2a9da65Auke Kok switch (pdev->revision) { 375547c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik case 0x7: 375665ad7fef10b50b6c06d6165fa847e2d3636b0a66Mark Lord mv_60x1b2_errata_pci7(host); 375747c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags |= MV_HP_ERRATA_60X1B2; 375847c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik break; 375947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik case 0x9: 376047c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags |= MV_HP_ERRATA_60X1C0; 3761bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik break; 3762bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik default: 3763bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik dev_printk(KERN_WARNING, &pdev->dev, 376447c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik "Applying B2 workarounds to unknown rev\n"); 376547c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hp_flags |= MV_HP_ERRATA_60X1B2; 3766bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik break; 3767bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik } 3768bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik break; 3769bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 3770e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik case chip_7042: 3771616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord hp_flags |= MV_HP_PCIE | MV_HP_CUT_THROUGH; 3772306b30f74d37f289033c696285e07ce0158a5d7bMark Lord if (pdev->vendor == PCI_VENDOR_ID_TTI && 3773306b30f74d37f289033c696285e07ce0158a5d7bMark Lord (pdev->device == 0x2300 || pdev->device == 0x2310)) 3774306b30f74d37f289033c696285e07ce0158a5d7bMark Lord { 37754e5200334e03e5620aa19d538300c13db270a063Mark Lord /* 37764e5200334e03e5620aa19d538300c13db270a063Mark Lord * Highpoint RocketRAID PCIe 23xx series cards: 37774e5200334e03e5620aa19d538300c13db270a063Mark Lord * 37784e5200334e03e5620aa19d538300c13db270a063Mark Lord * Unconfigured drives are treated as "Legacy" 37794e5200334e03e5620aa19d538300c13db270a063Mark Lord * by the BIOS, and it overwrites sector 8 with 37804e5200334e03e5620aa19d538300c13db270a063Mark Lord * a "Lgcy" metadata block prior to Linux boot. 37814e5200334e03e5620aa19d538300c13db270a063Mark Lord * 37824e5200334e03e5620aa19d538300c13db270a063Mark Lord * Configured drives (RAID or JBOD) leave sector 8 37834e5200334e03e5620aa19d538300c13db270a063Mark Lord * alone, but instead overwrite a high numbered 37844e5200334e03e5620aa19d538300c13db270a063Mark Lord * sector for the RAID metadata. This sector can 37854e5200334e03e5620aa19d538300c13db270a063Mark Lord * be determined exactly, by truncating the physical 37864e5200334e03e5620aa19d538300c13db270a063Mark Lord * drive capacity to a nice even GB value. 37874e5200334e03e5620aa19d538300c13db270a063Mark Lord * 37884e5200334e03e5620aa19d538300c13db270a063Mark Lord * RAID metadata is at: (dev->n_sectors & ~0xfffff) 37894e5200334e03e5620aa19d538300c13db270a063Mark Lord * 37904e5200334e03e5620aa19d538300c13db270a063Mark Lord * Warn the user, lest they think we're just buggy. 37914e5200334e03e5620aa19d538300c13db270a063Mark Lord */ 37924e5200334e03e5620aa19d538300c13db270a063Mark Lord printk(KERN_WARNING DRV_NAME ": Highpoint RocketRAID" 37934e5200334e03e5620aa19d538300c13db270a063Mark Lord " BIOS CORRUPTS DATA on all attached drives," 37944e5200334e03e5620aa19d538300c13db270a063Mark Lord " regardless of if/how they are configured." 37954e5200334e03e5620aa19d538300c13db270a063Mark Lord " BEWARE!\n"); 37964e5200334e03e5620aa19d538300c13db270a063Mark Lord printk(KERN_WARNING DRV_NAME ": For data safety, do not" 37974e5200334e03e5620aa19d538300c13db270a063Mark Lord " use sectors 8-9 on \"Legacy\" drives," 37984e5200334e03e5620aa19d538300c13db270a063Mark Lord " and avoid the final two gigabytes on" 37994e5200334e03e5620aa19d538300c13db270a063Mark Lord " all RocketRAID BIOS initialized drives.\n"); 3800306b30f74d37f289033c696285e07ce0158a5d7bMark Lord } 38018e7decdb8b132ee970a2636931b7653dec6af472Mark Lord /* drop through */ 3802e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik case chip_6042: 3803e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik hpriv->ops = &mv6xxx_ops; 3804e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik hp_flags |= MV_HP_GEN_IIE; 3805616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord if (board_idx == chip_6042 && mv_pci_cut_through_okay(host)) 3806616d4a98ad8749ebe17a8fcac67df65c321350acMark Lord hp_flags |= MV_HP_CUT_THROUGH; 3807e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 380844c10138fd4bbc4b6d6bff0873c24902f2a9da65Auke Kok switch (pdev->revision) { 38095cf73bfb061552aa18d816d2859409be9ace5306Mark Lord case 0x2: /* Rev.B0: the first/only public release */ 3810e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik hp_flags |= MV_HP_ERRATA_60X1C0; 3811e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik break; 3812e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik default: 3813e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik dev_printk(KERN_WARNING, &pdev->dev, 3814e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik "Applying 60X1C0 workarounds to unknown rev\n"); 3815e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik hp_flags |= MV_HP_ERRATA_60X1C0; 3816e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik break; 3817e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik } 3818e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik break; 3819f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara case chip_soc: 382029b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr if (soc_is_65n(hpriv)) 382129b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr hpriv->ops = &mv_soc_65n_ops; 382229b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr else 382329b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr hpriv->ops = &mv_soc_ops; 3824eb3a55a9f43f0f8e770c2abf70e65bdda2d5ff1eSaeed Bishara hp_flags |= MV_HP_FLAG_SOC | MV_HP_GEN_IIE | 3825eb3a55a9f43f0f8e770c2abf70e65bdda2d5ff1eSaeed Bishara MV_HP_ERRATA_60X1C0; 3826f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara break; 3827e4e7b89280d1d666e2c09e5ad36cf071796c4c7eJeff Garzik 3828bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik default: 3829f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara dev_printk(KERN_ERR, host->dev, 38305796d1c4c89efff823259fda35b08ea66ebf8b23Jeff Garzik "BUG: invalid board index %u\n", board_idx); 3831bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik return 1; 3832bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik } 3833bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 3834bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik hpriv->hp_flags = hp_flags; 383502a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord if (hp_flags & MV_HP_PCIE) { 3836cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord hpriv->irq_cause_offset = PCIE_IRQ_CAUSE; 3837cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord hpriv->irq_mask_offset = PCIE_IRQ_MASK; 383802a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord hpriv->unmask_all_irqs = PCIE_UNMASK_ALL_IRQS; 383902a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord } else { 3840cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord hpriv->irq_cause_offset = PCI_IRQ_CAUSE; 3841cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord hpriv->irq_mask_offset = PCI_IRQ_MASK; 384202a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord hpriv->unmask_all_irqs = PCI_UNMASK_ALL_IRQS; 384302a121da5a53d415b6596bc19cc6999d295d32a4Mark Lord } 3844bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 3845bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik return 0; 3846bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik} 3847bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 384805b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 384947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik * mv_init_host - Perform some early initialization of the host. 38504447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo * @host: ATA host to initialize 385105b308e1df6d9d673daedb517969241f41278b52Brett Russ * 385205b308e1df6d9d673daedb517969241f41278b52Brett Russ * If possible, do an early global reset of the host. Then do 385305b308e1df6d9d673daedb517969241f41278b52Brett Russ * our port init and clear/unmask all/relevant host interrupts. 385405b308e1df6d9d673daedb517969241f41278b52Brett Russ * 385505b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 385605b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 385705b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 38581bfeff03f8a52eb896e5aad33d52e2451437bb0bSaeed Bisharastatic int mv_init_host(struct ata_host *host) 385920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 386020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ int rc = 0, n_hc, port, hc; 38614447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo struct mv_host_priv *hpriv = host->private_data; 3862f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara void __iomem *mmio = hpriv->base; 386347c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik 38641bfeff03f8a52eb896e5aad33d52e2451437bb0bSaeed Bishara rc = mv_chip_id(host, hpriv->board_idx); 3865bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik if (rc) 3866352fab701ca4753dd005b67ce5e512be944eb591Mark Lord goto done; 3867f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 38681f39847255a02c69190ae30c33b8ccf4c10840dfMark Lord if (IS_SOC(hpriv)) { 3869cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord hpriv->main_irq_cause_addr = mmio + SOC_HC_MAIN_IRQ_CAUSE; 3870cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord hpriv->main_irq_mask_addr = mmio + SOC_HC_MAIN_IRQ_MASK; 38711f39847255a02c69190ae30c33b8ccf4c10840dfMark Lord } else { 3872cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord hpriv->main_irq_cause_addr = mmio + PCI_HC_MAIN_IRQ_CAUSE; 3873cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord hpriv->main_irq_mask_addr = mmio + PCI_HC_MAIN_IRQ_MASK; 3874f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara } 3875352fab701ca4753dd005b67ce5e512be944eb591Mark Lord 38765d0fb2e730e2085021cf5c8b6d14983e92aea75bThomas Reitmayr /* initialize shadow irq mask with register's value */ 38775d0fb2e730e2085021cf5c8b6d14983e92aea75bThomas Reitmayr hpriv->main_irq_mask = readl(hpriv->main_irq_mask_addr); 38785d0fb2e730e2085021cf5c8b6d14983e92aea75bThomas Reitmayr 3879352fab701ca4753dd005b67ce5e512be944eb591Mark Lord /* global interrupt mask: 0 == mask everything */ 3880c4de573b14d78ac83861d81d12977457d1e9cb6dMark Lord mv_set_main_irq_mask(host, ~0, 0); 3881bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 38824447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo n_hc = mv_get_hc_count(host->ports[0]->flags); 3883bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 38844447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo for (port = 0; port < host->n_ports; port++) 388529b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr if (hpriv->ops->read_preamp) 388629b7e43c310bdc20d240c7674d9073f6c1c12a3fMartin Michlmayr hpriv->ops->read_preamp(hpriv, port, mmio); 388720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 3888c9d39130123238ac18478a42e25cb7996eacfcc0Jeff Garzik rc = hpriv->ops->reset_hc(hpriv, mmio, n_hc); 388947c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik if (rc) 389020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ goto done; 389120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 3892522479fb98c6667f081e75f87e298e413c0b1db8Jeff Garzik hpriv->ops->reset_flash(hpriv, mmio); 38937bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara hpriv->ops->reset_bus(host, mmio); 389447c2b677daeed9c79ecb7167c211ff36876ea611Jeff Garzik hpriv->ops->enable_leds(hpriv, mmio); 389520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 38964447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo for (port = 0; port < host->n_ports; port++) { 3897cbcdd87593a1d85c5c4b259945a3a09eee12814dTejun Heo struct ata_port *ap = host->ports[port]; 38982a47ce06d534692f9bd2bf4e90a20fc9b1054c39Jeff Garzik void __iomem *port_mmio = mv_port_base(mmio, port); 3899cbcdd87593a1d85c5c4b259945a3a09eee12814dTejun Heo 3900cbcdd87593a1d85c5c4b259945a3a09eee12814dTejun Heo mv_port_init(&ap->ioaddr, port_mmio); 390120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ } 390220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 390320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ for (hc = 0; hc < n_hc; hc++) { 390431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ void __iomem *hc_mmio = mv_hc_base(mmio, hc); 390531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 390631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ VPRINTK("HC%i: HC config=0x%08x HC IRQ cause " 390731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ "(before clear)=0x%08x\n", hc, 3908cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord readl(hc_mmio + HC_CFG), 3909cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord readl(hc_mmio + HC_IRQ_CAUSE)); 391031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 391131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ /* Clear any currently outstanding hc interrupt conditions */ 3912cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(0, hc_mmio + HC_IRQ_CAUSE); 391320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ } 391420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 391544c65d169c5d2e5c872581ebc65f12710d7c3b71Mark Lord if (!IS_SOC(hpriv)) { 391644c65d169c5d2e5c872581ebc65f12710d7c3b71Mark Lord /* Clear any currently outstanding host interrupt conditions */ 3917cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(0, mmio + hpriv->irq_cause_offset); 391831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 391944c65d169c5d2e5c872581ebc65f12710d7c3b71Mark Lord /* and unmask interrupt generation for host regs */ 3920cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord writelfl(hpriv->unmask_all_irqs, mmio + hpriv->irq_mask_offset); 392144c65d169c5d2e5c872581ebc65f12710d7c3b71Mark Lord } 392251de32d200b21333950abc52ea1e589bc4eecef7Mark Lord 39236be96ac15e4d913e1f48299db083ada5321803b2Mark Lord /* 39246be96ac15e4d913e1f48299db083ada5321803b2Mark Lord * enable only global host interrupts for now. 39256be96ac15e4d913e1f48299db083ada5321803b2Mark Lord * The per-port interrupts get done later as ports are set up. 39266be96ac15e4d913e1f48299db083ada5321803b2Mark Lord */ 39276be96ac15e4d913e1f48299db083ada5321803b2Mark Lord mv_set_main_irq_mask(host, 0, PCI_ERR); 39282b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord mv_set_irq_coalescing(host, irq_coalescing_io_count, 39292b748a0a344847fe6b924407bbe153e1878c9f09Mark Lord irq_coalescing_usecs); 3930f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharadone: 3931f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return rc; 3932f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara} 3933fb621e2fde735abab854586d52c96c5624bcb5b8Jeff Garzik 3934fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradleystatic int mv_create_dma_pools(struct mv_host_priv *hpriv, struct device *dev) 3935fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley{ 3936fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley hpriv->crqb_pool = dmam_pool_create("crqb_q", dev, MV_CRQB_Q_SZ, 3937fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley MV_CRQB_Q_SZ, 0); 3938fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley if (!hpriv->crqb_pool) 3939fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley return -ENOMEM; 3940fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley 3941fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley hpriv->crpb_pool = dmam_pool_create("crpb_q", dev, MV_CRPB_Q_SZ, 3942fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley MV_CRPB_Q_SZ, 0); 3943fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley if (!hpriv->crpb_pool) 3944fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley return -ENOMEM; 3945fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley 3946fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley hpriv->sg_tbl_pool = dmam_pool_create("sg_tbl", dev, MV_SG_TBL_SZ, 3947fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley MV_SG_TBL_SZ, 0); 3948fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley if (!hpriv->sg_tbl_pool) 3949fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley return -ENOMEM; 3950fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley 3951fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley return 0; 3952fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley} 3953fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley 395415a32632d94011911497052a96cdbf3b905b325dLennert Buytenhekstatic void mv_conf_mbus_windows(struct mv_host_priv *hpriv, 395515a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek struct mbus_dram_target_info *dram) 395615a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek{ 395715a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek int i; 395815a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek 395915a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek for (i = 0; i < 4; i++) { 396015a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek writel(0, hpriv->base + WINDOW_CTRL(i)); 396115a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek writel(0, hpriv->base + WINDOW_BASE(i)); 396215a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek } 396315a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek 396415a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek for (i = 0; i < dram->num_cs; i++) { 396515a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek struct mbus_dram_window *cs = dram->cs + i; 396615a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek 396715a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek writel(((cs->size - 1) & 0xffff0000) | 396815a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek (cs->mbus_attr << 8) | 396915a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek (dram->mbus_dram_target_id << 4) | 1, 397015a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek hpriv->base + WINDOW_CTRL(i)); 397115a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek writel(cs->base, hpriv->base + WINDOW_BASE(i)); 397215a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek } 397315a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek} 397415a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek 3975f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara/** 3976f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * mv_platform_probe - handle a positive probe of an soc Marvell 3977f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * host 3978f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * @pdev: platform device found 3979f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * 3980f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * LOCKING: 3981f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * Inherited from caller. 3982f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara */ 3983f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic int mv_platform_probe(struct platform_device *pdev) 3984f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara{ 3985f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara static int printed_version; 3986f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara const struct mv_sata_platform_data *mv_platform_data; 3987f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara const struct ata_port_info *ppi[] = 3988f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara { &mv_port_info[chip_soc], NULL }; 3989f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara struct ata_host *host; 3990f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara struct mv_host_priv *hpriv; 3991f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara struct resource *res; 3992f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara int n_ports, rc; 399320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 3994f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara if (!printed_version++) 3995f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara dev_printk(KERN_INFO, &pdev->dev, "version " DRV_VERSION "\n"); 3996bca1c4eb9411533d613123618c0d127fae532595Jeff Garzik 3997f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara /* 3998f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * Simple resource validation .. 3999f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara */ 4000f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara if (unlikely(pdev->num_resources != 2)) { 4001f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara dev_err(&pdev->dev, "invalid number of resources\n"); 4002f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return -EINVAL; 4003f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara } 4004f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4005f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara /* 4006f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * Get the register base first 4007f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara */ 4008f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 4009f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara if (res == NULL) 4010f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return -EINVAL; 4011f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4012f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara /* allocate host */ 4013f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara mv_platform_data = pdev->dev.platform_data; 4014f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara n_ports = mv_platform_data->n_ports; 4015f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4016f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara host = ata_host_alloc_pinfo(&pdev->dev, ppi, n_ports); 4017f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara hpriv = devm_kzalloc(&pdev->dev, sizeof(*hpriv), GFP_KERNEL); 4018f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4019f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara if (!host || !hpriv) 4020f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return -ENOMEM; 4021f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara host->private_data = hpriv; 4022f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara hpriv->n_ports = n_ports; 40231bfeff03f8a52eb896e5aad33d52e2451437bb0bSaeed Bishara hpriv->board_idx = chip_soc; 4024f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4025f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara host->iomap = NULL; 4026f1cb0ea12fee23018ad1865bf789cbd463f13747Saeed Bishara hpriv->base = devm_ioremap(&pdev->dev, res->start, 4027041b5eac254107cd3ba60034c38a411531cc64eeJulia Lawall resource_size(res)); 4028cae5a29d3c4ec7c4214966021c9ee827e66bd67bMark Lord hpriv->base -= SATAHC0_REG_BASE; 4029f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4030c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#if defined(CONFIG_HAVE_CLK) 4031c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara hpriv->clk = clk_get(&pdev->dev, NULL); 4032c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara if (IS_ERR(hpriv->clk)) 4033c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara dev_notice(&pdev->dev, "cannot get clkdev\n"); 4034c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara else 4035c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara clk_enable(hpriv->clk); 4036c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#endif 4037c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara 403815a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek /* 403915a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek * (Re-)program MBUS remapping windows if we are asked to. 404015a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek */ 404115a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek if (mv_platform_data->dram != NULL) 404215a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek mv_conf_mbus_windows(hpriv, mv_platform_data->dram); 404315a32632d94011911497052a96cdbf3b905b325dLennert Buytenhek 4044fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley rc = mv_create_dma_pools(hpriv, &pdev->dev); 4045fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley if (rc) 4046c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara goto err; 4047fbf14e2f2d674e6a2ff0fb2aa569e7f6687483a3Byron Bradley 4048f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara /* initialize adapter */ 40491bfeff03f8a52eb896e5aad33d52e2451437bb0bSaeed Bishara rc = mv_init_host(host); 4050f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara if (rc) 4051c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara goto err; 4052f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4053f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara dev_printk(KERN_INFO, &pdev->dev, 4054f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara "slots %u ports %d\n", (unsigned)MV_MAX_Q_DEPTH, 4055f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara host->n_ports); 4056f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4057f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return ata_host_activate(host, platform_get_irq(pdev, 0), mv_interrupt, 4058f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara IRQF_SHARED, &mv6_sht); 4059c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bisharaerr: 4060c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#if defined(CONFIG_HAVE_CLK) 4061c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara if (!IS_ERR(hpriv->clk)) { 4062c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara clk_disable(hpriv->clk); 4063c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara clk_put(hpriv->clk); 4064c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara } 4065c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#endif 4066c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara 4067c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara return rc; 4068f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara} 4069f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4070f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara/* 4071f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * 4072f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * mv_platform_remove - unplug a platform interface 4073f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * @pdev: platform device 4074f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * 4075f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * A platform bus SATA device has been unplugged. Perform the needed 4076f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * cleanup. Also called on module unload for any active devices. 4077f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara */ 4078f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic int __devexit mv_platform_remove(struct platform_device *pdev) 4079f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara{ 4080f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara struct device *dev = &pdev->dev; 4081f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara struct ata_host *host = dev_get_drvdata(dev); 4082c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#if defined(CONFIG_HAVE_CLK) 4083c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara struct mv_host_priv *hpriv = host->private_data; 4084c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#endif 4085f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara ata_host_detach(host); 4086c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara 4087c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#if defined(CONFIG_HAVE_CLK) 4088c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara if (!IS_ERR(hpriv->clk)) { 4089c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara clk_disable(hpriv->clk); 4090c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara clk_put(hpriv->clk); 4091c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara } 4092c77a2f4e6b76c9094182dfa653ece4243f6df80cSaeed Bishara#endif 4093f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return 0; 409420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 409520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 40966481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara#ifdef CONFIG_PM 40976481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bisharastatic int mv_platform_suspend(struct platform_device *pdev, pm_message_t state) 40986481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara{ 40996481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara struct ata_host *host = dev_get_drvdata(&pdev->dev); 41006481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara if (host) 41016481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara return ata_host_suspend(host, state); 41026481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara else 41036481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara return 0; 41046481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara} 41056481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara 41066481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bisharastatic int mv_platform_resume(struct platform_device *pdev) 41076481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara{ 41086481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara struct ata_host *host = dev_get_drvdata(&pdev->dev); 41096481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara int ret; 41106481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara 41116481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara if (host) { 41126481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara struct mv_host_priv *hpriv = host->private_data; 41136481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara const struct mv_sata_platform_data *mv_platform_data = \ 41146481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara pdev->dev.platform_data; 41156481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara /* 41166481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara * (Re-)program MBUS remapping windows if we are asked to. 41176481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara */ 41186481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara if (mv_platform_data->dram != NULL) 41196481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara mv_conf_mbus_windows(hpriv, mv_platform_data->dram); 41206481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara 41216481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara /* initialize adapter */ 41221bfeff03f8a52eb896e5aad33d52e2451437bb0bSaeed Bishara ret = mv_init_host(host); 41236481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara if (ret) { 41246481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara printk(KERN_ERR DRV_NAME ": Error during HW init\n"); 41256481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara return ret; 41266481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara } 41276481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara ata_host_resume(host); 41286481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara } 41296481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara 41306481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara return 0; 41316481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara} 41326481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara#else 41336481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara#define mv_platform_suspend NULL 41346481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara#define mv_platform_resume NULL 41356481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara#endif 41366481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara 4137f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic struct platform_driver mv_platform_driver = { 4138f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .probe = mv_platform_probe, 4139f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .remove = __devexit_p(mv_platform_remove), 41406481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara .suspend = mv_platform_suspend, 41416481f2b52cd5411ea6342b749daf0e4f3b390d7bSaeed Bishara .resume = mv_platform_resume, 4142f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .driver = { 4143f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .name = DRV_NAME, 4144f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .owner = THIS_MODULE, 4145f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara }, 4146f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara}; 4147f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4148f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 41497bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara#ifdef CONFIG_PCI 4150f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic int mv_pci_init_one(struct pci_dev *pdev, 4151f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara const struct pci_device_id *ent); 4152b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara#ifdef CONFIG_PM 4153b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bisharastatic int mv_pci_device_resume(struct pci_dev *pdev); 4154b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara#endif 4155f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 41567bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara 41577bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bisharastatic struct pci_driver mv_pci_driver = { 41587bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara .name = DRV_NAME, 41597bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara .id_table = mv_pci_tbl, 4160f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara .probe = mv_pci_init_one, 41617bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara .remove = ata_pci_remove_one, 4162b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara#ifdef CONFIG_PM 4163b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara .suspend = ata_pci_device_suspend, 4164b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara .resume = mv_pci_device_resume, 4165b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara#endif 4166b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara 41677bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara}; 41687bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara 41697bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara/* move to PCI layer or libata core? */ 41707bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bisharastatic int pci_go_64(struct pci_dev *pdev) 41717bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara{ 41727bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara int rc; 41737bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara 41746a35528a8346f6e6fd32ed7e51f04d1fa4ca2c01Yang Hongyang if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64))) { 41756a35528a8346f6e6fd32ed7e51f04d1fa4ca2c01Yang Hongyang rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); 41767bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara if (rc) { 4177284901a90a9e0b812ca3f5f852cbbfb60d10249dYang Hongyang rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)); 41787bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara if (rc) { 41797bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara dev_printk(KERN_ERR, &pdev->dev, 41807bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara "64-bit DMA enable failed\n"); 41817bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara return rc; 41827bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara } 41837bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara } 41847bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara } else { 4185284901a90a9e0b812ca3f5f852cbbfb60d10249dYang Hongyang rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); 41867bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara if (rc) { 41877bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara dev_printk(KERN_ERR, &pdev->dev, 41887bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara "32-bit DMA enable failed\n"); 41897bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara return rc; 41907bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara } 4191284901a90a9e0b812ca3f5f852cbbfb60d10249dYang Hongyang rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)); 41927bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara if (rc) { 41937bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara dev_printk(KERN_ERR, &pdev->dev, 41947bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara "32-bit consistent DMA enable failed\n"); 41957bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara return rc; 41967bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara } 41977bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara } 41987bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara 41997bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara return rc; 42007bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara} 42017bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara 420205b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 420305b308e1df6d9d673daedb517969241f41278b52Brett Russ * mv_print_info - Dump key info to kernel log for perusal. 42044447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo * @host: ATA host to print info about 420505b308e1df6d9d673daedb517969241f41278b52Brett Russ * 420605b308e1df6d9d673daedb517969241f41278b52Brett Russ * FIXME: complete this. 420705b308e1df6d9d673daedb517969241f41278b52Brett Russ * 420805b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 420905b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 421005b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 42114447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heostatic void mv_print_info(struct ata_host *host) 421231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ{ 42134447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo struct pci_dev *pdev = to_pci_dev(host->dev); 42144447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo struct mv_host_priv *hpriv = host->private_data; 421544c10138fd4bbc4b6d6bff0873c24902f2a9da65Auke Kok u8 scc; 4216c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik const char *scc_s, *gen; 421731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 421831961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ /* Use this to determine the HW stepping of the chip so we know 421931961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ * what errata to workaround 422031961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ */ 422131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ pci_read_config_byte(pdev, PCI_CLASS_DEVICE, &scc); 422231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ if (scc == 0) 422331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ scc_s = "SCSI"; 422431961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ else if (scc == 0x01) 422531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ scc_s = "RAID"; 422631961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ else 4227c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik scc_s = "?"; 4228c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik 4229c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik if (IS_GEN_I(hpriv)) 4230c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik gen = "I"; 4231c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik else if (IS_GEN_II(hpriv)) 4232c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik gen = "II"; 4233c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik else if (IS_GEN_IIE(hpriv)) 4234c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik gen = "IIE"; 4235c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik else 4236c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik gen = "?"; 423731961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 4238a9524a76f70f3343e4be27f95a7e92a8ba5f9009Jeff Garzik dev_printk(KERN_INFO, &pdev->dev, 4239c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik "Gen-%s %u slots %u ports %s mode IRQ via %s\n", 4240c1e4fe711a410a139095e6b3e3ce3f07f466063cJeff Garzik gen, (unsigned)MV_MAX_Q_DEPTH, host->n_ports, 424131961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ scc_s, (MV_HP_FLAG_MSI & hpriv->hp_flags) ? "MSI" : "INTx"); 424231961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ} 424331961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ 424405b308e1df6d9d673daedb517969241f41278b52Brett Russ/** 4245f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara * mv_pci_init_one - handle a positive probe of a PCI Marvell host 424605b308e1df6d9d673daedb517969241f41278b52Brett Russ * @pdev: PCI device found 424705b308e1df6d9d673daedb517969241f41278b52Brett Russ * @ent: PCI device ID entry for the matched host 424805b308e1df6d9d673daedb517969241f41278b52Brett Russ * 424905b308e1df6d9d673daedb517969241f41278b52Brett Russ * LOCKING: 425005b308e1df6d9d673daedb517969241f41278b52Brett Russ * Inherited from caller. 425105b308e1df6d9d673daedb517969241f41278b52Brett Russ */ 4252f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic int mv_pci_init_one(struct pci_dev *pdev, 4253f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara const struct pci_device_id *ent) 425420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 42552dcb407e61458ded17503d6bd12b8c064965368bJeff Garzik static int printed_version; 425620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ unsigned int board_idx = (unsigned int)ent->driver_data; 42574447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo const struct ata_port_info *ppi[] = { &mv_port_info[board_idx], NULL }; 42584447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo struct ata_host *host; 42594447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo struct mv_host_priv *hpriv; 4260c4bc7d7310a40c8c0b917e88983dc4a8e6b59e38Saeed Bishara int n_ports, port, rc; 426120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 4262a9524a76f70f3343e4be27f95a7e92a8ba5f9009Jeff Garzik if (!printed_version++) 4263a9524a76f70f3343e4be27f95a7e92a8ba5f9009Jeff Garzik dev_printk(KERN_INFO, &pdev->dev, "version " DRV_VERSION "\n"); 426420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 42654447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo /* allocate host */ 42664447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo n_ports = mv_get_hc_count(ppi[0]->flags) * MV_PORTS_PER_HC; 42674447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo 42684447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo host = ata_host_alloc_pinfo(&pdev->dev, ppi, n_ports); 42694447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo hpriv = devm_kzalloc(&pdev->dev, sizeof(*hpriv), GFP_KERNEL); 42704447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo if (!host || !hpriv) 42714447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo return -ENOMEM; 42724447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo host->private_data = hpriv; 4273f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara hpriv->n_ports = n_ports; 42741bfeff03f8a52eb896e5aad33d52e2451437bb0bSaeed Bishara hpriv->board_idx = board_idx; 42754447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo 42764447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo /* acquire resources */ 427724dc5f33ea4b504cfbd23fa159a4cacba8e4d800Tejun Heo rc = pcim_enable_device(pdev); 427824dc5f33ea4b504cfbd23fa159a4cacba8e4d800Tejun Heo if (rc) 427920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ return rc; 428020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 42810d5ff566779f894ca9937231a181eb31e4adff0eTejun Heo rc = pcim_iomap_regions(pdev, 1 << MV_PRIMARY_BAR, DRV_NAME); 42820d5ff566779f894ca9937231a181eb31e4adff0eTejun Heo if (rc == -EBUSY) 428324dc5f33ea4b504cfbd23fa159a4cacba8e4d800Tejun Heo pcim_pin_device(pdev); 42840d5ff566779f894ca9937231a181eb31e4adff0eTejun Heo if (rc) 428524dc5f33ea4b504cfbd23fa159a4cacba8e4d800Tejun Heo return rc; 42864447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo host->iomap = pcim_iomap_table(pdev); 4287f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara hpriv->base = host->iomap[MV_PRIMARY_BAR]; 428820f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 4289d88184fb2348a50f7c34f5d49a901c875b2e0114Jeff Garzik rc = pci_go_64(pdev); 4290d88184fb2348a50f7c34f5d49a901c875b2e0114Jeff Garzik if (rc) 4291d88184fb2348a50f7c34f5d49a901c875b2e0114Jeff Garzik return rc; 4292d88184fb2348a50f7c34f5d49a901c875b2e0114Jeff Garzik 4293da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord rc = mv_create_dma_pools(hpriv, &pdev->dev); 4294da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord if (rc) 4295da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord return rc; 4296da2fa9baf06f33a8fa7aa3f56c9f2b4070ceca0eMark Lord 4297c4bc7d7310a40c8c0b917e88983dc4a8e6b59e38Saeed Bishara for (port = 0; port < host->n_ports; port++) { 4298c4bc7d7310a40c8c0b917e88983dc4a8e6b59e38Saeed Bishara struct ata_port *ap = host->ports[port]; 4299c4bc7d7310a40c8c0b917e88983dc4a8e6b59e38Saeed Bishara void __iomem *port_mmio = mv_port_base(hpriv->base, port); 4300c4bc7d7310a40c8c0b917e88983dc4a8e6b59e38Saeed Bishara unsigned int offset = port_mmio - hpriv->base; 4301c4bc7d7310a40c8c0b917e88983dc4a8e6b59e38Saeed Bishara 4302c4bc7d7310a40c8c0b917e88983dc4a8e6b59e38Saeed Bishara ata_port_pbar_desc(ap, MV_PRIMARY_BAR, -1, "mmio"); 4303c4bc7d7310a40c8c0b917e88983dc4a8e6b59e38Saeed Bishara ata_port_pbar_desc(ap, MV_PRIMARY_BAR, offset, "port"); 4304c4bc7d7310a40c8c0b917e88983dc4a8e6b59e38Saeed Bishara } 4305c4bc7d7310a40c8c0b917e88983dc4a8e6b59e38Saeed Bishara 430620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ /* initialize adapter */ 43071bfeff03f8a52eb896e5aad33d52e2451437bb0bSaeed Bishara rc = mv_init_host(host); 430824dc5f33ea4b504cfbd23fa159a4cacba8e4d800Tejun Heo if (rc) 430924dc5f33ea4b504cfbd23fa159a4cacba8e4d800Tejun Heo return rc; 431020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 43116d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord /* Enable message-switched interrupts, if requested */ 43126d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord if (msi && pci_enable_msi(pdev) == 0) 43136d3c30efc964fadf2e6270e6fceaeca3ce50027aMark Lord hpriv->hp_flags |= MV_HP_FLAG_MSI; 431420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 431531961943e3110c5a1c36b1e0069c29f7c4380e51Brett Russ mv_dump_pci_cfg(pdev, 0x68); 43164447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo mv_print_info(host); 431720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 43184447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo pci_set_master(pdev); 4319ea8b4db97aa41a66c05daa4055a1974692ccd52dJeff Garzik pci_try_set_mwi(pdev); 43204447d35156169cf136e829eb6b5cac2d6370f2d9Tejun Heo return ata_host_activate(host, pdev->irq, mv_interrupt, IRQF_SHARED, 4321c5d3e45a2200a0905dc45b72714726b7aac3aaf1Jeff Garzik IS_GEN_I(hpriv) ? &mv5_sht : &mv6_sht); 432220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 4323b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara 4324b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara#ifdef CONFIG_PM 4325b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bisharastatic int mv_pci_device_resume(struct pci_dev *pdev) 4326b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara{ 4327b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara struct ata_host *host = dev_get_drvdata(&pdev->dev); 4328b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara int rc; 4329b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara 4330b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara rc = ata_pci_device_do_resume(pdev); 4331b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara if (rc) 4332b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara return rc; 4333b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara 4334b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara /* initialize adapter */ 4335b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara rc = mv_init_host(host); 4336b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara if (rc) 4337b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara return rc; 4338b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara 4339b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara ata_host_resume(host); 4340b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara 4341b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara return 0; 4342b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara} 4343b2dec48ccaad004fc706352f82725d43369d9bd7Saeed Bishara#endif 43447bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara#endif 434520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 4346f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic int mv_platform_probe(struct platform_device *pdev); 4347f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bisharastatic int __devexit mv_platform_remove(struct platform_device *pdev); 4348f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 434920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russstatic int __init mv_init(void) 435020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 43517bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara int rc = -ENODEV; 43527bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara#ifdef CONFIG_PCI 43537bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara rc = pci_register_driver(&mv_pci_driver); 4354f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara if (rc < 0) 4355f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara return rc; 4356f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara#endif 4357f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara rc = platform_driver_register(&mv_platform_driver); 4358f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara 4359f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara#ifdef CONFIG_PCI 4360f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara if (rc < 0) 4361f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara pci_unregister_driver(&mv_pci_driver); 43627bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara#endif 43637bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara return rc; 436420f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 436520f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 436620f733e7d75a16bffc34842b7682c9247dd5f954Brett Russstatic void __exit mv_exit(void) 436720f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ{ 43687bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara#ifdef CONFIG_PCI 436920f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ pci_unregister_driver(&mv_pci_driver); 43707bb3c5290ca0ec9e65947c907495c2b56e895e46Saeed Bishara#endif 4371f351b2d638c3cb0b95adde3549b7bfaf3f991dfaSaeed Bishara platform_driver_unregister(&mv_platform_driver); 437220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ} 437320f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 437420f733e7d75a16bffc34842b7682c9247dd5f954Brett RussMODULE_AUTHOR("Brett Russ"); 437520f733e7d75a16bffc34842b7682c9247dd5f954Brett RussMODULE_DESCRIPTION("SCSI low-level driver for Marvell SATA controllers"); 437620f733e7d75a16bffc34842b7682c9247dd5f954Brett RussMODULE_LICENSE("GPL"); 437720f733e7d75a16bffc34842b7682c9247dd5f954Brett RussMODULE_DEVICE_TABLE(pci, mv_pci_tbl); 437820f733e7d75a16bffc34842b7682c9247dd5f954Brett RussMODULE_VERSION(DRV_VERSION); 437917c5aab5b34e351531466e35b154ca86db7d46a9Mark LordMODULE_ALIAS("platform:" DRV_NAME); 438020f733e7d75a16bffc34842b7682c9247dd5f954Brett Russ 438120f733e7d75a16bffc34842b7682c9247dd5f954Brett Russmodule_init(mv_init); 438220f733e7d75a16bffc34842b7682c9247dd5f954Brett Russmodule_exit(mv_exit); 4383