From patchwork Mon Feb 8 14:08:12 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Serge Semin X-Patchwork-Id: 12075683 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=-14.3 required=3.0 tests=BAYES_00,DKIMWL_WL_HIGH, DKIM_SIGNED,DKIM_VALID,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_CR_TRAILER, INCLUDES_PATCH,MAILING_LIST_MULTI,SPF_HELO_NONE,SPF_PASS,URIBL_BLOCKED autolearn=unavailable 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 182DFC433DB for ; Mon, 8 Feb 2021 14:19:13 +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 AD03964E2E for ; Mon, 8 Feb 2021 14:19:12 +0000 (UTC) DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org AD03964E2E Authentication-Results: mail.kernel.org; dmarc=none (p=none dis=none) header.from=baikalelectronics.ru 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=arP6g5a9+T0ivJt05iefva7M/H80UH/Vqzrh5j9kqpY=; b=SwDP+pDUvbOWwSDU96NNcQpsw OScaQWrR5h+T9h8lxBCmfmIiXVzKqZ9NJwUMggw8p7uzwkHAZM5WoedSkO1YcOjPDi8JVo+6EW4gd QdPRq6EQw5L/46bsByLhTqfsb+Kw+3FxLNrjvH9Q6HNPi0gzyiihP0tKKTAWmX536jbCQ6gr/jC9U 26yMD2lZ8ewGn1PgFjOH0146ryx6avvGWCCo7TBB1fqG0AyCBznkKSi6bQ4FdwjsEF1jnrxUyjLjG ORtBu/vmHkNiW2czK/NBkIlkxmf7rY0lo2eiW7+K3iVw6AHIjICzQBfFX2isslKttuuLT9lKgotg0 7gv7rZdPg==; Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1l97M3-0001SM-4F; Mon, 08 Feb 2021 14:17:31 +0000 Received: from mail.baikalelectronics.com ([87.245.175.226] helo=mail.baikalelectronics.ru) by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1l97DM-0005Gu-GS for linux-arm-kernel@lists.infradead.org; Mon, 08 Feb 2021 14:08:39 +0000 From: Serge Semin To: Rob Herring , Giuseppe Cavallaro , Alexandre Torgue , Jose Abreu , "David S. Miller" , Jakub Kicinski , Maxime Coquelin Subject: [PATCH 08/16] net: stmmac: Introduce Safety Feature IRQs enable/disable methods Date: Mon, 8 Feb 2021 17:08:12 +0300 Message-ID: <20210208140820.10410-9-Sergey.Semin@baikalelectronics.ru> In-Reply-To: <20210208140820.10410-1-Sergey.Semin@baikalelectronics.ru> References: <20210208140820.10410-1-Sergey.Semin@baikalelectronics.ru> MIME-Version: 1.0 X-ClientProxiedBy: MAIL.baikal.int (192.168.51.25) To mail (192.168.51.25) X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20210208_090833_001516_952A296D X-CRM114-Status: GOOD ( 14.94 ) 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: devicetree@vger.kernel.org, netdev@vger.kernel.org, linux-kernel@vger.kernel.org, Serge Semin , Alexey Malahov , Serge Semin , Vyacheslav Mitrofanov , Pavel Parkhomenko , linux-stm32@st-md-mailman.stormreply.com, linux-arm-kernel@lists.infradead.org Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org Safety feature IRQs is another set of IRQs, which aside with the DMA, MAC, MTL, GPIOs, etc interrupts can be generated by the DW *MAC network devices. They are signalled by means of the shared sbd_intr_o lane too, so we need to be able mask/unmask these interrupts in the framework of the generic IRQs setup procedure. Note there is no need in preserving the Safety interrupts enable register content in the provided callbacks as these registers are changed in these methods only. Moreover by doing so we disable the interrupts, which are unsupported by the Safety IRQ status handler, if any of them have been enabled by default. Signed-off-by: Serge Semin --- Folks, the zero initialization of the DW xGMAC XGMAC_MTL_ECC_CONTROL register looks suspicious. Are you sure it is supposed to be cleared out in order to enable the safety IRQs? --- .../net/ethernet/stmicro/stmmac/dwmac4_core.c | 2 + drivers/net/ethernet/stmicro/stmmac/dwmac5.c | 36 +++++++++-------- drivers/net/ethernet/stmicro/stmmac/dwmac5.h | 2 + .../ethernet/stmicro/stmmac/dwxgmac2_core.c | 40 +++++++++++-------- drivers/net/ethernet/stmicro/stmmac/hwif.h | 6 +++ .../net/ethernet/stmicro/stmmac/stmmac_main.c | 6 +++ 6 files changed, 60 insertions(+), 32 deletions(-) diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac4_core.c b/drivers/net/ethernet/stmicro/stmmac/dwmac4_core.c index 9ad48a0f96a6..99296ff14616 100644 --- a/drivers/net/ethernet/stmicro/stmmac/dwmac4_core.c +++ b/drivers/net/ethernet/stmicro/stmmac/dwmac4_core.c @@ -1320,6 +1320,8 @@ const struct stmmac_ops dwmac510_ops = { .debug = dwmac4_debug, .set_filter = dwmac4_set_filter, .safety_feat_config = dwmac5_safety_feat_config, + .enable_safety_feat_irq = dwmac5_enable_safety_feat_irq, + .disable_safety_feat_irq = dwmac5_disable_safety_feat_irq, .safety_feat_irq_status = dwmac5_safety_feat_irq_status, .safety_feat_dump = dwmac5_safety_feat_dump, .rxp_config = dwmac5_rxp_config, diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac5.c b/drivers/net/ethernet/stmicro/stmmac/dwmac5.c index 8f7ac24545ef..43682a42b4d5 100644 --- a/drivers/net/ethernet/stmicro/stmmac/dwmac5.c +++ b/drivers/net/ethernet/stmicro/stmmac/dwmac5.c @@ -190,7 +190,7 @@ int dwmac5_safety_feat_config(void __iomem *ioaddr, unsigned int asp) if (!asp) return -EINVAL; - /* 1. Enable Safety Features */ + /* Enable Safety Features */ value = readl(ioaddr + MTL_ECC_CONTROL); value |= TSOEE; /* TSO ECC */ value |= MRXPEE; /* MTL RX Parser ECC */ @@ -199,30 +199,17 @@ int dwmac5_safety_feat_config(void __iomem *ioaddr, unsigned int asp) value |= MTXEE; /* MTL TX FIFO ECC */ writel(value, ioaddr + MTL_ECC_CONTROL); - /* 2. Enable MTL Safety Interrupts */ - value = readl(ioaddr + MTL_ECC_INT_ENABLE); - value |= RPCEIE; /* RX Parser Memory Correctable Error */ - value |= ECEIE; /* EST Memory Correctable Error */ - value |= RXCEIE; /* RX Memory Correctable Error */ - value |= TXCEIE; /* TX Memory Correctable Error */ - writel(value, ioaddr + MTL_ECC_INT_ENABLE); - - /* 3. Enable DMA Safety Interrupts */ - value = readl(ioaddr + DMA_ECC_INT_ENABLE); - value |= TCEIE; /* TSO Memory Correctable Error */ - writel(value, ioaddr + DMA_ECC_INT_ENABLE); - /* Only ECC Protection for External Memory feature is selected */ if (asp <= 0x1) return 0; - /* 5. Enable Parity and Timeout for FSM */ + /* Enable Parity and Timeout for FSM */ value = readl(ioaddr + MAC_FSM_CONTROL); value |= PRTYEN; /* FSM Parity Feature */ value |= TMOUTEN; /* FSM Timeout Feature */ writel(value, ioaddr + MAC_FSM_CONTROL); - /* 4. Enable Data Parity Protection */ + /* Enable Data Parity Protection */ value = readl(ioaddr + MTL_DPP_CONTROL); value |= EDPP; writel(value, ioaddr + MTL_DPP_CONTROL); @@ -239,6 +226,23 @@ int dwmac5_safety_feat_config(void __iomem *ioaddr, unsigned int asp) return 0; } +void dwmac5_enable_safety_feat_irq(void __iomem *ioaddr) +{ + /* Enable MTL Safety Interrupts: RX Parser Memory, EST, RX and Tx + * Memory Correctable Errors. + */ + writel(RPCEIE | ECEIE | RXCEIE | TXCEIE, ioaddr + MTL_ECC_INT_ENABLE); + + /* Enable DMA Safety Interrupts: TSO Memory Correctable Error. */ + writel(TCEIE, ioaddr + DMA_ECC_INT_ENABLE); +} + +void dwmac5_disable_safety_feat_irq(void __iomem *ioaddr) +{ + writel(0, ioaddr + MTL_ECC_INT_ENABLE); + writel(0, ioaddr + DMA_ECC_INT_ENABLE); +} + int dwmac5_safety_feat_irq_status(struct net_device *ndev, void __iomem *ioaddr, unsigned int asp, struct stmmac_safety_stats *stats) diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac5.h b/drivers/net/ethernet/stmicro/stmmac/dwmac5.h index 56b0762c1276..7709d206b6c3 100644 --- a/drivers/net/ethernet/stmicro/stmmac/dwmac5.h +++ b/drivers/net/ethernet/stmicro/stmmac/dwmac5.h @@ -99,6 +99,8 @@ #define GMAC_RXQCTRL_VFFQE BIT(16) int dwmac5_safety_feat_config(void __iomem *ioaddr, unsigned int asp); +void dwmac5_enable_safety_feat_irq(void __iomem *ioaddr); +void dwmac5_disable_safety_feat_irq(void __iomem *ioaddr); int dwmac5_safety_feat_irq_status(struct net_device *ndev, void __iomem *ioaddr, unsigned int asp, struct stmmac_safety_stats *stats); diff --git a/drivers/net/ethernet/stmicro/stmmac/dwxgmac2_core.c b/drivers/net/ethernet/stmicro/stmmac/dwxgmac2_core.c index 3a93e1b10d2e..cdcc15b9d5e5 100644 --- a/drivers/net/ethernet/stmicro/stmmac/dwxgmac2_core.c +++ b/drivers/net/ethernet/stmicro/stmmac/dwxgmac2_core.c @@ -834,28 +834,14 @@ static int dwxgmac3_safety_feat_config(void __iomem *ioaddr, unsigned int asp) if (!asp) return -EINVAL; - /* 1. Enable Safety Features */ + /* Enable Safety Features */ writel(0x0, ioaddr + XGMAC_MTL_ECC_CONTROL); - /* 2. Enable MTL Safety Interrupts */ - value = readl(ioaddr + XGMAC_MTL_ECC_INT_ENABLE); - value |= XGMAC_RPCEIE; /* RX Parser Memory Correctable Error */ - value |= XGMAC_ECEIE; /* EST Memory Correctable Error */ - value |= XGMAC_RXCEIE; /* RX Memory Correctable Error */ - value |= XGMAC_TXCEIE; /* TX Memory Correctable Error */ - writel(value, ioaddr + XGMAC_MTL_ECC_INT_ENABLE); - - /* 3. Enable DMA Safety Interrupts */ - value = readl(ioaddr + XGMAC_DMA_ECC_INT_ENABLE); - value |= XGMAC_DCEIE; /* Descriptor Cache Memory Correctable Error */ - value |= XGMAC_TCEIE; /* TSO Memory Correctable Error */ - writel(value, ioaddr + XGMAC_DMA_ECC_INT_ENABLE); - /* Only ECC Protection for External Memory feature is selected */ if (asp <= 0x1) return 0; - /* 4. Enable Parity and Timeout for FSM */ + /* Enable Parity and Timeout for FSM */ value = readl(ioaddr + XGMAC_MAC_FSM_CONTROL); value |= XGMAC_PRTYEN; /* FSM Parity Feature */ value |= XGMAC_TMOUTEN; /* FSM Timeout Feature */ @@ -864,6 +850,26 @@ static int dwxgmac3_safety_feat_config(void __iomem *ioaddr, unsigned int asp) return 0; } +void dwxgmac3_enable_safety_feat_irq(void __iomem *ioaddr) +{ + /* Enable MTL Safety Interrupts: RX Parser Memory, EST, RX and Tx + * Memory Correctable Errors. + */ + writel(XGMAC_RPCEIE | XGMAC_ECEIE | XGMAC_RXCEIE | XGMAC_TXCEIE, + ioaddr + XGMAC_MTL_ECC_INT_ENABLE); + + /* Enable DMA Safety Interrupts: Descriptor Cache, TSO Memory + * Correctable Errors. + */ + writel(XGMAC_DCEIE | XGMAC_TCEIE, ioaddr + XGMAC_DMA_ECC_INT_ENABLE); +} + +void dwxgmac3_disable_safety_feat_irq(void __iomem *ioaddr) +{ + writel(0, ioaddr + XGMAC_MTL_ECC_INT_ENABLE); + writel(0, ioaddr + XGMAC_DMA_ECC_INT_ENABLE); +} + static int dwxgmac3_safety_feat_irq_status(struct net_device *ndev, void __iomem *ioaddr, unsigned int asp, @@ -1510,6 +1516,8 @@ const struct stmmac_ops dwxgmac210_ops = { .debug = NULL, .set_filter = dwxgmac2_set_filter, .safety_feat_config = dwxgmac3_safety_feat_config, + .enable_safety_feat_irq = dwxgmac3_enable_safety_feat_irq, + .disable_safety_feat_irq = dwxgmac3_disable_safety_feat_irq, .safety_feat_irq_status = dwxgmac3_safety_feat_irq_status, .safety_feat_dump = dwxgmac3_safety_feat_dump, .set_mac_loopback = dwxgmac2_set_mac_loopback, diff --git a/drivers/net/ethernet/stmicro/stmmac/hwif.h b/drivers/net/ethernet/stmicro/stmmac/hwif.h index b933347cd991..fc26169e24f8 100644 --- a/drivers/net/ethernet/stmicro/stmmac/hwif.h +++ b/drivers/net/ethernet/stmicro/stmmac/hwif.h @@ -365,6 +365,8 @@ struct stmmac_ops { void (*pcs_get_adv_lp)(void __iomem *ioaddr, struct rgmii_adv *adv); /* Safety Features */ int (*safety_feat_config)(void __iomem *ioaddr, unsigned int asp); + void (*enable_safety_feat_irq)(void __iomem *ioaddr); + void (*disable_safety_feat_irq)(void __iomem *ioaddr); int (*safety_feat_irq_status)(struct net_device *ndev, void __iomem *ioaddr, unsigned int asp, struct stmmac_safety_stats *stats); @@ -482,6 +484,10 @@ struct stmmac_ops { stmmac_do_void_callback(__priv, mac, pcs_get_adv_lp, __args) #define stmmac_safety_feat_config(__priv, __args...) \ stmmac_do_callback(__priv, mac, safety_feat_config, __args) +#define stmmac_enable_safety_feat_irq(__priv, __args...) \ + stmmac_do_void_callback(__priv, mac, enable_safety_feat_irq, __args) +#define stmmac_disable_safety_feat_irq(__priv, __args...) \ + stmmac_do_void_callback(__priv, mac, disable_safety_feat_irq, __args) #define stmmac_safety_feat_irq_status(__priv, __args...) \ stmmac_do_callback(__priv, mac, safety_feat_irq_status, __args) #define stmmac_safety_feat_dump(__priv, __args...) \ diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c index 33065195c499..ddcd82d02c27 100644 --- a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c +++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c @@ -4139,6 +4139,9 @@ static void stmmac_enable_irq(struct stmmac_priv *priv) maxq = max(priv->plat->rx_queues_to_use, priv->plat->tx_queues_to_use); + if (priv->dma_cap.asp) + stmmac_enable_safety_feat_irq(priv, priv->ioaddr); + for (chan = 0; chan < maxq; ++chan) { stmmac_enable_dma_irq(priv, priv->ioaddr, chan); @@ -4176,6 +4179,9 @@ static void stmmac_disable_irq(struct stmmac_priv *priv) stmmac_disable_dma_irq(priv, priv->ioaddr, chan); } + if (priv->dma_cap.asp) + stmmac_disable_safety_feat_irq(priv, priv->ioaddr); + enable_irq(priv->dev->irq); }