Date:	Sun, 18 Jul 2010 18:25:17 -0600
From:	Jens Axboe <jaxboe@...ionio.com>
To:	Jeff Garzik <jgarzik@...ox.com>
CC:	Matthew Garrett <mjg59@...f.ucam.org>,
	"linux-kernel@...r.kernel.org" <linux-kernel@...r.kernel.org>,
	Tejun Heo <tj@...nel.org>,
	Jesse Barnes <jbarnes@...tuousgeek.org>
Subject: Re: [PATCH[RFC] Quirk macbook pro 6,2 into ahci mode

On 07/18/2010 04:44 PM, Jeff Garzik wrote:
> On 07/18/2010 02:42 PM, Matthew Garrett wrote:
>> On Sun, Jul 18, 2010 at 10:03:44AM -0600, Jens Axboe wrote:
>>> Looking at the specs, I don't see what I am missing to make this
>>> work for resume. I'm assuming that EFI did initialize some bits
>>> that am missing when coming out of resume, but I don't know which
>>> bits.
>>
>> There's no guarantee that the AHCI BAR is programmed by the firmware (it
>> seems to be on the Macs, but won't be on most hardware). Is it getting
>> reprogrammed on resume?
> 
> That's definitely the key question.
> 
> I would have quirked AHCI/piix hardware into AHCI mode long ago, if 
> firmwares defaulting to piix mode would actually program the PCI BAR 
> correctly.
> 
> Or, if the firmware had some way to safely allocate a bus memory range, 
> which we could ourselves program into the PCI BAR.  Some non-PC 
> platforms can do that.

So I've dug a bit further, and I discovered that the AHCI BAR is indeed
not working on resume. I googled and found an older patch from Matthew
that hacks it in, but it still failed on resume. But a bit differently,
it seemed that now only interrupt delivery was problematic. I disabled
msi for this controller, and bingo it now works as expected and
suspend/resumes just fine.

The MSI registers were programmed on resume, so I'm quite sure which
extra bit needs to be fiddled to ensure that MSI works as well.

The patch I'm testing with now is below, it works but of course it a
hack in areas. I'm attaching the output from resume with the debug stuff
in, in case it helps anyone.


diff --git a/drivers/ata/ahci.c b/drivers/ata/ahci.c
index f252253..f0f3a9e 100644
--- a/drivers/ata/ahci.c
+++ b/drivers/ata/ahci.c
@@ -1119,6 +1119,10 @@ static int ahci_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
 	if (ahci_sb600_enable_64bit(pdev))
 		hpriv->flags &= ~AHCI_HFLAG_32BIT_ONLY;
 
+	/* turn off msi on mbp 6,2 ahci mode */
+	if (pdev->device == 0x3b29)
+		hpriv->flags |= AHCI_HFLAG_NO_MSI;
+
 	if ((hpriv->flags & AHCI_HFLAG_NO_MSI) || pci_enable_msi(pdev))
 		pci_intx(pdev, 1);
 
diff --git a/drivers/pci/probe.c b/drivers/pci/probe.c
index f4adba2..45e37b9 100644
--- a/drivers/pci/probe.c
+++ b/drivers/pci/probe.c
@@ -118,7 +118,7 @@ static inline unsigned int pci_calc_resource_flags(unsigned int flags)
 	return IORESOURCE_MEM;
 }
 
-static u64 pci_size(u64 base, u64 maxbase, u64 mask)
+u64 pci_size(u64 base, u64 maxbase, u64 mask)
 {
 	u64 size = mask & maxbase;	/* Find the significant bits */
 	if (!size)
diff --git a/drivers/pci/quirks.c b/drivers/pci/quirks.c
index 477345d..f153749 100644
--- a/drivers/pci/quirks.c
+++ b/drivers/pci/quirks.c
@@ -1020,6 +1020,205 @@ static void quirk_disable_pxb(struct pci_dev *pdev)
 DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_INTEL,	PCI_DEVICE_ID_INTEL_82454NX,	quirk_disable_pxb);
 DECLARE_PCI_FIXUP_RESUME_EARLY(PCI_VENDOR_ID_INTEL,	PCI_DEVICE_ID_INTEL_82454NX,	quirk_disable_pxb);
 
+struct pch_reg {
+	unsigned int offset;
+	unsigned int size;
+	const char *name;
+};
+
+static struct pch_reg pch_regs[] = {
+	{
+		.offset = 0x09,
+		.size	= 1,
+		.name	= "PI",
+	},
+	{
+		.offset = 0x0a,
+		.size	= 1,
+		.name	= "SCC",
+	},
+	{
+		.offset = 0x3c,
+		.size	= 1,
+		.name	= "INT_LN",
+	},
+	{
+		.offset = 0x3d,
+		.size	= 1,
+		.name	= "INT_PN",
+	},
+	{
+		.offset = 0x74,
+		.size	= 2,
+		.name	= "PMCS",
+	},
+	{
+		.offset = 0x82,
+		.size	= 2,
+		.name	= "MSIMC",
+	},
+	{
+		.offset = 0x84,
+		.size	= 4,
+		.name	= "MSIMA",
+	},
+	{
+		.offset = 0x88,
+		.size	= 2,
+		.name	= "MSIMD",
+	},
+	{
+		.offset = 0x90,
+		.size	= 2,
+		.name	= "MAP",
+	},
+	{
+		.offset = 0x92,
+		.size	= 2,
+		.name	= "PCS",
+	},
+	{
+		.offset = 0x94,
+		.size	= 4,
+		.name	= "SCLKCG",
+	},
+	{
+		.offset = 0x9c,
+		.size	= 4,
+		.name	= "SCLKGC",
+	},
+	{
+		.name	= NULL,
+	},
+};
+
+static void dump_regs(struct pci_dev *pdev, const char *msg)
+{
+	struct pch_reg *pr;
+	u8 byte;
+	u16 word;
+	u32 dword;
+	int i;
+
+	printk("%s:\n", msg);
+	for (i = 0; pch_regs[i].name; i++) {
+		int val;
+
+		pr = &pch_regs[i];
+		switch (pr->size) {
+		case 1:
+			pci_read_config_byte(pdev, pr->offset, &byte);
+			val = byte;
+			break;
+		case 2:
+			pci_read_config_word(pdev, pr->offset, &word);
+			val = word;
+			break;
+		case 4:
+			pci_read_config_dword(pdev, pr->offset, &dword);
+			val = dword;
+			break;
+		default:
+			val = -1;
+		}
+		printk("  reg %s(%x): %x\n", pr->name, pr->offset, val);
+	}
+}
+
+static void show_regions(struct pci_dev *pdev, const char *msg)
+{
+	int i;
+
+	printk("%s: \n", msg);
+	for (i = 0; i <= 5; i++)
+		printk("  BAR %d, res %pR\n", i, &pdev->resource[i]);
+		
+}
+
+/*
+ * This enables AHCI mode on Macbook Pro 6,2 and others based on Intels
+ * 5 series / 3400 series chipset.
+ *
+ * Info found here http://www.intel.com/Assets/PDF/datasheet/322169.pdf
+ */
+static void quirk_pch_ahci(struct pci_dev *pdev)
+{
+	u16 mode;
+
+	/*
+	 * 0x90 is the MAP register offset
+	 */
+	pci_read_config_word(pdev, 0x90, &mode);
+
+	/*
+	 * MAP.MV must be 0x00 to allow ahci enable
+	 */
+	if (mode & 0x03)
+		return;
+
+	/*
+	 * Already in AHCI mode?
+	 */
+	if (mode & (1 << 6))
+		return;
+
+	/*
+	 * MAP.SMS bit 6 is AHCI mode, MAP.SC bit 5 is port config
+	 */
+	mode = (1 << 6) | (1 << 5);
+	pci_write_config_word(pdev, 0x90, mode);
+
+	if ((pdev->class >> 8) == PCI_CLASS_STORAGE_IDE ||
+	    (pdev->class >> 8) == PCI_CLASS_STORAGE_SATA_AHCI) {
+		pci_write_config_byte(pdev, PCI_CLASS_PROG, 0x01);
+		pci_write_config_byte(pdev, PCI_CLASS_DEVICE, 0x06);
+		pdev->class = PCI_CLASS_STORAGE_SATA_AHCI;
+	}
+
+	/*
+	 * Re-read device id, it has now changed
+	 */
+	pci_read_config_word(pdev, PCI_DEVICE_ID, &pdev->device);
+
+	dump_regs(pdev, "boot");
+	show_regions(pdev, "boot");
+}
+DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_INTEL, 0x3b28, quirk_pch_ahci);
+
+static void pch_update_bar(struct pci_dev *pdev)
+{
+	if (pcim_iomap_regions(pdev, 1 << 5, "AHCI quirk")) {
+		int ret;
+
+		printk("AHCI BAR not set - attempting to program... ");
+		pdev->resource[5].flags = IORESOURCE_MEM;
+		ret = pci_allocate_resource(pdev, 5);
+		if (ret)
+			printk (KERN_INFO "Failed to allocate new region\n");
+		else
+			printk (KERN_INFO "Succeeded\n");
+	} else
+		pcim_iounmap_regions(pdev, 1 << 5);
+}
+
+static void quirk_pch_ahci_resume(struct pci_dev *pdev)
+{
+	show_regions(pdev, "resume");
+	dump_regs(pdev, "resume-pre");
+
+	quirk_pch_ahci(pdev);
+#if 0
+	pci_write_config_word(pdev, 0x74, 1 << 8);
+	pci_write_config_dword(pdev, 0x94, 0x3c000183);
+	pci_write_config_dword(pdev, 0x84, 0x00);
+	pci_write_config_word(pdev, 0x88, 0x00);
+#endif
+
+	dump_regs(pdev, "resume-post");
+	pch_update_bar(pdev);
+}
+DECLARE_PCI_FIXUP_RESUME_EARLY(PCI_VENDOR_ID_INTEL, 0x3b29, quirk_pch_ahci_resume);
+
 static void __devinit quirk_amd_ide_mode(struct pci_dev *pdev)
 {
 	/* set SBX00/Hudson-2 SATA in IDE mode to AHCI mode */
diff --git a/drivers/pci/setup-res.c b/drivers/pci/setup-res.c
index 92379e2..3255dd6 100644
--- a/drivers/pci/setup-res.c
+++ b/drivers/pci/setup-res.c
@@ -25,6 +25,59 @@
 #include <linux/slab.h>
 #include "pci.h"
 
+int pci_allocate_resource(struct pci_dev *dev, int resno)
+{
+	int err;
+	u32 size, mask, reg;
+	resource_size_t start;
+	struct resource *res = &dev->resource[resno];
+	struct resource *bres = pci_find_parent_resource(dev, res);
+
+	if (!bres) {
+		BUG();
+	}
+
+	if (!bres)
+		return -ENOMEM;
+	
+	if (res->flags & IORESOURCE_IO) {
+		mask = (u32)PCI_BASE_ADDRESS_IO_MASK;
+		start = PCIBIOS_MIN_IO;
+	} else {
+		mask = (u32)PCI_BASE_ADDRESS_MEM_MASK;
+		start = PCIBIOS_MIN_MEM;
+	}
+
+	if (resno < 6)
+		reg = PCI_BASE_ADDRESS_0 + 4 * resno;
+	else
+		return -EINVAL;
+
+	pci_write_config_dword(dev, reg, ~0);
+	pci_read_config_dword(dev, reg, &size);
+
+	if (!size || size == 0xffffffff)
+		return 0;
+
+	size = pci_size(0, size, mask);
+	
+	if (res->start != 0 && res->end != 0)
+		release_resource (res);
+
+	err = allocate_resource (bres, res, size+1, start, ~0U, 1024, NULL,
+				 NULL);
+
+	if (err) {
+		printk ("Failed to allocate a resource\n");
+		return err;
+	}
+
+	pci_update_resource(dev, resno);
+
+	return 0;
+}
+EXPORT_SYMBOL(pci_allocate_resource);
+
 
 void pci_update_resource(struct pci_dev *dev, int resno)
 {
diff --git a/include/linux/pci.h b/include/linux/pci.h
index 7cb0084..4385c9d 100644
--- a/include/linux/pci.h
+++ b/include/linux/pci.h
@@ -849,6 +849,8 @@ void pdev_sort_resources(struct pci_dev *, struct resource_list *);
 int pci_enable_resources(struct pci_dev *, int mask);
 void pci_fixup_irqs(u8 (*)(struct pci_dev *, u8 *),
 		    int (*)(struct pci_dev *, u8, u8));
+int pci_allocate_resource(struct pci_dev *dev, int resno);
+u64 pci_size(u64 base, u64 maxbase, u64 mask);
 #define HAVE_PCI_REQ_REGIONS	2
 int __must_check pci_request_regions(struct pci_dev *, const char *);
 int __must_check pci_request_regions_exclusive(struct pci_dev *, const char *);

-- 
Jens Axboe


View attachment "ahci-resume-debug" of type "text/plain" (2334 bytes)

Powered by blists - more mailing lists