Received-SPF: pass (google.com: domain of linux-kernel+bounces-172009-linux.lists.archive=gmail.com@vger.kernel.org designates 147.75.48.161 as permitted sender) client-ip=147.75.48.161;
From: Frank Li <Frank.Li@nxp.com>
Date: Tue, 07 May 2024 14:45:49 -0400
Subject: [PATCH v4 11/12] PCI: imx6: Call: Common PHY API to set mode,
 speed, and submode
Content-Type: text/plain; charset="utf-8"
Content-Transfer-Encoding: 7bit
Message-Id: <20240507-pci2_upstream-v4-11-e8c80d874057@nxp.com>
References: <20240507-pci2_upstream-v4-0-e8c80d874057@nxp.com>
In-Reply-To: <20240507-pci2_upstream-v4-0-e8c80d874057@nxp.com>
To: Richard Zhu <hongxing.zhu@nxp.com>, 
 Lucas Stach <l.stach@pengutronix.de>, 
 Lorenzo Pieralisi <lpieralisi@kernel.org>, 
 =?utf-8?q?Krzysztof_Wilczy=C5=84ski?= <kw@linux.com>, 
 Rob Herring <robh@kernel.org>, Bjorn Helgaas <bhelgaas@google.com>, 
 Shawn Guo <shawnguo@kernel.org>, Sascha Hauer <s.hauer@pengutronix.de>, 
 Pengutronix Kernel Team <kernel@pengutronix.de>, 
 Fabio Estevam <festevam@gmail.com>, NXP Linux Team <linux-imx@nxp.com>, 
 Philipp Zabel <p.zabel@pengutronix.de>, Liam Girdwood <lgirdwood@gmail.com>, 
 Mark Brown <broonie@kernel.org>, 
 Manivannan Sadhasivam <manivannan.sadhasivam@linaro.org>, 
 Krzysztof Kozlowski <krzysztof.kozlowski+dt@linaro.org>, 
 Conor Dooley <conor+dt@kernel.org>
Cc: linux-pci@vger.kernel.org, imx@lists.linux.dev, 
 linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org, 
 bpf@vger.kernel.org, devicetree@vger.kernel.org, 
 Frank Li <Frank.Li@nxp.com>
Precedence: bulk
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0:
	=?utf-8?B?Uit2UVRWYjdIZ1VwSVhJaE1tUlJtdFI3bVN0TWEvMnJXUmlBeXZONXNYaUxU?=
 =?utf-8?B?V1MyQ1RodFBPMWczWWpxZCtJTWVCMWlUSzR4OEFGVFdMN0JiZjYrY0EwZytt?=
 =?utf-8?B?Y2FwM0dDLzNjNFZ4bUVidUNnaUtUdkZXYlBUU2huZnhxenhnaXQ1Y2RYaHhH?=
 =?utf-8?B?dEFCMFBhcnRNOEVaZWN4SUJsNkc4TUN1WTNSUnc2L29FSzY3TjhjTWltK2gx?=
 =?utf-8?B?SmcreWcvVWdiVjRCMXkzVVVnS2YvNWYxMGJXK1hGbFpwb0JSeWxyS1k1Zk9S?=
 =?utf-8?B?aWk0OWZwY2c1MUN0U1BGM0c3SEV1TnVsMDlMN3gvL2NhakU2RE9QUWpaSmxZ?=
 =?utf-8?B?UEE2ZVFrSDlJRWZWWGxUSzJrOWhlSVZVMlBObkI4M3JGb3k0MkU2ajk5ZThW?=
 =?utf-8?B?aE4wdk53RFZJQmRmcGxFOXZrS1JDa1N1amp0Wjh4Ym5OOE5QclplWnRONGFq?=
 =?utf-8?B?N1FNM3MxUS9tUEFvZU5ScVpFajNLY3o2SzNIaTBKYUVDMUI5NURqRUJPKzdl?=
 =?utf-8?B?bExsN3dPR3J1MDQzeHlkeldBeUwyVS9SRE5NSm1oMUhqUnVIeUxvanVFS3NX?=
 =?utf-8?B?ejFJczRGWlQ0a3VyelhrVDJPWFhRUnlWV1JLcjBaSWs5K2x5RkVjcFBYYklp?=
 =?utf-8?B?MXNCSWlLaUdpdXBNaTJ5OGpucHI3MFlIMVFzQnhQRmFGLzdPekF3R1c0NWNJ?=
 =?utf-8?B?SHk1UXhCV1d5UTYrcDBDZ1hLRjAvRkxZY2U3K2JGK0JBNWtVdkx2RldBbWdN?=
 =?utf-8?B?bnpKMHh3bFBLUEtJVkF3Z0trdnpSOGVTVkp0RkQwMzM1Y3prYjJRdjI3N3pW?=
 =?utf-8?B?eVMxWE52T25XTytELzh3LzJkcHhNR2tYRmVzdmhIUkpJMkZtaVV6N2xWSjJ1?=
 =?utf-8?B?Wk1pTEo4aHFiUDh0NjlCZng3K0Y5Z1VNa0hVWEg4UFVCVEJoUFZ6ankwSzRo?=
 =?utf-8?B?bEdiUVlMNXBqYjYyeEppZUZaRzFVRnluVlRMQ3hZUXQySUpCWlVrR1Z5bmFt?=
 =?utf-8?B?UC9IV1BYNkNrOU5MNG1lQWEwY1pqVlZYQ3M2bWlxSlp2RVVNcUd4TC9xS25v?=
 =?utf-8?B?WHNaZGhiN0p3Yi9CbXF0R2tpMlE1L2NFSUlRaE1HVmVnRnlrMmY4WkJnZm13?=
 =?utf-8?B?MDRnU2xnZjU3ZlkrSHdVWHdRQXJXSmd6WFg3RllFTmVWOStRU0pNYmVKYysy?=
 =?utf-8?B?YnQ3cVFCZ1FaTDdHbFNJeURIeFRrZ2hETU0ybGx5MlN1VnNTWjJOU0YwbmQw?=
 =?utf-8?B?MXVTZWlMMStnTXRWYnpWZ3dLMVF4UE9pcmUyVGIyZmNwUmlKbFZnSmxJT2tz?=
 =?utf-8?B?SGlLekV3QVhNWThaM0hPUitZMUJwTzBNT1lZL2VSemJSejlCRHE5SG9RUXVv?=
 =?utf-8?B?S2Z4NEFKVkY5YytRNXErbG51UHRNTm9ZYjMxMkVPbmpLV3dlQmc4aFl3d1BW?=
 =?utf-8?B?aUF0ZTVkcFpSUW55QVVGenkrMnEvTUhGRTgwTnVVK2IxT2R3UXlrVFpKK2Vm?=
 =?utf-8?B?UEFwQjduYVJRNXg5MnhEV0VkeElac3BWTW9jeGtvYU10bkZwWUdGT3ZrL3V4?=
 =?utf-8?B?b2o1czRMTXZTUndOeEx4U2hUdUFBeU02Z05XVEJZeGI1YXYycmRDSXpwRncw?=
 =?utf-8?B?SWdzMGJMcUlqL05kT1lxdzk0RENaSmJuWk1QeEpUb3Fwdi9HaUxYcTFJS2Qv?=
 =?utf-8?B?Y21tYmhQdS9qTDJNNVVXMWhlTlJmdkNZUGdsQjNtb0RVbE84MWV1OUFWbUg5?=
 =?utf-8?B?VkxtVHNQMm9XVWNZMFNNL3hPUldpNFVvVzNpejhPMHhFM1R6dVBCUndpRStZ?=
 =?utf-8?B?Uk5RWVVsZjB3c1E0cElGMzh3STV1TjFpTk5SaHhKeGl1S0YxZWl0enZBUklx?=
 =?utf-8?B?cHQ4bFZHTkJYb2NHVGJUTDNCZFF1SEJUTHZuVWdJSHFWc0VCY1MrUkVpV3ZT?=
 =?utf-8?B?M1RybVA0WjNEWUtDaVlCV0hEcmFUKytXck9Eak5CTGZyM21VR0pWemRyMEI4?=
 =?utf-8?B?ZTVVMTVoMXhMY08ramlVNmFRYzBYTXdFQWx2TzN0ZnhXeUtHaGpQUlhRUjA4?=
 =?utf-8?B?U0YvZjFFdCtvdTdCSGNlZGR1M0YwdEFCQWNKQk5vWU85dmFNV05WOUhWWXN1?=
 =?utf-8?Q?t6AQfuVyj9HMWxwjwCZzJ9Xj5?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: 577e8acb-a1d5-4427-4e5e-08dc6ec62161
X-MS-Exchange-CrossTenant-AuthSource: PAXPR04MB9642.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 07 May 2024 18:47:22.3242
 (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: nvrNUWcSTYaHBRMGb/2tH2Oe3m8IcLfb1K1D352gy2T62g3yZIPHSLBCLJfG77LzK/rhBQvymM9HjEJa/MGoyA==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: DU0PR04MB9636

Invoke the common PHY API to configure mode, speed, and submode. While
these functions are optional in the PHY interface, they are necessary for
certain PHY drivers. Lack of support for these functions in a PHY driver
does not cause harm.

Signed-off-by: Frank Li <Frank.Li@nxp.com>
---
 drivers/pci/controller/dwc/pci-imx6.c | 13 +++++++++++++
 1 file changed, 13 insertions(+)

diff --git a/drivers/pci/controller/dwc/pci-imx6.c b/drivers/pci/controller/dwc/pci-imx6.c
index 9d53b545540c6..df623977d8fe6 100644
--- a/drivers/pci/controller/dwc/pci-imx6.c
+++ b/drivers/pci/controller/dwc/pci-imx6.c
@@ -30,6 +30,7 @@
 #include <linux/interrupt.h>
 #include <linux/reset.h>
 #include <linux/phy/phy.h>
+#include <linux/phy/pcie.h>
 #include <linux/pm_domain.h>
 #include <linux/pm_runtime.h>
 
@@ -308,6 +309,10 @@ static void imx_pcie_configure_type(struct imx_pcie *imx_pcie)
 
 	id = imx_pcie->controller_id;
 
+	/* If mode_mask[0] is 0, means use phy driver to set mode */
+	if (!drvdata->mode_mask[0])
+		return;
+
 	/* If mode_mask[id] is zero, means each controller have its individual gpr */
 	if (!drvdata->mode_mask[id])
 		id = 0;
@@ -887,6 +892,7 @@ static void imx_pcie_ltssm_enable(struct device *dev)
 	struct imx_pcie *imx_pcie = dev_get_drvdata(dev);
 	const struct imx_pcie_drvdata *drvdata = imx_pcie->drvdata;
 
+	phy_set_speed(imx_pcie->phy, PCI_EXP_LNKCAP_SLS_2_5GB);
 	if (drvdata->ltssm_mask)
 		regmap_update_bits(imx_pcie->iomuxc_gpr, drvdata->ltssm_off, drvdata->ltssm_mask,
 				   drvdata->ltssm_mask);
@@ -899,6 +905,7 @@ static void imx_pcie_ltssm_disable(struct device *dev)
 	struct imx_pcie *imx_pcie = dev_get_drvdata(dev);
 	const struct imx_pcie_drvdata *drvdata = imx_pcie->drvdata;
 
+	phy_set_speed(imx_pcie->phy, 0);
 	if (drvdata->ltssm_mask)
 		regmap_update_bits(imx_pcie->iomuxc_gpr, drvdata->ltssm_off,
 				   drvdata->ltssm_mask, 0);
@@ -1034,6 +1041,12 @@ static int imx_pcie_host_init(struct dw_pcie_rp *pp)
 			goto err_clk_disable;
 		}
 
+		ret = phy_set_mode_ext(imx_pcie->phy, PHY_MODE_PCIE, PHY_MODE_PCIE_RC);
+		if (ret) {
+			dev_err(dev, "unable to set pcie PHY mode\n");
+			goto err_phy_off;
+		}
+
 		ret = phy_power_on(imx_pcie->phy);
 		if (ret) {
 			dev_err(dev, "waiting for PHY ready timeout!\n");

-- 
2.34.1