ahci: Add platform driver

This can be used for AHCI-compatible interfaces implemented inside System-On-Chip solutions, or AHCI devices connected via localbus. Signed-off-by: Anton Vorontsov <avorontsov@ru.mvista.com> Signed-off-by: Jeff Garzik <jgarzik@redhat.com>

ahci: Add platform driver
This can be used for AHCI-compatible interfaces implemented inside System-On-Chip solutions, or AHCI devices connected via localbus. Signed-off-by: Anton Vorontsov <avorontsov@ru.mvista.com> Signed-off-by: Jeff Garzik <jgarzik@redhat.com>
Anton Vorontsov · Jeff Garzik
1 parent 365cfa1ed5
Showing 4 changed files with 229 additions and 0 deletions Side-by-side Diff
drivers/ata/Kconfig
drivers/ata/Makefile
drivers/ata/ahci_platform.c
include/linux/ahci_platform.h
@@ -65,6 +65,14 @@
  
 	  If unsure, say N.
  
+config SATA_AHCI_PLATFORM
+	tristate "Platform AHCI SATA support"
+	help
+	  This option enables support for Platform AHCI Serial ATA
+	  controllers.
+
+	  If unsure, say N.
+
 config SATA_SIL24
 	tristate "Silicon Image 3124/3132 SATA support"
 	depends on PCI
@@ -2,6 +2,7 @@
 obj-$(CONFIG_ATA)		+= libata.o
  
 obj-$(CONFIG_SATA_AHCI)		+= ahci.o libahci.o
+obj-$(CONFIG_SATA_AHCI_PLATFORM) += ahci_platform.o libahci.o
 obj-$(CONFIG_SATA_SVW)		+= sata_svw.o
 obj-$(CONFIG_ATA_PIIX)		+= ata_piix.o
 obj-$(CONFIG_SATA_PROMISE)	+= sata_promise.o
+/*
+ * AHCI SATA platform driver
+ *
+ * Copyright 2004-2005  Red Hat, Inc.
+ *   Jeff Garzik <jgarzik@pobox.com>
+ * Copyright 2010  MontaVista Software, LLC.
+ *   Anton Vorontsov <avorontsov@ru.mvista.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2, or (at your option)
+ * any later version.
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/interrupt.h>
+#include <linux/device.h>
+#include <linux/platform_device.h>
+#include <linux/libata.h>
+#include <linux/ahci_platform.h>
+#include "ahci.h"
+
+static int __init ahci_probe(struct platform_device *pdev)
+{
+	struct device *dev = &pdev->dev;
+	struct ahci_platform_data *pdata = dev->platform_data;
+	struct ata_port_info pi = {
+		.flags		= AHCI_FLAG_COMMON,
+		.pio_mask	= ATA_PIO4,
+		.udma_mask	= ATA_UDMA6,
+		.port_ops	= &ahci_ops,
+	};
+	const struct ata_port_info *ppi[] = { &pi, NULL };
+	struct ahci_host_priv *hpriv;
+	struct ata_host *host;
+	struct resource *mem;
+	int irq;
+	int n_ports;
+	int i;
+	int rc;
+
+	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+	if (!mem) {
+		dev_err(dev, "no mmio space\n");
+		return -EINVAL;
+	}
+
+	irq = platform_get_irq(pdev, 0);
+	if (irq <= 0) {
+		dev_err(dev, "no irq\n");
+		return -EINVAL;
+	}
+
+	if (pdata && pdata->init) {
+		rc = pdata->init(dev);
+		if (rc)
+			return rc;
+	}
+
+	if (pdata && pdata->ata_port_info)
+		pi = *pdata->ata_port_info;
+
+	hpriv = devm_kzalloc(dev, sizeof(*hpriv), GFP_KERNEL);
+	if (!hpriv) {
+		rc = -ENOMEM;
+		goto err0;
+	}
+
+	hpriv->flags |= (unsigned long)pi.private_data;
+
+	hpriv->mmio = devm_ioremap(dev, mem->start, resource_size(mem));
+	if (!hpriv->mmio) {
+		dev_err(dev, "can't map %pR\n", mem);
+		rc = -ENOMEM;
+		goto err0;
+	}
+
+	ahci_save_initial_config(dev, hpriv,
+		pdata ? pdata->force_port_map : 0,
+		pdata ? pdata->mask_port_map  : 0);
+
+	/* prepare host */
+	if (hpriv->cap & HOST_CAP_NCQ)
+		pi.flags |= ATA_FLAG_NCQ;
+
+	if (hpriv->cap & HOST_CAP_PMP)
+		pi.flags |= ATA_FLAG_PMP;
+
+	ahci_set_em_messages(hpriv, &pi);
+
+	/* CAP.NP sometimes indicate the index of the last enabled
+	 * port, at other times, that of the last possible port, so
+	 * determining the maximum port number requires looking at
+	 * both CAP.NP and port_map.
+	 */
+	n_ports = max(ahci_nr_ports(hpriv->cap), fls(hpriv->port_map));
+
+	host = ata_host_alloc_pinfo(dev, ppi, n_ports);
+	if (!host) {
+		rc = -ENOMEM;
+		goto err0;
+	}
+
+	host->private_data = hpriv;
+
+	if (!(hpriv->cap & HOST_CAP_SSS) || ahci_ignore_sss)
+		host->flags |= ATA_HOST_PARALLEL_SCAN;
+	else
+		printk(KERN_INFO "ahci: SSS flag set, parallel bus scan disabled\n");
+
+	if (pi.flags & ATA_FLAG_EM)
+		ahci_reset_em(host);
+
+	for (i = 0; i < host->n_ports; i++) {
+		struct ata_port *ap = host->ports[i];
+
+		ata_port_desc(ap, "mmio %pR", mem);
+		ata_port_desc(ap, "port 0x%x", 0x100 + ap->port_no * 0x80);
+
+		/* set initial link pm policy */
+		ap->pm_policy = NOT_AVAILABLE;
+
+		/* set enclosure management message type */
+		if (ap->flags & ATA_FLAG_EM)
+			ap->em_message_type = ahci_em_messages;
+
+		/* disabled/not-implemented port */
+		if (!(hpriv->port_map & (1 << i)))
+			ap->ops = &ata_dummy_port_ops;
+	}
+
+	rc = ahci_reset_controller(host);
+	if (rc)
+		goto err0;
+
+	ahci_init_controller(host);
+	ahci_print_info(host, "platform");
+
+	rc = ata_host_activate(host, irq, ahci_interrupt, IRQF_SHARED,
+			       &ahci_sht);
+	if (rc)
+		goto err0;
+
+	return 0;
+err0:
+	if (pdata && pdata->exit)
+		pdata->exit(dev);
+	return rc;
+}
+
+static int __devexit ahci_remove(struct platform_device *pdev)
+{
+	struct device *dev = &pdev->dev;
+	struct ahci_platform_data *pdata = dev->platform_data;
+	struct ata_host *host = dev_get_drvdata(dev);
+
+	ata_host_detach(host);
+
+	if (pdata && pdata->exit)
+		pdata->exit(dev);
+
+	return 0;
+}
+
+static struct platform_driver ahci_driver = {
+	.probe = ahci_probe,
+	.remove = __devexit_p(ahci_remove),
+	.driver = {
+		.name = "ahci",
+		.owner = THIS_MODULE,
+	},
+};
+
+static int __init ahci_init(void)
+{
+	return platform_driver_probe(&ahci_driver, ahci_probe);
+}
+module_init(ahci_init);
+
+static void __exit ahci_exit(void)
+{
+	platform_driver_unregister(&ahci_driver);
+}
+module_exit(ahci_exit);
+
+MODULE_DESCRIPTION("AHCI SATA platform driver");
+MODULE_AUTHOR("Anton Vorontsov <avorontsov@ru.mvista.com>");
+MODULE_LICENSE("GPL");
+MODULE_ALIAS("platform:ahci");
+/*
+ * AHCI SATA platform driver
+ *
+ * Copyright 2004-2005  Red Hat, Inc.
+ *   Jeff Garzik <jgarzik@pobox.com>
+ * Copyright 2010  MontaVista Software, LLC.
+ *   Anton Vorontsov <avorontsov@ru.mvista.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2, or (at your option)
+ * any later version.
+ */
+
+#ifndef _AHCI_PLATFORM_H
+#define _AHCI_PLATFORM_H
+
+struct device;
+struct ata_port_info;
+
+struct ahci_platform_data {
+	int (*init)(struct device *dev);
+	void (*exit)(struct device *dev);
+	const struct ata_port_info *ata_port_info;
+	unsigned int force_port_map;
+	unsigned int mask_port_map;
+};
+
+#endif /* _AHCI_PLATFORM_H */
...	...	@@ -65,6 +65,14 @@
65	65
66	66	If unsure, say N.
67	67
	68	+config SATA_AHCI_PLATFORM
	69	+ tristate "Platform AHCI SATA support"
	70	+ help
	71	+ This option enables support for Platform AHCI Serial ATA
	72	+ controllers.
	73	+
	74	+ If unsure, say N.
	75	+
68	76	config SATA_SIL24
69	77	tristate "Silicon Image 3124/3132 SATA support"
70	78	depends on PCI
...	...	@@ -2,6 +2,7 @@
2	2	obj-$(CONFIG_ATA) += libata.o
3	3
4	4	obj-$(CONFIG_SATA_AHCI) += ahci.o libahci.o
	5	+obj-$(CONFIG_SATA_AHCI_PLATFORM) += ahci_platform.o libahci.o
5	6	obj-$(CONFIG_SATA_SVW) += sata_svw.o
6	7	obj-$(CONFIG_ATA_PIIX) += ata_piix.o
7	8	obj-$(CONFIG_SATA_PROMISE) += sata_promise.o
	1	+/*
	2	+ * AHCI SATA platform driver
	3	+ *
	4	+ * Copyright 2004-2005 Red Hat, Inc.
	5	+ * Jeff Garzik <jgarzik@pobox.com>
	6	+ * Copyright 2010 MontaVista Software, LLC.
	7	+ * Anton Vorontsov <avorontsov@ru.mvista.com>
	8	+ *
	9	+ * This program is free software; you can redistribute it and/or modify
	10	+ * it under the terms of the GNU General Public License as published by
	11	+ * the Free Software Foundation; either version 2, or (at your option)
	12	+ * any later version.
	13	+ */
	14	+
	15	+#include <linux/kernel.h>
	16	+#include <linux/module.h>
	17	+#include <linux/init.h>
	18	+#include <linux/interrupt.h>
	19	+#include <linux/device.h>
	20	+#include <linux/platform_device.h>
	21	+#include <linux/libata.h>
	22	+#include <linux/ahci_platform.h>
	23	+#include "ahci.h"
	24	+
	25	+static int __init ahci_probe(struct platform_device *pdev)
	26	+{
	27	+ struct device *dev = &pdev->dev;
	28	+ struct ahci_platform_data *pdata = dev->platform_data;
	29	+ struct ata_port_info pi = {
	30	+ .flags = AHCI_FLAG_COMMON,
	31	+ .pio_mask = ATA_PIO4,
	32	+ .udma_mask = ATA_UDMA6,
	33	+ .port_ops = &ahci_ops,
	34	+ };
	35	+ const struct ata_port_info *ppi[] = { &pi, NULL };
	36	+ struct ahci_host_priv *hpriv;
	37	+ struct ata_host *host;
	38	+ struct resource *mem;
	39	+ int irq;
	40	+ int n_ports;
	41	+ int i;
	42	+ int rc;
	43	+
	44	+ mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	45	+ if (!mem) {
	46	+ dev_err(dev, "no mmio space\n");
	47	+ return -EINVAL;
	48	+ }
	49	+
	50	+ irq = platform_get_irq(pdev, 0);
	51	+ if (irq <= 0) {
	52	+ dev_err(dev, "no irq\n");
	53	+ return -EINVAL;
	54	+ }
	55	+
	56	+ if (pdata && pdata->init) {
	57	+ rc = pdata->init(dev);
	58	+ if (rc)
	59	+ return rc;
	60	+ }
	61	+
	62	+ if (pdata && pdata->ata_port_info)
	63	+ pi = *pdata->ata_port_info;
	64	+
	65	+ hpriv = devm_kzalloc(dev, sizeof(*hpriv), GFP_KERNEL);
	66	+ if (!hpriv) {
	67	+ rc = -ENOMEM;
	68	+ goto err0;
	69	+ }
	70	+
	71	+ hpriv->flags \|= (unsigned long)pi.private_data;
	72	+
	73	+ hpriv->mmio = devm_ioremap(dev, mem->start, resource_size(mem));
	74	+ if (!hpriv->mmio) {
	75	+ dev_err(dev, "can't map %pR\n", mem);
	76	+ rc = -ENOMEM;
	77	+ goto err0;
	78	+ }
	79	+
	80	+ ahci_save_initial_config(dev, hpriv,
	81	+ pdata ? pdata->force_port_map : 0,
	82	+ pdata ? pdata->mask_port_map : 0);
	83	+
	84	+ /* prepare host */
	85	+ if (hpriv->cap & HOST_CAP_NCQ)
	86	+ pi.flags \|= ATA_FLAG_NCQ;
	87	+
	88	+ if (hpriv->cap & HOST_CAP_PMP)
	89	+ pi.flags \|= ATA_FLAG_PMP;
	90	+
	91	+ ahci_set_em_messages(hpriv, &pi);
	92	+
	93	+ /* CAP.NP sometimes indicate the index of the last enabled
	94	+ * port, at other times, that of the last possible port, so
	95	+ * determining the maximum port number requires looking at
	96	+ * both CAP.NP and port_map.
	97	+ */
	98	+ n_ports = max(ahci_nr_ports(hpriv->cap), fls(hpriv->port_map));
	99	+
	100	+ host = ata_host_alloc_pinfo(dev, ppi, n_ports);
	101	+ if (!host) {
	102	+ rc = -ENOMEM;
	103	+ goto err0;
	104	+ }
	105	+
	106	+ host->private_data = hpriv;
	107	+
	108	+ if (!(hpriv->cap & HOST_CAP_SSS) \|\| ahci_ignore_sss)
	109	+ host->flags \|= ATA_HOST_PARALLEL_SCAN;
	110	+ else
	111	+ printk(KERN_INFO "ahci: SSS flag set, parallel bus scan disabled\n");
	112	+
	113	+ if (pi.flags & ATA_FLAG_EM)
	114	+ ahci_reset_em(host);
	115	+
	116	+ for (i = 0; i < host->n_ports; i++) {
	117	+ struct ata_port *ap = host->ports[i];
	118	+
	119	+ ata_port_desc(ap, "mmio %pR", mem);
	120	+ ata_port_desc(ap, "port 0x%x", 0x100 + ap->port_no * 0x80);
	121	+
	122	+ /* set initial link pm policy */
	123	+ ap->pm_policy = NOT_AVAILABLE;
	124	+
	125	+ /* set enclosure management message type */
	126	+ if (ap->flags & ATA_FLAG_EM)
	127	+ ap->em_message_type = ahci_em_messages;
	128	+
	129	+ /* disabled/not-implemented port */
	130	+ if (!(hpriv->port_map & (1 << i)))
	131	+ ap->ops = &ata_dummy_port_ops;
	132	+ }
	133	+
	134	+ rc = ahci_reset_controller(host);
	135	+ if (rc)
	136	+ goto err0;
	137	+
	138	+ ahci_init_controller(host);
	139	+ ahci_print_info(host, "platform");
	140	+
	141	+ rc = ata_host_activate(host, irq, ahci_interrupt, IRQF_SHARED,
	142	+ &ahci_sht);
	143	+ if (rc)
	144	+ goto err0;
	145	+
	146	+ return 0;
	147	+err0:
	148	+ if (pdata && pdata->exit)
	149	+ pdata->exit(dev);
	150	+ return rc;
	151	+}
	152	+
	153	+static int __devexit ahci_remove(struct platform_device *pdev)
	154	+{
	155	+ struct device *dev = &pdev->dev;
	156	+ struct ahci_platform_data *pdata = dev->platform_data;
	157	+ struct ata_host *host = dev_get_drvdata(dev);
	158	+
	159	+ ata_host_detach(host);
	160	+
	161	+ if (pdata && pdata->exit)
	162	+ pdata->exit(dev);
	163	+
	164	+ return 0;
	165	+}
	166	+
	167	+static struct platform_driver ahci_driver = {
	168	+ .probe = ahci_probe,
	169	+ .remove = __devexit_p(ahci_remove),
	170	+ .driver = {
	171	+ .name = "ahci",
	172	+ .owner = THIS_MODULE,
	173	+ },
	174	+};
	175	+
	176	+static int __init ahci_init(void)
	177	+{
	178	+ return platform_driver_probe(&ahci_driver, ahci_probe);
	179	+}
	180	+module_init(ahci_init);
	181	+
	182	+static void __exit ahci_exit(void)
	183	+{
	184	+ platform_driver_unregister(&ahci_driver);
	185	+}
	186	+module_exit(ahci_exit);
	187	+
	188	+MODULE_DESCRIPTION("AHCI SATA platform driver");
	189	+MODULE_AUTHOR("Anton Vorontsov <avorontsov@ru.mvista.com>");
	190	+MODULE_LICENSE("GPL");
	191	+MODULE_ALIAS("platform:ahci");