Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20;
From:   wei.fang@nxp.com
To:     davem@davemloft.net, edumazet@google.com, kuba@kernel.org,
        pabeni@redhat.com
Cc:     netdev@vger.kernel.org, linux-kernel@vger.kernel.org
Subject: [PATCH V2 net-next] net: fec: add stop mode support for imx8 platform
Date:   Fri,  2 Sep 2022 10:30:01 +0800
Message-Id: <20220902023001.2258165-1-wei.fang@nxp.com>
Content-Transfer-Encoding: 8bit
Content-Type: text/plain
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0: =?us-ascii?Q?3cfT8KbEU7sjlumZSI0N3cEuQf8DRHwJ//iq9GNPuZ/yxu6kI584ALdcQwCM?=
 =?us-ascii?Q?Ca7bgEgjh6vH8PWWoFrhHmFnrCLn2rFIaTAE53ic/8Mgd7wIqTXEyCiFoGOE?=
 =?us-ascii?Q?0qOPzRwKKv2AgUnPHf/3H0zckEPgLU/eRdL6h//GOr0lbLXb4qErxkvrlMBi?=
 =?us-ascii?Q?oUbReREjzTVZQHzpVQssLLjdSad47SKRD9glD3r/HNbo82187byPYzCs3MvO?=
 =?us-ascii?Q?yNcVQxiIzJPNkC+RODxndH1BnFQVrx+ITEZcKhau+JTVtgUMQV99iHCvcmee?=
 =?us-ascii?Q?nNsbSsd8Kvc9kmoyjraKAO55LD1Fsc5BRlSuWIai3kuEg/cuWfN+Fp1m4u4g?=
 =?us-ascii?Q?lkHKkCsyBmAeb2M9KlfypLHaunMaKcZrBVuzxNORD/c4OY4aswAeeqMojoP7?=
 =?us-ascii?Q?2kMopDY7wpTLhTn5HYnI88HyUKm6mpdUrvZsEqL63N9S3Env5nGi5XSc8P5/?=
 =?us-ascii?Q?kEZhvE2/XxuL2WtWTktxOWEQ/P7ofsvW9oWrhmmaW3Ol7uTkGBtHdNQq8YUK?=
 =?us-ascii?Q?HkFvoClyo+wkc228hUOGytB79Z3YC2WgXdWBU6fpv5yI2EalQ2jpq4Ppl8g0?=
 =?us-ascii?Q?L+CmIvdTlAoYgk5Wobvi43i/BPe8D56aKGx4098mqhlnyKeKQXGgktgenuDf?=
 =?us-ascii?Q?QquZxpttklF9iuHiaejkFydwKg+paF0Ff1yl5Ow3HMZ8AqCSIOfKt6dRx37Q?=
 =?us-ascii?Q?AqyvKJJkGf62RZ1wo00QW4uDMv/HZGz+cnDDOpp+SX6JD01i7wQ5+9ZtAmeD?=
 =?us-ascii?Q?SDOOrzY5vGzpbLyQkR/1oP1HlMlofE1C5SKL98VpfsssgunDKemlWnK0cnJ9?=
 =?us-ascii?Q?gU6Wkc6t+Xo0Q2yDLcJaL7nhVtqP4gfLO8mhQ8P1UQrIG/YJ+M+1/gkr9XiN?=
 =?us-ascii?Q?UbzPCVeLvhNCO+g/WjWP97rBehpTomMMjwwsRnF5uEClcljyKMtvtqnyinww?=
 =?us-ascii?Q?7YlwZbrb1GXZKK6g+CrnPSbeHX40Qc0waIFZzEPt09pnR9DmKAO/Y/5uN5Nh?=
 =?us-ascii?Q?3/SpUA+ajVleywhjgJJFEf4mrIwufVLJatJi959llaKfMAHWfm93rlmGX/KH?=
 =?us-ascii?Q?z3UVxTFyBzqvpyhccA/DYLv6wULzjkcWjnR+Ytynw/+njq0qYb+kGpB5/KT7?=
 =?us-ascii?Q?CchfkVr03jz/K4TyP6OnGT5gNdknuxiFxOw1Mgf6uyk+heSBeZItOlRByXKD?=
 =?us-ascii?Q?eiMD2pPHQYS1wqMwmx01LflPbRqa+FsCj+8L2zdMynQH7bLuWTtC/MfwyJ71?=
 =?us-ascii?Q?r3xqyXhcFaAD7qV/fAL77P9XMyOtUVt/J46aeCcSvbuCJZl0OsyT4sbxwlxX?=
 =?us-ascii?Q?tkWCQkK073TGyDqBfL7mpKFUTf8eUJtelfgGSxl4mXwJDI3DTm0UXe8V6BdZ?=
 =?us-ascii?Q?ThpPNu+0uBHBGFlgSFEVzId1lg1k1PyQkGD3u/tNgk27QfQ5b/hjdyvU/1NB?=
 =?us-ascii?Q?nx8Rr+gBjjxCs+antBVSYWnHrMZf0DiO83b85K+EDajdg+yxmqLvbMTm4bay?=
 =?us-ascii?Q?+YPqt4ULfXo18dMC3ngkmZEhATIbwNeCkP+W42FQBGIwyHon4dc0a3+UzvxI?=
 =?us-ascii?Q?7Jq5TxOyYtrg6k6e9O7j2OBBiJRoJf9Wpcfopxxe?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: d070da7d-4ae6-4c64-bb60-08da8c8b11ce
X-MS-Exchange-CrossTenant-AuthSource: DB9PR04MB8106.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 02 Sep 2022 02:30:15.8148
 (UTC)
X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted
X-MS-Exchange-CrossTenant-Id: 686ea1d3-bc2b-4c6f-a92c-d99c5c301635
X-MS-Exchange-CrossTenant-MailboxType: HOSTED
X-MS-Exchange-CrossTenant-UserPrincipalName: ZqZR5Q8zz4jhxsNTxV6VIC/mL2uO7JxOVNmZiPuN6WB4OnQzRH9J/L4/G2qpJ8wgFBVm5iFD6JiRqqgPvi4AlA==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: DB3PR0402MB3705
X-Spam-Status: No, score=-2.1 required=5.0 tests=BAYES_00,DKIM_SIGNED,
        DKIM_VALID,DKIM_VALID_AU,DKIM_VALID_EF,RCVD_IN_DNSWL_NONE,
        RCVD_IN_MSPIKE_H2,SPF_HELO_PASS,SPF_PASS,T_SCC_BODY_TEXT_LINE
        autolearn=ham autolearn_force=no version=3.4.6
X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on
        lindbergh.monkeyblade.net
Precedence: bulk
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org

From: Wei Fang <wei.fang@nxp.com>

The current driver support stop mode by calling machine api.
The patch add dts support to set GPR register for stop request.

imx8mq enter stop/exit stop mode by setting GPR bit, which can
be accessed by A core.
imx8qm enter stop/exit stop mode by calling IMX_SC ipc APIs that
communicate with M core ipc service, and the M core set the related
GPR bit at last.

Signed-off-by: Wei Fang <wei.fang@nxp.com>
---
V2 change:
V1 patch does not apply, so rebase it.
---
 drivers/net/ethernet/freescale/fec.h      |  4 +++
 drivers/net/ethernet/freescale/fec_main.c | 35 +++++++++++++++++++++++
 2 files changed, 39 insertions(+)

diff --git a/drivers/net/ethernet/freescale/fec.h b/drivers/net/ethernet/freescale/fec.h
index 0cebe4b63adb..68bc16058bae 100644
--- a/drivers/net/ethernet/freescale/fec.h
+++ b/drivers/net/ethernet/freescale/fec.h
@@ -18,6 +18,8 @@
 #include <linux/net_tstamp.h>
 #include <linux/ptp_clock_kernel.h>
 #include <linux/timecounter.h>
+#include <dt-bindings/firmware/imx/rsrc.h>
+#include <linux/firmware/imx/sci.h>
 
 #if defined(CONFIG_M523x) || defined(CONFIG_M527x) || defined(CONFIG_M528x) || \
     defined(CONFIG_M520x) || defined(CONFIG_M532x) || defined(CONFIG_ARM) || \
@@ -641,6 +643,8 @@ struct fec_enet_private {
 		u8 at_inc_corr;
 	} ptp_saved_state;
 
+	struct imx_sc_ipc *ipc_handle;
+
 	u64 ethtool_stats[];
 };
 
diff --git a/drivers/net/ethernet/freescale/fec_main.c b/drivers/net/ethernet/freescale/fec_main.c
index 7211597d323d..8ba8eb340b92 100644
--- a/drivers/net/ethernet/freescale/fec_main.c
+++ b/drivers/net/ethernet/freescale/fec_main.c
@@ -1181,6 +1181,34 @@ fec_restart(struct net_device *ndev)
 
 }
 
+static int fec_enet_ipc_handle_init(struct fec_enet_private *fep)
+{
+	if (!(of_machine_is_compatible("fsl,imx8qm") ||
+	      of_machine_is_compatible("fsl,imx8qxp") ||
+	      of_machine_is_compatible("fsl,imx8dxl")))
+		return 0;
+
+	return imx_scu_get_handle(&fep->ipc_handle);
+}
+
+static void fec_enet_ipg_stop_set(struct fec_enet_private *fep, bool enabled)
+{
+	struct device_node *np = fep->pdev->dev.of_node;
+	u32 rsrc_id, val;
+	int idx;
+
+	if (!np || !fep->ipc_handle)
+		return;
+
+	idx = of_alias_get_id(np, "ethernet");
+	if (idx < 0)
+		idx = 0;
+	rsrc_id = idx ? IMX_SC_R_ENET_1 : IMX_SC_R_ENET_0;
+
+	val = enabled ? 1 : 0;
+	imx_sc_misc_set_control(fep->ipc_handle, rsrc_id, IMX_SC_C_IPG_STOP, val);
+}
+
 static void fec_enet_stop_mode(struct fec_enet_private *fep, bool enabled)
 {
 	struct fec_platform_data *pdata = fep->pdev->dev.platform_data;
@@ -1196,6 +1224,8 @@ static void fec_enet_stop_mode(struct fec_enet_private *fep, bool enabled)
 					   BIT(stop_gpr->bit), 0);
 	} else if (pdata && pdata->sleep_mode_enable) {
 		pdata->sleep_mode_enable(enabled);
+	} else {
+		fec_enet_ipg_stop_set(fep, enabled);
 	}
 }
 
@@ -3851,6 +3881,10 @@ fec_probe(struct platform_device *pdev)
 	    !of_property_read_bool(np, "fsl,err006687-workaround-present"))
 		fep->quirks |= FEC_QUIRK_ERR006687;
 
+	ret = fec_enet_ipc_handle_init(fep);
+	if (ret)
+		goto failed_ipc_init;
+
 	if (of_get_property(np, "fsl,magic-packet", NULL))
 		fep->wol_flag |= FEC_WOL_HAS_MAGIC_PACKET;
 
@@ -4048,6 +4082,7 @@ fec_probe(struct platform_device *pdev)
 		of_phy_deregister_fixed_link(np);
 	of_node_put(phy_node);
 failed_stop_mode:
+failed_ipc_init:
 failed_phy:
 	dev_id--;
 failed_ioremap:
-- 
2.25.1