From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-9.7 required=3.0 tests=DKIMWL_WL_HIGH,DKIM_SIGNED, DKIM_VALID,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_PATCH,MAILING_LIST_MULTI, MSGID_FROM_MTA_HEADER,SIGNED_OFF_BY,SPF_HELO_NONE,SPF_PASS,URIBL_BLOCKED, USER_AGENT_GIT autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 89FA0C433E1 for ; Tue, 7 Jul 2020 15:23:34 +0000 (UTC) Received: from merlin.infradead.org (merlin.infradead.org [205.233.59.134]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id 481B320853 for ; Tue, 7 Jul 2020 15:23:34 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=lists.infradead.org header.i=@lists.infradead.org header.b="m5l9p1s8"; dkim=fail reason="signature verification failed" (1024-bit key) header.d=voleatech.de header.i=@voleatech.de header.b="hZ7R/uEk" DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org 481B320853 Authentication-Results: mail.kernel.org; dmarc=fail (p=quarantine dis=none) header.from=voleatech.de Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=merlin.20170209; h=Sender:Content-Transfer-Encoding: Content-Type:Cc:List-Subscribe:List-Help:List-Post:List-Archive: List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To:Message-Id:Date: Subject:To:From:Reply-To:Content-ID:Content-Description:Resent-Date: Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=hZgWcJCxPpRfM8FI7AInHJiOGMykr9O9s4bWqyr+MzU=; b=m5l9p1s8hiWKaReUcRA5t8UMp rdqbxX6xASb9Wd+vEjye5qSxBSLoEABZn/7c1owZrhoe20S+7S9ANUy18GfUju4zrNve92gizjk6T yM/x+g5TRn4vwVsMvFCoLZTPVkcbinBIhOQFnSNflurLenI/q8a+JZLUZsAku1rT0rauJ2z0RY/Yl 4+XkYbPuZ44wr9tA4qshLp2S8HugoOxjbReryNo1lPbO1Va32j9AAk1MzlVVjGrx4tiG9Upp1DFA+ Ucz3uf62F6z2ZMeKtz4Av1zsKU2ipRTZbR4woRu2pDixNCoTR0cJ4x5E8ZhwZ+LM+Nng2aMQ8HB+1 mvcGXFRFQ==; Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1jspPu-0005ml-Fa; Tue, 07 Jul 2020 15:21:54 +0000 Received: from mail-db8eur05on2119.outbound.protection.outlook.com ([40.107.20.119] helo=EUR05-DB8-obe.outbound.protection.outlook.com) by merlin.infradead.org with esmtps (Exim 4.92.3 #3 (Red Hat Linux)) id 1jspPa-0005ec-LX for linux-arm-kernel@lists.infradead.org; Tue, 07 Jul 2020 15:21:36 +0000 ARC-Seal: i=1; a=rsa-sha256; s=arcselector9901; d=microsoft.com; cv=none; b=oWHUCo/WeI3+UFSP1/AOiMK5ivn0hXK5HLtSu9FwABZQZmtu7Yz/tsBcegTDMsW5g/TBuqpJgu9Jd72DlwOZJS3rPZMCtuVvN6S+Eujh7p7hasKQXEpXUUm47DSRqgMmwM3bJ9XomrnnjUxfe5oeP4nx69pde/kYswENfZ+ux5dsRvP+Vgef0SVgkpyj2vAIecmwO8Cg4zWtZTo3iyt4O7FFWAzuQYU08gXllE8O64eN5wntEhBO5u4ddV4Qvdw6ysQxoVWMgWXHEhLRGsYCBHt+y0E0J5jmt8ibvzrMJbQEmY3jjkGcfclWDSe+t8vLy+0ojvbSZdJU45GUShkysg== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=microsoft.com; s=arcselector9901; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=DQXjikctgJcHuuPcRCgVm3kBFyL/4d/HT6S9MWWUAPk=; b=mNC/BVZd9BU1y7V943g5Q1JlfqaqWdi5NLqlnNVyrkuTp2lE8QFecmW99TiDMGqL64bd2Em4TUZ4Uj0lS36y37lLHhs+Wtf2QA3kiWYs6FOuHScttdTO2o68DhBM2JF79cnvZKsqwANRK2zfAsVUtS7aorejn8cLtN052pCBKXwJGlTa8gKH9f/ofwGTcAhf3r8yb71g+LBO10+eWFbKAeQSYpE3Rcs5J2TpW5G9kIEft6KguRNPnThvIRpmgXjhAY5KWK+Al/MIQgAjwhuasJ2fHfACOvkibnmVMLc0jJ9P7xVfxY71zaD1G+LVrBQnyrRNCKf5Q77YWA01oCt0Qw== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=pass smtp.mailfrom=voleatech.de; dmarc=pass action=none header.from=voleatech.de; dkim=pass header.d=voleatech.de; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=voleatech.de; s=selector2; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=DQXjikctgJcHuuPcRCgVm3kBFyL/4d/HT6S9MWWUAPk=; b=hZ7R/uEkGxlvcMXFpSCImjRYYA/JoaNoj1tJnBYrpFS4E9jj25a0xOU7T5XSgJ+TqjlMSgen0teZ8mH2Kf6NxqYVflTIu0CINz/WKf0BB/0yC2C9LwDowDlbepbYUK5WPh51+zzpMYMQUjQs9AEKIx/RYhjLTpZaaG3cZirhjdk= Authentication-Results: lists.infradead.org; dkim=none (message not signed) header.d=none;lists.infradead.org; dmarc=none action=none header.from=voleatech.de; Received: from AM4PR0501MB2785.eurprd05.prod.outlook.com (2603:10a6:200:5d::11) by AM0PR05MB4226.eurprd05.prod.outlook.com (2603:10a6:208:57::22) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.3153.27; Tue, 7 Jul 2020 15:21:29 +0000 Received: from AM4PR0501MB2785.eurprd05.prod.outlook.com ([fe80::39a1:e237:5fef:6f39]) by AM4PR0501MB2785.eurprd05.prod.outlook.com ([fe80::39a1:e237:5fef:6f39%11]) with mapi id 15.20.3153.029; Tue, 7 Jul 2020 15:21:29 +0000 From: sven.auhagen@voleatech.de To: linux-arm-kernel@lists.infradead.org Subject: [PATCH 3/7] ata: ahci: mvebu: Add support for A8k legacy DT bindings Date: Tue, 7 Jul 2020 17:21:10 +0200 Message-Id: <20200707152114.53890-4-sven.auhagen@voleatech.de> X-Mailer: git-send-email 2.24.3 (Apple Git-128) In-Reply-To: <20200707152114.53890-1-sven.auhagen@voleatech.de> References: <20200707152114.53890-1-sven.auhagen@voleatech.de> X-ClientProxiedBy: AM0PR04CA0006.eurprd04.prod.outlook.com (2603:10a6:208:122::19) To AM4PR0501MB2785.eurprd05.prod.outlook.com (2603:10a6:200:5d::11) MIME-Version: 1.0 X-MS-Exchange-MessageSentRepresentingType: 1 Received: from SvensMacBookAir.sven.lan (109.193.235.168) by AM0PR04CA0006.eurprd04.prod.outlook.com (2603:10a6:208:122::19) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.3174.20 via Frontend Transport; Tue, 7 Jul 2020 15:21:28 +0000 X-Mailer: git-send-email 2.24.3 (Apple Git-128) X-Originating-IP: [109.193.235.168] X-MS-PublicTrafficType: Email X-MS-Office365-Filtering-Correlation-Id: 1bf5e039-ae5e-46cc-0d29-08d822896bdb X-MS-TrafficTypeDiagnostic: AM0PR05MB4226: X-Microsoft-Antispam-PRVS: X-MS-Oob-TLC-OOBClassifiers: OLM:663; X-Forefront-PRVS: 0457F11EAF X-MS-Exchange-SenderADCheck: 1 X-Microsoft-Antispam: BCL:0; X-Microsoft-Antispam-Message-Info: oH0V3MFxO7cTo16iK3QLGRC9pSyZjaUXo89SRjJcRdlAbrEU4Q547RPRuTKLxxvwpmY3XswunCbod19TD5TneiU4WL9gpxRHs2slYx8hPDUfj6mCS2cL9kjvuqfbXo599uP/A+Jud67Px3liA3AFDkV4LRgmHJw06UUZEc7/7Nqwc0xmGxbrxSrTg1aXxhQJwxEJehkkJqzOdwUVuJ4XGFvuWLOtBiqF/UU4sbAGc6QYe4h9P/u9fb3bm/U+SOyabfte/RI5TaGgkHhdY8gPV3c9ZxzuDfcwfXwyGR8kOh4fUvqna9fXAtNgI1rkIv0ZRlwMNdUdeTFb9ix20zfZ2Q== X-Forefront-Antispam-Report: CIP:255.255.255.255; CTRY:; LANG:en; SCL:1; SRV:; IPV:NLI; SFV:NSPM; H:AM4PR0501MB2785.eurprd05.prod.outlook.com; PTR:; CAT:NONE; SFTY:; SFS:(4636009)(396003)(346002)(39830400003)(376002)(366004)(136003)(6916009)(5660300002)(83380400001)(86362001)(508600001)(30864003)(6486002)(6666004)(4326008)(36756003)(316002)(956004)(2616005)(186003)(16526019)(52116002)(8936002)(8676002)(66476007)(66946007)(6512007)(1076003)(9686003)(2906002)(6506007)(26005)(66556008); DIR:OUT; SFP:1102; X-MS-Exchange-AntiSpam-MessageData: AXRtJhU280tSx/FYPAZlheoi/GLTuVzsYoETCdoaswda+1LEYDsVaYBxNt6ogjDnuHxqA4RdlSTdanjP8kdHN0+vgKgm09eoxs9bI1u1t+WJsNAvs4y4vHYPl6Z7RIScXh0mWq5iaFqM5U4HMfqYi4n/W4TyVHK93YMQhMpTsJDMwsdNVQbVG6As8qtxcXtZ0F+u21NsBFUr4J7sl7AmnhklDNz0T4rHw5t+PetvLtDPAzdtXu58OxBiFFNgrNG0BL7u950K5GjCGPHdEJ1gcadtWrGMk5CeA8xS4A/ZmztBbQxkW1Rr+WckfftsU7qQd3deA4KxsJhdLp5tdM/ViPHhB/u6zQrNfmIBvTcBHn1hkEqTTkXvshEuygGFGghx8Ey5INbUGRhQn84sCggRnXfL801ddokb+7lPfxG5lZ2hg4A8h/0UERmlHPTquzNWW1YcoGs7bHNBPK0QVTsv3oZIy8jFLt3hIfSVZuzaLioVyci8MPjiVkUrQNvE7G+A X-OriginatorOrg: voleatech.de X-MS-Exchange-CrossTenant-Network-Message-Id: 1bf5e039-ae5e-46cc-0d29-08d822896bdb X-MS-Exchange-CrossTenant-AuthSource: AM4PR0501MB2785.eurprd05.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 07 Jul 2020 15:21:29.0665 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-CrossTenant-Id: b82a99f6-7981-4a72-9534-4d35298f847b X-MS-Exchange-CrossTenant-MailboxType: HOSTED X-MS-Exchange-CrossTenant-UserPrincipalName: 9DHmgfsmn7eBeRN6dLZYNRAq2pG1dxUKah9E7JtGT8FBgKikf7hIQZuSxO4r9kiHfv7xtYIgBA9lnN5PJvd4fQ05s31FePC474Q8pUQcAik= X-MS-Exchange-Transport-CrossTenantHeadersStamped: AM0PR05MB4226 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20200707_112134_810344_921EC68A X-CRM114-Status: GOOD ( 22.89 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: baruch@tkos.co.il, antoine.tenart@bootlin.com, maxime.chevallier@bootlin.com, nadavh@marvell.com, thomas.petazzoni@bootlin.com, miquel.raynal@bootlin.com Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: Sven Auhagen 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 Signed-off-by: Miquel Raynal --- 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 #include #include +#include #include #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.24.3 (Apple Git-128) _______________________________________________ linux-arm-kernel mailing list linux-arm-kernel@lists.infradead.org http://lists.infradead.org/mailman/listinfo/linux-arm-kernel