From: Sven Auhagen <sven.auhagen@xxxxxxxxxxxx>
The CP110 SATA unit has 2 ports, and a dedicated ICU entry per
port. In the past, the AHCI SATA driver only supported one interrupt
per SATA unit. To solve this conflict, the 2 SATA wired interrupts in
the South-Bridge got configured as 1 GIC interrupt in the
North-Bridge, regardless of the number of SATA ports actually
enabled/in use, and the DT bindings only referenced the interrupt of
one port.
Since then, this limitation has been addressed and this patch ensures
backward compatibility with old DTs not describing SATA ports
correctly directly from the AHCI MVEBU driver. This way, we will be
able to drop the hack from the ICU driver. IOW, when the A8k
compatible string is used and there is no sub-nodes in the DT, we
fake the creation and mapping of the second (missing) interrupt.
Signed-off-by: Sven Auhagen <sven.auhagen@xxxxxxxxxxxx>
Signed-off-by: Miquel Raynal <miquel.raynal@xxxxxxxxxxx>
---
drivers/ata/ahci.h | 3 +
drivers/ata/ahci_mvebu.c | 235 ++++++++++++++++++++++++++++++++-
drivers/ata/libahci.c | 3 +-
drivers/ata/libahci_platform.c | 3 +
include/linux/ahci_platform.h | 1 +
5 files changed, 239 insertions(+), 6 deletions(-)
diff --git a/drivers/ata/ahci.h b/drivers/ata/ahci.h
index d991dd46e89c..8cb256eec86b 100644
--- a/drivers/ata/ahci.h
+++ b/drivers/ata/ahci.h
@@ -407,6 +407,9 @@ int ahci_do_softreset(struct ata_link *link, unsigned int *class,
int ahci_do_hardreset(struct ata_link *link, unsigned int *class,
unsigned long deadline, bool *online);
+void ahci_handle_port_interrupt(struct ata_port *ap,
+ void __iomem *port_mmio, u32 status);
+
unsigned int ahci_qc_issue(struct ata_queued_cmd *qc);
int ahci_stop_engine(struct ata_port *ap);
void ahci_start_fis_rx(struct ata_port *ap);
diff --git a/drivers/ata/ahci_mvebu.c b/drivers/ata/ahci_mvebu.c
index 1cdc126882eb..62e9b94e2bba 100644
--- a/drivers/ata/ahci_mvebu.c
+++ b/drivers/ata/ahci_mvebu.c
@@ -16,6 +16,7 @@
#include <linux/mbus.h>
#include <linux/module.h>
#include <linux/of_device.h>
+#include <linux/of_irq.h>
#include <linux/platform_device.h>
#include "ahci.h"
@@ -28,9 +29,14 @@
#define AHCI_WINDOW_BASE(win) (0x64 + ((win) << 4))
#define AHCI_WINDOW_SIZE(win) (0x68 + ((win) << 4))
+#define ICU_SATA0_ICU_ID 109
+#define ICU_SATA1_ICU_ID 107
+
struct ahci_mvebu_plat_data {
int (*plat_config)(struct ahci_host_priv *hpriv);
unsigned int host_flags;
+ unsigned int resource_flags;
+ unsigned int port_irq[2];
};
static void ahci_mvebu_mbus_config(struct ahci_host_priv *hpriv,
@@ -96,6 +102,213 @@ static int ahci_mvebu_armada_3700_config(struct ahci_host_priv *hpriv)
return 0;
}
+static int ahci_get_per_port_irq_armada8k(struct ata_host *host, int port)
+{
+ struct ahci_host_priv *hpriv = host->private_data;
+ struct ahci_mvebu_plat_data *pdata = hpriv->plat_data;
+
+ return pdata->port_irq[port];
+}
+
+static irqreturn_t ahci_multi_irqs_intr_hard_armada8k(int irq, void *dev_instance)
+{
+ struct ata_port *ap = dev_instance;
+ struct ata_host *host = ap->host;
+ struct ahci_host_priv *hpriv = host->private_data;
+ void __iomem *port_mmio = ahci_port_base(ap);
+ void __iomem *mmio = hpriv->mmio;
+ u32 status;
+
+ VPRINTK("ENTER\n");
+
+ status = readl(port_mmio + PORT_IRQ_STAT);
+ writel(status, port_mmio + PORT_IRQ_STAT);
+
+ spin_lock(ap->lock);
+ ahci_handle_port_interrupt(ap, port_mmio, status);
+ spin_unlock(ap->lock);
+
+ writel(BIT(ap->port_no), mmio + HOST_IRQ_STAT);
+
+ VPRINTK("EXIT\n");
+
+ return IRQ_HANDLED;
+}
+
+static int ahci_host_activate_multi_irqs_armada8k(struct ata_host *host,
+ struct scsi_host_template *sht)
+{
+ struct ahci_host_priv *hpriv = host->private_data;
+ int i, rc;
+
+ rc = ata_host_start(host);
+ if (rc)
+ return rc;
+ /*
+ * Requests IRQs one per port
+ */
+ for (i = 0; i < host->n_ports; i++) {
+ struct ahci_port_priv *pp = host->ports[i]->private_data;
+ int irq = hpriv->get_irq_vector(host, i);
+
+ /* Do not receive interrupts sent by dummy ports */
+ if (!pp) {
+ disable_irq(irq);
+ continue;
+ }
+
+ rc = devm_request_irq(host->dev, irq, ahci_multi_irqs_intr_hard_armada8k,
+ 0, pp->irq_desc, host->ports[i]);
+
+ if (rc)
+ return rc;
+ ata_port_desc(host->ports[i], "irq %d", irq);
+ }
+
+ return ata_host_register(host, sht);
+}
+
+static int ahci_mvebu_armada_8k_irq_backwards(struct ahci_host_priv *hpriv,
+ struct device *dev)
+{
+ struct device_node *np = of_irq_find_parent(dev->of_node);
+ struct ahci_mvebu_plat_data *pdata = hpriv->plat_data;
+ struct irq_data *irqd = irq_get_irq_data(pdata->port_irq[0]);
+ int host_irq = irqd ? irqd_to_hwirq(irqd) : 0;
+ int missing_irq = (host_irq == ICU_SATA1_ICU_ID) ?
+ ICU_SATA0_ICU_ID : ICU_SATA1_ICU_ID;
+ struct irq_fwspec fwspec = {
+ .fwnode = of_node_to_fwnode(np),
+ .param_count = 2,
+ .param = {missing_irq, IRQ_TYPE_LEVEL_HIGH},
+ };
+
+ if (of_get_child_count(dev->of_node))
+ return 0;
+
+ pdata->port_irq[1] = irq_create_fwspec_mapping(&fwspec);
+ if (pdata->port_irq[1])
+ hpriv->mask_port_map = GENMASK(1, 0);
+
+ return 0;
+}
+
+static int ahci_platform_init_host_armada8k(struct platform_device *pdev,
+ struct ahci_host_priv *hpriv,
+ const struct ata_port_info *pi_template,
+ struct scsi_host_template *sht)
+{
+ struct ahci_mvebu_plat_data *pdata = hpriv->plat_data;
+ struct device *dev = &pdev->dev;
+ struct ata_port_info pi = *pi_template;
+ const struct ata_port_info *ppi[] = { &pi, NULL };
+ struct device_node *child;
+ struct ata_host *host;
+ int i, port_irq, n_ports, rc, child_nodes, port = 0;
+
+ /* Get IRQs per port */
+ child_nodes = of_get_child_count(dev->of_node);
+ if (child_nodes) {
+ for_each_child_of_node(dev->of_node, child) {
+
+ port_irq = of_irq_get(child, 0);
+ if (!port_irq)
+ port_irq = -EINVAL;
+ if (port_irq < 0) {
+ rc = port_irq;
+ return rc;
+ }
+
+ pdata->port_irq[port] = port_irq;
+ port++;
+ }
+ } else {
+ /* Backwards Compatibility Check */
+ port_irq = platform_get_irq(pdev, 0);
+ if (port_irq > 0) {
+ pdata->port_irq[0] = port_irq;
+ ahci_mvebu_armada_8k_irq_backwards(hpriv, dev);
+ } else {
+ dev_err(dev, "no irq\n");
+ return -EINVAL;
+ }
+ }
+
+ hpriv->get_irq_vector = ahci_get_per_port_irq_armada8k;
+
+ /* prepare host */
+ pi.private_data = (void *)(unsigned long)hpriv->flags;
+
+ ahci_save_initial_config(dev, hpriv);
+
+ 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)
+ return -ENOMEM;
+
+ host->private_data = hpriv;
+
+ if (!(hpriv->cap & HOST_CAP_SSS) || ahci_ignore_sss)
+ host->flags |= ATA_HOST_PARALLEL_SCAN;
+ else
+ dev_info(dev, "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",
+ platform_get_resource(pdev, IORESOURCE_MEM, 0));
+ ata_port_desc(ap, "port 0x%x", 0x100 + ap->port_no * 0x80);
+
+ /* set enclosure management message type */
+ if (ap->flags & ATA_FLAG_EM)
+ ap->em_message_type = hpriv->em_msg_type;
+
+ /* disabled/not-implemented port */
+ if (!(hpriv->port_map & (1 << i)))
+ ap->ops = &ata_dummy_port_ops;
+ }
+
+ if (hpriv->cap & HOST_CAP_64) {
+ rc = dma_coerce_mask_and_coherent(dev, DMA_BIT_MASK(64));
+ if (rc) {
+ rc = dma_coerce_mask_and_coherent(dev,
+ DMA_BIT_MASK(32));
+ if (rc) {
+ dev_err(dev, "Failed to enable 64-bit DMA.\n");
+ return rc;
+ }
+ dev_warn(dev, "Enable 32-bit DMA instead of 64-bit.\n");
+ }
+ }
+
+ rc = ahci_reset_controller(host);
+ if (rc)
+ return rc;
+
+ ahci_init_controller(host);
+ ahci_print_info(host, "platform");
+
+ return ahci_host_activate_multi_irqs_armada8k(host, sht);
+}
+
static int ahci_mvebu_armada_8k_config(struct ahci_host_priv *hpriv)
{
return 0;
@@ -189,15 +402,22 @@ static struct scsi_host_template ahci_platform_sht = {
static int ahci_mvebu_probe(struct platform_device *pdev)
{
- const struct ahci_mvebu_plat_data *pdata;
+ const struct ahci_mvebu_plat_data *pdata_plat;
+ struct ahci_mvebu_plat_data *pdata;
struct ahci_host_priv *hpriv;
int rc;
- pdata = of_device_get_match_data(&pdev->dev);
- if (!pdata)
+ pdata_plat = of_device_get_match_data(&pdev->dev);
+ if (!pdata_plat)
return -EINVAL;
- hpriv = ahci_platform_get_resources(pdev, 0);
+ pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
+ if (!pdata)
+ return -ENOMEM;
+
+ memcpy(pdata, pdata_plat, sizeof(*pdata));
+
+ hpriv = ahci_platform_get_resources(pdev, pdata->resource_flags);
if (IS_ERR(hpriv))
return PTR_ERR(hpriv);
@@ -214,7 +434,11 @@ static int ahci_mvebu_probe(struct platform_device *pdev)
if (rc)
goto disable_resources;
- rc = ahci_platform_init_host(pdev, hpriv, &ahci_mvebu_port_info,
+ if (pdata->resource_flags & AHCI_PLATFORM_A8K_QUIRK)
+ rc = ahci_platform_init_host_armada8k(pdev, hpriv, &ahci_mvebu_port_info,
+ &ahci_platform_sht);
+ else
+ rc = ahci_platform_init_host(pdev, hpriv, &ahci_mvebu_port_info,
&ahci_platform_sht);
if (rc)
goto disable_resources;
@@ -237,6 +461,7 @@ static const struct ahci_mvebu_plat_data ahci_mvebu_armada_3700_plat_data = {
static const struct ahci_mvebu_plat_data ahci_mvebu_armada_8k_plat_data = {
.plat_config = ahci_mvebu_armada_8k_config,
+ .resource_flags = AHCI_PLATFORM_A8K_QUIRK,
};
static const struct of_device_id ahci_mvebu_of_match[] = {
diff --git a/drivers/ata/libahci.c b/drivers/ata/libahci.c
index ea5bf5f4cbed..0e6eaa2e03a9 100644
--- a/drivers/ata/libahci.c
+++ b/drivers/ata/libahci.c
@@ -1799,7 +1799,7 @@ static void ahci_error_intr(struct ata_port *ap, u32 irq_stat)
ata_port_abort(ap);
}
-static void ahci_handle_port_interrupt(struct ata_port *ap,
+void ahci_handle_port_interrupt(struct ata_port *ap,
void __iomem *port_mmio, u32 status)
{
struct ata_eh_info *ehi = &ap->link.eh_info;
@@ -1882,6 +1882,7 @@ static void ahci_handle_port_interrupt(struct ata_port *ap,
ata_port_freeze(ap);
}
}
+EXPORT_SYMBOL_GPL(ahci_handle_port_interrupt);
static void ahci_port_intr(struct ata_port *ap)
{
diff --git a/drivers/ata/libahci_platform.c b/drivers/ata/libahci_platform.c
index 129556fcf6be..21332a33f766 100644
--- a/drivers/ata/libahci_platform.c
+++ b/drivers/ata/libahci_platform.c
@@ -464,6 +464,9 @@ struct ahci_host_priv *ahci_platform_get_resources(struct platform_device *pdev,
if (!child_nodes)
hpriv->nports = 1;
+ if (!child_nodes && flags & AHCI_PLATFORM_A8K_QUIRK)
+ hpriv->nports = 2;
+
hpriv->phys = devm_kcalloc(dev, hpriv->nports, sizeof(*hpriv->phys), GFP_KERNEL);
if (!hpriv->phys) {
rc = -ENOMEM;
diff --git a/include/linux/ahci_platform.h b/include/linux/ahci_platform.h
index 49e5383d4222..b31972e0bfbf 100644
--- a/include/linux/ahci_platform.h
+++ b/include/linux/ahci_platform.h
@@ -42,5 +42,6 @@ int ahci_platform_suspend(struct device *dev);
int ahci_platform_resume(struct device *dev);
#define AHCI_PLATFORM_GET_RESETS 0x01
+#define AHCI_PLATFORM_A8K_QUIRK 0x02
#endif /* _AHCI_PLATFORM_H */
--
2.20.1
