From patchwork Tue May 7 18:45:43 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Frank Li X-Patchwork-Id: 13657572 Received: from EUR04-VI1-obe.outbound.protection.outlook.com (mail-vi1eur04on2051.outbound.protection.outlook.com [40.107.8.51]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 0FC3B16EC15; Tue, 7 May 2024 18:46:51 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=fail smtp.client-ip=40.107.8.51 ARC-Seal: i=2; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1715107614; cv=fail; b=OCyHRuMMW5QUzzYFLT0gsUu32jU+yKBtD1Fvo87Js1zCU7m0AOBL/jGJ0MEIdLuCNR1OR6T0fdq+If2iup58wFolxichtigmcKJadRkumwzktMqpG82WB8lkXsqnhBgCyowCM8N/XqprSbB30hR+h841PvbQkA+3w+plB0HSZaU= ARC-Message-Signature: i=2; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1715107614; c=relaxed/simple; bh=Cpqug5G7k49MqW0A3NFncM6Y5cYEpxavVt54pyo/9Qo=; h=From:Date:Subject:Content-Type:Message-Id:References:In-Reply-To: To:Cc:MIME-Version; b=tIJiDmCWHqoTLbGpn2wxisFb5Fz4/Ryfe/ztIKvK2RqfgTcKWV6Mhv0ihZ4wTtKVAzNmBGt6D08NsLA5QdN7K3iTwEOcKggW8JyacQGpPnzs1cy8+jSpLQYmqMG1m+TYK8HwHdEEYOVUsyocIBB0TKIxH99SaZpGsfPJ5ZNlDAI= ARC-Authentication-Results: i=2; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=nxp.com; spf=pass smtp.mailfrom=nxp.com; dkim=pass (1024-bit key) header.d=nxp.com header.i=@nxp.com header.b=UCaex8/p; arc=fail smtp.client-ip=40.107.8.51 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=nxp.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=nxp.com Authentication-Results: smtp.subspace.kernel.org; dkim=pass (1024-bit key) header.d=nxp.com header.i=@nxp.com header.b="UCaex8/p" ARC-Seal: i=1; a=rsa-sha256; s=arcselector9901; d=microsoft.com; cv=none; b=X04qXaaiC0595okiuRTgeJ5h0C7PK5co38cw1HDgZRpSWJ36ERX+Qh3nR4VOpSBT0Cty+3NGfllkQlOK7FJbqAJdTpfvx/DxXR0XYmU3FplNGemT5+86TTLdkYcr8NJUqSvaQdsQkBEk4hfpSagS/EUMR2kSEsOuXLt1araawdnkbH2chFTpgc8PoVlSFFHkEmVACl2r06AMwiKh3osudeNMQRPLaGg5DS0Ztsh+ja0vMUdYb2kJ4b0whr8U1tqGFZTzr1uyDXr60Oft6wpqnKNKPWy7uKvZo5Sj/jd2W6nUhnAPiNr9J16IJX9F1vesNCmLSJbvob0Vyn9zTQ68ag== 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-AntiSpam-MessageData-ChunkCount:X-MS-Exchange-AntiSpam-MessageData-0:X-MS-Exchange-AntiSpam-MessageData-1; bh=1nl/ELpxThlz8kTl1lbs0j8zTFjcylBahXo9Jv8iXEQ=; b=STE0mmZDrX9hhAOVD7lrmzGPyjuRCS0Ij0oRy60OFv8peYGqJvmHr4DQJ6tEo9neqeJaBOEBMEerFgq/7Shb8dfmggiBLhCiCNlvBGg54aUYHW6GBessGHwqXWeWZNyxpoIfEOQfh0OG3FSS17hBHKcN8bMgDdS5qzfo7uLQ2RaGJxgQ4rabhrQPT3VOrE+zT72mpUiIXsqZ80Qvy6xzXZEK4wvfr+ie+TspltnFzHv92pIrau1gg8rkp941vg62EF7pgmW9fSt0/gOvwKyi2r3IBCRpJFxU/n9ZnkYcL+tFhiSQpzh6fOJ2giNtK8QvzUpnHFoMoiqTYEyKDAHPRg== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=pass smtp.mailfrom=nxp.com; dmarc=pass action=none header.from=nxp.com; dkim=pass header.d=nxp.com; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=nxp.com; s=selector2; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=1nl/ELpxThlz8kTl1lbs0j8zTFjcylBahXo9Jv8iXEQ=; b=UCaex8/p1vPPrz21votM0zO6eoLEhHantCIdjlBf79AjJ2ODzaDtXAAiK0GRRF7c4D4SqrzRVuQPWSEx2dHXVPQ6hH7VszRRDULYYFreYt/ks9ZBkA3Idja3tPmJkhA2SgR+4pimqfmtQjfa84IP5W58kY6Qp3z1/ZMrqhGhz70= Authentication-Results: dkim=none (message not signed) header.d=none;dmarc=none action=none header.from=nxp.com; Received: from PAXPR04MB9642.eurprd04.prod.outlook.com (2603:10a6:102:240::14) by DU0PR04MB9636.eurprd04.prod.outlook.com (2603:10a6:10:320::21) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.7544.41; Tue, 7 May 2024 18:46:48 +0000 Received: from PAXPR04MB9642.eurprd04.prod.outlook.com ([fe80::1e67:dfc9:d0c1:fe58]) by PAXPR04MB9642.eurprd04.prod.outlook.com ([fe80::1e67:dfc9:d0c1:fe58%7]) with mapi id 15.20.7544.041; Tue, 7 May 2024 18:46:48 +0000 From: Frank Li Date: Tue, 07 May 2024 14:45:43 -0400 Subject: [PATCH v4 05/12] PCI: imx6: Simplify switch-case logic by involve core_reset callback Message-Id: <20240507-pci2_upstream-v4-5-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 , Lucas Stach , Lorenzo Pieralisi , =?utf-8?q?Krzysztof_Wilczy?= =?utf-8?q?=C5=84ski?= , Rob Herring , Bjorn Helgaas , Shawn Guo , Sascha Hauer , Pengutronix Kernel Team , Fabio Estevam , NXP Linux Team , Philipp Zabel , Liam Girdwood , Mark Brown , Manivannan Sadhasivam , Krzysztof Kozlowski , Conor Dooley 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 X-Mailer: b4 0.13-dev-e586c X-Developer-Signature: v=1; a=ed25519-sha256; t=1715107574; l=7027; i=Frank.Li@nxp.com; s=20240130; h=from:subject:message-id; bh=Cpqug5G7k49MqW0A3NFncM6Y5cYEpxavVt54pyo/9Qo=; b=lEu/WKLevwLBU+GsXyEDwvrd1ECLpXCE+545syYEZrWi459n2RA8Kly2lP5zalZ9HTiR+1r5W Fea6U/DC0OED4frS1NOFa2IqxnLTcpo54e9NgZsJt7QhU/DJh5OAcP7 X-Developer-Key: i=Frank.Li@nxp.com; a=ed25519; pk=I0L1sDUfPxpAkRvPKy7MdauTuSENRq+DnA+G4qcS94Q= X-ClientProxiedBy: BY5PR17CA0026.namprd17.prod.outlook.com (2603:10b6:a03:1b8::39) To PAXPR04MB9642.eurprd04.prod.outlook.com (2603:10a6:102:240::14) Precedence: bulk X-Mailing-List: bpf@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 X-MS-PublicTrafficType: Email X-MS-TrafficTypeDiagnostic: PAXPR04MB9642:EE_|DU0PR04MB9636:EE_ X-MS-Office365-Filtering-Correlation-Id: c0271a42-03b3-4e7e-a494-08dc6ec60d0f X-MS-Exchange-SenderADCheck: 1 X-MS-Exchange-AntiSpam-Relay: 0 X-Microsoft-Antispam: BCL:0;ARA:13230031|1800799015|376005|7416005|52116005|366007|921011|38350700005; X-Microsoft-Antispam-Message-Info: =?utf-8?q?AU6XW3EXou5XG99J/1I0hVyCmJKL+nD?= =?utf-8?q?9ZM5kq7M89Sc/XF3iv5odM4khKGh9ym2a7fHUD259aPv5fCNMa4NZosAVKzR67zQj?= =?utf-8?q?95PY18ZsorxywAhboMA3LERxa+foMeab5Fha4af+aJjPK7q3YzAXaZ7uJ4bZm7Uzn?= =?utf-8?q?Idyxig6b+7mnJEVX26E1u39Z83VX72Va737R45rO5uYGitzmA3NvdV5BPQG6yVop0?= =?utf-8?q?TH86xb1wWiW8/bdP5T34GXinZRKpyjrAz/KSQgzfFJm768PaKixUGDajfLkex3CLP?= =?utf-8?q?LBe1hf7i0v54viWfbaombOm7dXRPpCPYNiHZjIkv0WLHbikxohNyW52hC3wN17i4v?= =?utf-8?q?lseq0b2BUSb63LbSWnsgYNqotAxcsBRfm5FupoT/e/1BXtdmjWkOQwjyIkJBj57YJ?= =?utf-8?q?CLv3WnZXCw9gHdcoZ7YIG4vN+IActdHfm/Hn9dO8RKjoKIknJPVN1qyqOacW9CXRn?= =?utf-8?q?y19Z5GGIb+vTwnNC2IdzDmO0iHdRBSqa1OwodduHmB7SqmhPak9gUP16So16w3gMB?= =?utf-8?q?ukqbjAuEHO6QFcpe+SGTl2OAAvHsofMNNCRQxxvGSvRcv91qF0eL6aX2UyStyTORq?= =?utf-8?q?aJubynC+61c5WyHqPT0yH2cP0dZuzcXpxn56j9T1D9zYe/0iXz/J42+Ivz1MHXEno?= =?utf-8?q?9s7IRFNPjkLyZvA2HguC/l/F2uqFPouJ2L3gyuj+xuCAekXqz8fXSI6hv2rEdKuCj?= =?utf-8?q?89PetawaUpFcd7k7Kzy50303YONySX9x6CJ1fGVtZLd6Pye6nOhtWvOZz1tUk2+ae?= =?utf-8?q?5sT/PhKBpHXVtaB7/znyHirJM7BICAsBVNyJkQRXVCn0GMhp4dmCK8Z2ftO8WnvzL?= =?utf-8?q?lmabbUh/ZsLlz6Y7JLTEnJVvdeyf3hxjCVmY+Umldo5gp9rv/KEr072lDOk1OczOH?= =?utf-8?q?JgiNYPRKqd+dbuFHP6dCVnIf7gJ551Jnz2M7Q+OTsVSdMZ/izsGYoyNufs6abawHz?= =?utf-8?q?Q80Y58inI5naGDvLrUEu66q/0HZNXk4d14+AcNPjBsyjP0MwBWjZKlevJJh/9GCuo?= =?utf-8?q?Y9gtAqh+9+Qipp2df6LD9ayFCpUGWWh10KnDYJPswpeEd05JTVCx5kXLsnRBSmZAC?= =?utf-8?q?QKGZLPb4dSWCOKZtUGeWmCyovtgo26OapsP6oG1KkZu9wDO1MQAIr4NTUdY+UTBc3?= =?utf-8?q?PSqBUJMdP43cSoPAJ9Y2NEvpSKtjsXClE6flYiJSymzHOAAnZWBM2X9TVZb+HA0E/?= =?utf-8?q?nuVERPLyLNuRXCRIl6Sm20RVHbGzM60A81BKkX/PEx0GfgG+lKhLrklCjduHoYbCR?= =?utf-8?q?KXU438913IiwkRsvYUMO3Cnw8zQsyJX2lbcdVTXLz+gW12+3Je2FU/us=3D?= X-Forefront-Antispam-Report: CIP:255.255.255.255;CTRY:;LANG:en;SCL:1;SRV:;IPV:NLI;SFV:NSPM;H:PAXPR04MB9642.eurprd04.prod.outlook.com;PTR:;CAT:NONE;SFS:(13230031)(1800799015)(376005)(7416005)(52116005)(366007)(921011)(38350700005);DIR:OUT;SFP:1101; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: =?utf-8?q?/XpP8x1uvO6MYnginIUDc8E88k05?= =?utf-8?q?/+dYsPLmyZQe6nsGDWciNROkVY3QMyJdi/rZnvMaXLm20MTUCstkuWlPjc7vqS3rZ?= =?utf-8?q?8uF1JNH1IMvwiXHG+K3A3UAmXc4TPyLXkdOAw6qAVqFEFo++YYpwIzi1nWN/1IB8L?= =?utf-8?q?23his9MxKUIjTG7xy5aU5mx5OOuCEg/aB/dXb9x65M0JB6vvAWAOmI1gPEwtQFV8g?= =?utf-8?q?rY1k3t+qjBulh4NQRUHtqg9fakK04n31pzRuqUmP8DTmLKoTNvtRGe8hXuDm0Jq/l?= =?utf-8?q?Pi6D5aqXjWisT0kbe9qS/9PZVYrhkxAD/poFfwRw66h79xEnbfUqCMK31HDg/V83L?= =?utf-8?q?QJZnuKtPCEgP+1CRsRwSqsxtMTwN17HDJWtj23hKCmOvBC8oLIYjqW4SDxe7r6FfK?= =?utf-8?q?3odhUCOmtsv0Z4dbuAHJfsHppuuBLRt7/8hxT1J0ukdm81DDmHWOMKTC2Lcid8yG0?= =?utf-8?q?PmXbHWD9koAyDXtbawU/xBvImek9fAGIqUvpKa4BY/XpTlS5BSTcw+tKObqb2AAfm?= =?utf-8?q?GdWZfqhEZWh0xrCV5dQo9me24Z5QgXeVmQMDWspNYs+81oDUwWj+6eIZQU13eqZ/6?= =?utf-8?q?IqPSRhvy449BviP20SzhIqymXbbZ1NUXrFIEelnhCoxkoj/r1DTJzG+AO++WHPljA?= =?utf-8?q?blK2IdQ97sEeDXY44SiOZU4JRrpZqyP3zEwOQlBH2YwxrW8+e6X39eyp5OEUYFnSB?= =?utf-8?q?bW6mlDFSBpX07QOjcsA83bWh/o1Q/KaGuhWnOjZ8ApghfGy2Kb3bYDrixUW5qfflX?= =?utf-8?q?C2AM02dxdkw0aOc2kSzboAKmWxRCX8lvC9xfiU+/YYyXbVgW+t23Veaok8dPXTFe5?= =?utf-8?q?zItH52A25V6ld1qbu0ag0XB60Ncs6wdDqQXhPxF2cMU7epI9kMhsFm3A+It0ILpda?= =?utf-8?q?cAOndJZphbEZ7q4HlHhqTbjPLrirBflkKCLBD+8HmfoZYH+XUI9psTz/9be9uiiUm?= =?utf-8?q?OHbBGu3n+zfPbU5nkqn6oqOlcu+WPiipGTbFTuxgzSgAdEy9en6IwFHFDcMerv4m3?= =?utf-8?q?GNtwsctJLpf/beXJHqhPsoBG+5eI5WrRYMwMlubu29KVp1EvitHr1/HwnxIyEKxC0?= =?utf-8?q?ivhJFJ7XkmhrrO3T8OIdXEv6LYNALGq50wOlNllR5v22Et41V8ZAkUHvNSW1/xiVi?= =?utf-8?q?pQHXr1gqPk4CyB8H8Fls0BFzxjjrlfRN3HlYJXKcEn7i26YF1z+uC5TjhBBdUdkx6?= =?utf-8?q?QE20Ranuu6UISl2p3dokoSrS+YCab99rLU19tC/+q//wOBKEzwrvuKCOPi40HzseM?= =?utf-8?q?QDzIC281tFe7wXqZrobcPicq7p2EmnZ3QC8cCW7CS/m7X1Q4ThzvWs5shBsHMmmKr?= =?utf-8?q?U7Gz7d1I4n1QgId0z/l4htnSe+eiNF0Q0rzk9hYo+8N1zs1drz1gWWRtNqp5tDG9j?= =?utf-8?q?ep7eSs+315GR0kB30w78Ip/iTZhguwh6gYk8/3YjhO42IqmyGCOE5gGW9B6R8kFBv?= =?utf-8?q?64LdM5sXqdu/wVVga8szIrMzl3BAgxZXV+wXNgvSgGUhGe446D5Ltqx+4JnWUwjg4?= =?utf-8?q?3WGyMGnHUcig?= X-OriginatorOrg: nxp.com X-MS-Exchange-CrossTenant-Network-Message-Id: c0271a42-03b3-4e7e-a494-08dc6ec60d0f 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:46:48.8087 (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: KszmCK5zHC0m2Q4kON4cTUQDZIzGZsS46RJEd+26QsyJ++wbNQaLlOBUmvv9dUcKGVniQ5Hf7ptSsEifRBgRyg== X-MS-Exchange-Transport-CrossTenantHeadersStamped: DU0PR04MB9636 Instead of using the switch case statement to assert/dassert the core reset handled by this driver itself, let's introduce a new callback core_reset() and define it for platforms that require it. This simplifies the code. Signed-off-by: Frank Li --- drivers/pci/controller/dwc/pci-imx6.c | 134 ++++++++++++++++++---------------- 1 file changed, 71 insertions(+), 63 deletions(-) diff --git a/drivers/pci/controller/dwc/pci-imx6.c b/drivers/pci/controller/dwc/pci-imx6.c index cf1b487b3f625..7396f0d51119a 100644 --- a/drivers/pci/controller/dwc/pci-imx6.c +++ b/drivers/pci/controller/dwc/pci-imx6.c @@ -104,6 +104,7 @@ struct imx_pcie_drvdata { const struct pci_epc_features *epc_features; int (*init_phy)(struct imx_pcie *pcie); int (*set_ref_clk)(struct imx_pcie *pcie, bool enable); + int (*core_reset)(struct imx_pcie *pcie, bool assert); }; struct imx_pcie { @@ -672,35 +673,75 @@ static void imx_pcie_clk_disable(struct imx_pcie *imx_pcie) clk_bulk_disable_unprepare(imx_pcie->drvdata->clks_cnt, imx_pcie->clks); } +static int imx6sx_pcie_core_reset(struct imx_pcie *imx_pcie, bool assert) +{ + if (assert) + regmap_set_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR12, + IMX6SX_GPR12_PCIE_TEST_POWERDOWN); + + /* Force PCIe PHY reset */ + regmap_update_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR5, IMX6SX_GPR5_PCIE_BTNRST_RESET, + assert ? IMX6SX_GPR5_PCIE_BTNRST_RESET : 0); + return 0; +} + +static int imx6qp_pcie_core_reset(struct imx_pcie *imx_pcie, bool assert) +{ + regmap_update_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR1, IMX6Q_GPR1_PCIE_SW_RST, + assert ? IMX6Q_GPR1_PCIE_SW_RST : 0); + if (!assert) + usleep_range(200, 500); + + return 0; +} + +static int imx6q_pcie_core_reset(struct imx_pcie *imx_pcie, bool assert) +{ + if (!assert) + return 0; + + regmap_set_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR1, IMX6Q_GPR1_PCIE_TEST_PD); + regmap_set_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR1, IMX6Q_GPR1_PCIE_REF_CLK_EN); + + return 0; +} + +static int imx7d_pcie_core_reset(struct imx_pcie *imx_pcie, bool assert) +{ + struct dw_pcie *pci = imx_pcie->pci; + struct device *dev = pci->dev; + + if (assert) + return 0; + + /* + * Workaround for ERR010728, failure of PCI-e PLL VCO to + * oscillate, especially when cold. This turns off "Duty-cycle + * Corrector" and other mysterious undocumented things. + */ + + if (likely(imx_pcie->phy_base)) { + /* De-assert DCC_FB_EN */ + writel(PCIE_PHY_CMN_REG4_DCC_FB_EN, imx_pcie->phy_base + PCIE_PHY_CMN_REG4); + /* Assert RX_EQS and RX_EQS_SEL */ + writel(PCIE_PHY_CMN_REG24_RX_EQ_SEL | PCIE_PHY_CMN_REG24_RX_EQ, + imx_pcie->phy_base + PCIE_PHY_CMN_REG24); + /* Assert ATT_MODE */ + writel(PCIE_PHY_CMN_REG26_ATT_MODE, imx_pcie->phy_base + PCIE_PHY_CMN_REG26); + } else { + dev_warn(dev, "Unable to apply ERR010728 workaround. DT missing fsl,imx7d-pcie-phy phandle ?\n"); + } + imx7d_pcie_wait_for_phy_pll_lock(imx_pcie); + return 0; +} + static void imx_pcie_assert_core_reset(struct imx_pcie *imx_pcie) { reset_control_assert(imx_pcie->pciephy_reset); reset_control_assert(imx_pcie->apps_reset); - switch (imx_pcie->drvdata->variant) { - case IMX6SX: - regmap_update_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR12, - IMX6SX_GPR12_PCIE_TEST_POWERDOWN, - IMX6SX_GPR12_PCIE_TEST_POWERDOWN); - /* Force PCIe PHY reset */ - regmap_update_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR5, - IMX6SX_GPR5_PCIE_BTNRST_RESET, - IMX6SX_GPR5_PCIE_BTNRST_RESET); - break; - case IMX6QP: - regmap_update_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR1, - IMX6Q_GPR1_PCIE_SW_RST, - IMX6Q_GPR1_PCIE_SW_RST); - break; - case IMX6Q: - regmap_update_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR1, - IMX6Q_GPR1_PCIE_TEST_PD, 1 << 18); - regmap_update_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR1, - IMX6Q_GPR1_PCIE_REF_CLK_EN, 0 << 16); - break; - default: - break; - } + if (imx_pcie->drvdata->core_reset) + imx_pcie->drvdata->core_reset(imx_pcie, true); /* Some boards don't have PCIe reset GPIO. */ if (gpio_is_valid(imx_pcie->reset_gpio)) @@ -710,47 +751,10 @@ static void imx_pcie_assert_core_reset(struct imx_pcie *imx_pcie) static int imx_pcie_deassert_core_reset(struct imx_pcie *imx_pcie) { - struct dw_pcie *pci = imx_pcie->pci; - struct device *dev = pci->dev; - reset_control_deassert(imx_pcie->pciephy_reset); - switch (imx_pcie->drvdata->variant) { - case IMX7D: - /* Workaround for ERR010728, failure of PCI-e PLL VCO to - * oscillate, especially when cold. This turns off "Duty-cycle - * Corrector" and other mysterious undocumented things. - */ - if (likely(imx_pcie->phy_base)) { - /* De-assert DCC_FB_EN */ - writel(PCIE_PHY_CMN_REG4_DCC_FB_EN, - imx_pcie->phy_base + PCIE_PHY_CMN_REG4); - /* Assert RX_EQS and RX_EQS_SEL */ - writel(PCIE_PHY_CMN_REG24_RX_EQ_SEL - | PCIE_PHY_CMN_REG24_RX_EQ, - imx_pcie->phy_base + PCIE_PHY_CMN_REG24); - /* Assert ATT_MODE */ - writel(PCIE_PHY_CMN_REG26_ATT_MODE, - imx_pcie->phy_base + PCIE_PHY_CMN_REG26); - } else { - dev_warn(dev, "Unable to apply ERR010728 workaround. DT missing fsl,imx7d-pcie-phy phandle ?\n"); - } - - imx7d_pcie_wait_for_phy_pll_lock(imx_pcie); - break; - case IMX6SX: - regmap_update_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR5, - IMX6SX_GPR5_PCIE_BTNRST_RESET, 0); - break; - case IMX6QP: - regmap_update_bits(imx_pcie->iomuxc_gpr, IOMUXC_GPR1, - IMX6Q_GPR1_PCIE_SW_RST, 0); - - usleep_range(200, 500); - break; - default: - break; - } + if (imx_pcie->drvdata->core_reset) + imx_pcie->drvdata->core_reset(imx_pcie, false); /* Some boards don't have PCIe reset GPIO. */ if (gpio_is_valid(imx_pcie->reset_gpio)) { @@ -1448,6 +1452,7 @@ static const struct imx_pcie_drvdata drvdata[] = { .mode_mask[0] = IMX6Q_GPR12_DEVICE_TYPE, .init_phy = imx_pcie_init_phy, .set_ref_clk = imx6q_pcie_set_ref_clk, + .core_reset = imx6q_pcie_core_reset, }, [IMX6SX] = { .variant = IMX6SX, @@ -1463,6 +1468,7 @@ static const struct imx_pcie_drvdata drvdata[] = { .mode_mask[0] = IMX6Q_GPR12_DEVICE_TYPE, .init_phy = imx6sx_pcie_init_phy, .set_ref_clk = imx6sx_pcie_set_ref_clk, + .core_reset = imx6sx_pcie_core_reset, }, [IMX6QP] = { .variant = IMX6QP, @@ -1479,6 +1485,7 @@ static const struct imx_pcie_drvdata drvdata[] = { .mode_mask[0] = IMX6Q_GPR12_DEVICE_TYPE, .init_phy = imx_pcie_init_phy, .set_ref_clk = imx6q_pcie_set_ref_clk, + .core_reset = imx6qp_pcie_core_reset, }, [IMX7D] = { .variant = IMX7D, @@ -1492,6 +1499,7 @@ static const struct imx_pcie_drvdata drvdata[] = { .mode_mask[0] = IMX6Q_GPR12_DEVICE_TYPE, .init_phy = imx7d_pcie_init_phy, .set_ref_clk = imx7d_pcie_set_ref_clk, + .core_reset = imx7d_pcie_core_reset, }, [IMX8MQ] = { .variant = IMX8MQ,