| // SPDX-License-Identifier: GPL-2.0 |
| /* |
| * Qualcomm PCIe root complex driver |
| * |
| * Copyright (c) 2014-2015, The Linux Foundation. All rights reserved. |
| * Copyright 2015 Linaro Limited. |
| * |
| * Author: Stanimir Varbanov <svarbanov@mm-sol.com> |
| */ |
| |
| #include <linux/clk.h> |
| #include <linux/crc8.h> |
| #include <linux/debugfs.h> |
| #include <linux/delay.h> |
| #include <linux/gpio/consumer.h> |
| #include <linux/interconnect.h> |
| #include <linux/interrupt.h> |
| #include <linux/io.h> |
| #include <linux/iopoll.h> |
| #include <linux/kernel.h> |
| #include <linux/init.h> |
| #include <linux/of_device.h> |
| #include <linux/of_gpio.h> |
| #include <linux/pci.h> |
| #include <linux/pm_runtime.h> |
| #include <linux/platform_device.h> |
| #include <linux/phy/pcie.h> |
| #include <linux/phy/phy.h> |
| #include <linux/regulator/consumer.h> |
| #include <linux/reset.h> |
| #include <linux/slab.h> |
| #include <linux/types.h> |
| |
| #include "../../pci.h" |
| #include "pcie-designware.h" |
| |
| /* PARF registers */ |
| #define PARF_SYS_CTRL 0x00 |
| #define PARF_PM_CTRL 0x20 |
| #define PARF_PCS_DEEMPH 0x34 |
| #define PARF_PCS_SWING 0x38 |
| #define PARF_PHY_CTRL 0x40 |
| #define PARF_PHY_REFCLK 0x4c |
| #define PARF_CONFIG_BITS 0x50 |
| #define PARF_DBI_BASE_ADDR 0x168 |
| #define PARF_SLV_ADDR_SPACE_SIZE_2_3_3 0x16c /* Register offset specific to IP ver 2.3.3 */ |
| #define PARF_MHI_CLOCK_RESET_CTRL 0x174 |
| #define PARF_AXI_MSTR_WR_ADDR_HALT 0x178 |
| #define PARF_AXI_MSTR_WR_ADDR_HALT_V2 0x1a8 |
| #define PARF_Q2A_FLUSH 0x1ac |
| #define PARF_LTSSM 0x1b0 |
| #define PARF_SID_OFFSET 0x234 |
| #define PARF_BDF_TRANSLATE_CFG 0x24c |
| #define PARF_SLV_ADDR_SPACE_SIZE 0x358 |
| #define PARF_DEVICE_TYPE 0x1000 |
| #define PARF_BDF_TO_SID_TABLE_N 0x2000 |
| |
| /* ELBI registers */ |
| #define ELBI_SYS_CTRL 0x04 |
| |
| /* DBI registers */ |
| #define AXI_MSTR_RESP_COMP_CTRL0 0x818 |
| #define AXI_MSTR_RESP_COMP_CTRL1 0x81c |
| #define MISC_CONTROL_1_REG 0x8bc |
| |
| /* MHI registers */ |
| #define PARF_DEBUG_CNT_PM_LINKST_IN_L2 0xc04 |
| #define PARF_DEBUG_CNT_PM_LINKST_IN_L1 0xc0c |
| #define PARF_DEBUG_CNT_PM_LINKST_IN_L0S 0xc10 |
| #define PARF_DEBUG_CNT_AUX_CLK_IN_L1SUB_L1 0xc84 |
| #define PARF_DEBUG_CNT_AUX_CLK_IN_L1SUB_L2 0xc88 |
| |
| /* PARF_SYS_CTRL register fields */ |
| #define MAC_PHY_POWERDOWN_IN_P2_D_MUX_EN BIT(29) |
| #define MST_WAKEUP_EN BIT(13) |
| #define SLV_WAKEUP_EN BIT(12) |
| #define MSTR_ACLK_CGC_DIS BIT(10) |
| #define SLV_ACLK_CGC_DIS BIT(9) |
| #define CORE_CLK_CGC_DIS BIT(6) |
| #define AUX_PWR_DET BIT(4) |
| #define L23_CLK_RMV_DIS BIT(2) |
| #define L1_CLK_RMV_DIS BIT(1) |
| |
| /* PARF_PM_CTRL register fields */ |
| #define REQ_NOT_ENTR_L1 BIT(5) |
| |
| /* PARF_PCS_DEEMPH register fields */ |
| #define PCS_DEEMPH_TX_DEEMPH_GEN1(x) FIELD_PREP(GENMASK(21, 16), x) |
| #define PCS_DEEMPH_TX_DEEMPH_GEN2_3_5DB(x) FIELD_PREP(GENMASK(13, 8), x) |
| #define PCS_DEEMPH_TX_DEEMPH_GEN2_6DB(x) FIELD_PREP(GENMASK(5, 0), x) |
| |
| /* PARF_PCS_SWING register fields */ |
| #define PCS_SWING_TX_SWING_FULL(x) FIELD_PREP(GENMASK(14, 8), x) |
| #define PCS_SWING_TX_SWING_LOW(x) FIELD_PREP(GENMASK(6, 0), x) |
| |
| /* PARF_PHY_CTRL register fields */ |
| #define PHY_CTRL_PHY_TX0_TERM_OFFSET_MASK GENMASK(20, 16) |
| #define PHY_CTRL_PHY_TX0_TERM_OFFSET(x) FIELD_PREP(PHY_CTRL_PHY_TX0_TERM_OFFSET_MASK, x) |
| #define PHY_TEST_PWR_DOWN BIT(0) |
| |
| /* PARF_PHY_REFCLK register fields */ |
| #define PHY_REFCLK_SSP_EN BIT(16) |
| #define PHY_REFCLK_USE_PAD BIT(12) |
| |
| /* PARF_CONFIG_BITS register fields */ |
| #define PHY_RX0_EQ(x) FIELD_PREP(GENMASK(26, 24), x) |
| |
| /* PARF_SLV_ADDR_SPACE_SIZE register value */ |
| #define SLV_ADDR_SPACE_SZ 0x10000000 |
| |
| /* PARF_MHI_CLOCK_RESET_CTRL register fields */ |
| #define AHB_CLK_EN BIT(0) |
| #define MSTR_AXI_CLK_EN BIT(1) |
| #define BYPASS BIT(4) |
| |
| /* PARF_AXI_MSTR_WR_ADDR_HALT register fields */ |
| #define EN BIT(31) |
| |
| /* PARF_LTSSM register fields */ |
| #define LTSSM_EN BIT(8) |
| |
| /* PARF_DEVICE_TYPE register fields */ |
| #define DEVICE_TYPE_RC 0x4 |
| |
| /* ELBI_SYS_CTRL register fields */ |
| #define ELBI_SYS_CTRL_LT_ENABLE BIT(0) |
| |
| /* AXI_MSTR_RESP_COMP_CTRL0 register fields */ |
| #define CFG_REMOTE_RD_REQ_BRIDGE_SIZE_2K 0x4 |
| #define CFG_REMOTE_RD_REQ_BRIDGE_SIZE_4K 0x5 |
| |
| /* AXI_MSTR_RESP_COMP_CTRL1 register fields */ |
| #define CFG_BRIDGE_SB_INIT BIT(0) |
| |
| /* MISC_CONTROL_1_REG register fields */ |
| #define DBI_RO_WR_EN 1 |
| |
| /* PCI_EXP_SLTCAP register fields */ |
| #define PCIE_CAP_SLOT_POWER_LIMIT_VAL FIELD_PREP(PCI_EXP_SLTCAP_SPLV, 250) |
| #define PCIE_CAP_SLOT_POWER_LIMIT_SCALE FIELD_PREP(PCI_EXP_SLTCAP_SPLS, 1) |
| #define PCIE_CAP_SLOT_VAL (PCI_EXP_SLTCAP_ABP | \ |
| PCI_EXP_SLTCAP_PCP | \ |
| PCI_EXP_SLTCAP_MRLSP | \ |
| PCI_EXP_SLTCAP_AIP | \ |
| PCI_EXP_SLTCAP_PIP | \ |
| PCI_EXP_SLTCAP_HPS | \ |
| PCI_EXP_SLTCAP_HPC | \ |
| PCI_EXP_SLTCAP_EIP | \ |
| PCIE_CAP_SLOT_POWER_LIMIT_VAL | \ |
| PCIE_CAP_SLOT_POWER_LIMIT_SCALE) |
| |
| #define PERST_DELAY_US 1000 |
| |
| #define QCOM_PCIE_CRC8_POLYNOMIAL (BIT(2) | BIT(1) | BIT(0)) |
| |
| #define QCOM_PCIE_1_0_0_MAX_CLOCKS 4 |
| struct qcom_pcie_resources_1_0_0 { |
| struct clk_bulk_data clks[QCOM_PCIE_1_0_0_MAX_CLOCKS]; |
| struct reset_control *core; |
| struct regulator *vdda; |
| }; |
| |
| #define QCOM_PCIE_2_1_0_MAX_CLOCKS 5 |
| #define QCOM_PCIE_2_1_0_MAX_RESETS 6 |
| #define QCOM_PCIE_2_1_0_MAX_SUPPLY 3 |
| struct qcom_pcie_resources_2_1_0 { |
| struct clk_bulk_data clks[QCOM_PCIE_2_1_0_MAX_CLOCKS]; |
| struct reset_control_bulk_data resets[QCOM_PCIE_2_1_0_MAX_RESETS]; |
| int num_resets; |
| struct regulator_bulk_data supplies[QCOM_PCIE_2_1_0_MAX_SUPPLY]; |
| }; |
| |
| #define QCOM_PCIE_2_3_2_MAX_CLOCKS 4 |
| #define QCOM_PCIE_2_3_2_MAX_SUPPLY 2 |
| struct qcom_pcie_resources_2_3_2 { |
| struct clk_bulk_data clks[QCOM_PCIE_2_3_2_MAX_CLOCKS]; |
| struct regulator_bulk_data supplies[QCOM_PCIE_2_3_2_MAX_SUPPLY]; |
| }; |
| |
| #define QCOM_PCIE_2_3_3_MAX_CLOCKS 5 |
| #define QCOM_PCIE_2_3_3_MAX_RESETS 7 |
| struct qcom_pcie_resources_2_3_3 { |
| struct clk_bulk_data clks[QCOM_PCIE_2_3_3_MAX_CLOCKS]; |
| struct reset_control_bulk_data rst[QCOM_PCIE_2_3_3_MAX_RESETS]; |
| }; |
| |
| #define QCOM_PCIE_2_4_0_MAX_CLOCKS 4 |
| #define QCOM_PCIE_2_4_0_MAX_RESETS 12 |
| struct qcom_pcie_resources_2_4_0 { |
| struct clk_bulk_data clks[QCOM_PCIE_2_4_0_MAX_CLOCKS]; |
| int num_clks; |
| struct reset_control_bulk_data resets[QCOM_PCIE_2_4_0_MAX_RESETS]; |
| int num_resets; |
| }; |
| |
| #define QCOM_PCIE_2_7_0_MAX_CLOCKS 15 |
| #define QCOM_PCIE_2_7_0_MAX_SUPPLIES 2 |
| struct qcom_pcie_resources_2_7_0 { |
| struct clk_bulk_data clks[QCOM_PCIE_2_7_0_MAX_CLOCKS]; |
| int num_clks; |
| struct regulator_bulk_data supplies[QCOM_PCIE_2_7_0_MAX_SUPPLIES]; |
| struct reset_control *rst; |
| }; |
| |
| #define QCOM_PCIE_2_9_0_MAX_CLOCKS 5 |
| struct qcom_pcie_resources_2_9_0 { |
| struct clk_bulk_data clks[QCOM_PCIE_2_9_0_MAX_CLOCKS]; |
| struct reset_control *rst; |
| }; |
| |
| union qcom_pcie_resources { |
| struct qcom_pcie_resources_1_0_0 v1_0_0; |
| struct qcom_pcie_resources_2_1_0 v2_1_0; |
| struct qcom_pcie_resources_2_3_2 v2_3_2; |
| struct qcom_pcie_resources_2_3_3 v2_3_3; |
| struct qcom_pcie_resources_2_4_0 v2_4_0; |
| struct qcom_pcie_resources_2_7_0 v2_7_0; |
| struct qcom_pcie_resources_2_9_0 v2_9_0; |
| }; |
| |
| struct qcom_pcie; |
| |
| struct qcom_pcie_ops { |
| int (*get_resources)(struct qcom_pcie *pcie); |
| int (*init)(struct qcom_pcie *pcie); |
| int (*post_init)(struct qcom_pcie *pcie); |
| void (*deinit)(struct qcom_pcie *pcie); |
| void (*ltssm_enable)(struct qcom_pcie *pcie); |
| int (*config_sid)(struct qcom_pcie *pcie); |
| }; |
| |
| struct qcom_pcie_cfg { |
| const struct qcom_pcie_ops *ops; |
| }; |
| |
| struct qcom_pcie { |
| struct dw_pcie *pci; |
| void __iomem *parf; /* DT parf */ |
| void __iomem *elbi; /* DT elbi */ |
| void __iomem *mhi; |
| union qcom_pcie_resources res; |
| struct phy *phy; |
| struct gpio_desc *reset; |
| struct icc_path *icc_mem; |
| const struct qcom_pcie_cfg *cfg; |
| struct dentry *debugfs; |
| bool suspended; |
| }; |
| |
| #define to_qcom_pcie(x) dev_get_drvdata((x)->dev) |
| |
| static void qcom_ep_reset_assert(struct qcom_pcie *pcie) |
| { |
| gpiod_set_value_cansleep(pcie->reset, 1); |
| usleep_range(PERST_DELAY_US, PERST_DELAY_US + 500); |
| } |
| |
| static void qcom_ep_reset_deassert(struct qcom_pcie *pcie) |
| { |
| /* Ensure that PERST has been asserted for at least 100 ms */ |
| msleep(100); |
| gpiod_set_value_cansleep(pcie->reset, 0); |
| usleep_range(PERST_DELAY_US, PERST_DELAY_US + 500); |
| } |
| |
| static int qcom_pcie_start_link(struct dw_pcie *pci) |
| { |
| struct qcom_pcie *pcie = to_qcom_pcie(pci); |
| |
| /* Enable Link Training state machine */ |
| if (pcie->cfg->ops->ltssm_enable) |
| pcie->cfg->ops->ltssm_enable(pcie); |
| |
| return 0; |
| } |
| |
| static void qcom_pcie_2_1_0_ltssm_enable(struct qcom_pcie *pcie) |
| { |
| u32 val; |
| |
| /* enable link training */ |
| val = readl(pcie->elbi + ELBI_SYS_CTRL); |
| val |= ELBI_SYS_CTRL_LT_ENABLE; |
| writel(val, pcie->elbi + ELBI_SYS_CTRL); |
| } |
| |
| static int qcom_pcie_get_resources_2_1_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_1_0 *res = &pcie->res.v2_1_0; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| bool is_apq = of_device_is_compatible(dev->of_node, "qcom,pcie-apq8064"); |
| int ret; |
| |
| res->supplies[0].supply = "vdda"; |
| res->supplies[1].supply = "vdda_phy"; |
| res->supplies[2].supply = "vdda_refclk"; |
| ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(res->supplies), |
| res->supplies); |
| if (ret) |
| return ret; |
| |
| res->clks[0].id = "iface"; |
| res->clks[1].id = "core"; |
| res->clks[2].id = "phy"; |
| res->clks[3].id = "aux"; |
| res->clks[4].id = "ref"; |
| |
| /* iface, core, phy are required */ |
| ret = devm_clk_bulk_get(dev, 3, res->clks); |
| if (ret < 0) |
| return ret; |
| |
| /* aux, ref are optional */ |
| ret = devm_clk_bulk_get_optional(dev, 2, res->clks + 3); |
| if (ret < 0) |
| return ret; |
| |
| res->resets[0].id = "pci"; |
| res->resets[1].id = "axi"; |
| res->resets[2].id = "ahb"; |
| res->resets[3].id = "por"; |
| res->resets[4].id = "phy"; |
| res->resets[5].id = "ext"; |
| |
| /* ext is optional on APQ8016 */ |
| res->num_resets = is_apq ? 5 : 6; |
| ret = devm_reset_control_bulk_get_exclusive(dev, res->num_resets, res->resets); |
| if (ret < 0) |
| return ret; |
| |
| return 0; |
| } |
| |
| static void qcom_pcie_deinit_2_1_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_1_0 *res = &pcie->res.v2_1_0; |
| |
| clk_bulk_disable_unprepare(ARRAY_SIZE(res->clks), res->clks); |
| reset_control_bulk_assert(res->num_resets, res->resets); |
| |
| writel(1, pcie->parf + PARF_PHY_CTRL); |
| |
| regulator_bulk_disable(ARRAY_SIZE(res->supplies), res->supplies); |
| } |
| |
| static int qcom_pcie_init_2_1_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_1_0 *res = &pcie->res.v2_1_0; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| int ret; |
| |
| /* reset the PCIe interface as uboot can leave it undefined state */ |
| ret = reset_control_bulk_assert(res->num_resets, res->resets); |
| if (ret < 0) { |
| dev_err(dev, "cannot assert resets\n"); |
| return ret; |
| } |
| |
| ret = regulator_bulk_enable(ARRAY_SIZE(res->supplies), res->supplies); |
| if (ret < 0) { |
| dev_err(dev, "cannot enable regulators\n"); |
| return ret; |
| } |
| |
| ret = reset_control_bulk_deassert(res->num_resets, res->resets); |
| if (ret < 0) { |
| dev_err(dev, "cannot deassert resets\n"); |
| regulator_bulk_disable(ARRAY_SIZE(res->supplies), res->supplies); |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_post_init_2_1_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_1_0 *res = &pcie->res.v2_1_0; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| struct device_node *node = dev->of_node; |
| u32 val; |
| int ret; |
| |
| /* enable PCIe clocks and resets */ |
| val = readl(pcie->parf + PARF_PHY_CTRL); |
| val &= ~PHY_TEST_PWR_DOWN; |
| writel(val, pcie->parf + PARF_PHY_CTRL); |
| |
| ret = clk_bulk_prepare_enable(ARRAY_SIZE(res->clks), res->clks); |
| if (ret) |
| return ret; |
| |
| if (of_device_is_compatible(node, "qcom,pcie-ipq8064") || |
| of_device_is_compatible(node, "qcom,pcie-ipq8064-v2")) { |
| writel(PCS_DEEMPH_TX_DEEMPH_GEN1(24) | |
| PCS_DEEMPH_TX_DEEMPH_GEN2_3_5DB(24) | |
| PCS_DEEMPH_TX_DEEMPH_GEN2_6DB(34), |
| pcie->parf + PARF_PCS_DEEMPH); |
| writel(PCS_SWING_TX_SWING_FULL(120) | |
| PCS_SWING_TX_SWING_LOW(120), |
| pcie->parf + PARF_PCS_SWING); |
| writel(PHY_RX0_EQ(4), pcie->parf + PARF_CONFIG_BITS); |
| } |
| |
| if (of_device_is_compatible(node, "qcom,pcie-ipq8064")) { |
| /* set TX termination offset */ |
| val = readl(pcie->parf + PARF_PHY_CTRL); |
| val &= ~PHY_CTRL_PHY_TX0_TERM_OFFSET_MASK; |
| val |= PHY_CTRL_PHY_TX0_TERM_OFFSET(7); |
| writel(val, pcie->parf + PARF_PHY_CTRL); |
| } |
| |
| /* enable external reference clock */ |
| val = readl(pcie->parf + PARF_PHY_REFCLK); |
| /* USE_PAD is required only for ipq806x */ |
| if (!of_device_is_compatible(node, "qcom,pcie-apq8064")) |
| val &= ~PHY_REFCLK_USE_PAD; |
| val |= PHY_REFCLK_SSP_EN; |
| writel(val, pcie->parf + PARF_PHY_REFCLK); |
| |
| /* wait for clock acquisition */ |
| usleep_range(1000, 1500); |
| |
| /* Set the Max TLP size to 2K, instead of using default of 4K */ |
| writel(CFG_REMOTE_RD_REQ_BRIDGE_SIZE_2K, |
| pci->dbi_base + AXI_MSTR_RESP_COMP_CTRL0); |
| writel(CFG_BRIDGE_SB_INIT, |
| pci->dbi_base + AXI_MSTR_RESP_COMP_CTRL1); |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_get_resources_1_0_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_1_0_0 *res = &pcie->res.v1_0_0; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| int ret; |
| |
| res->vdda = devm_regulator_get(dev, "vdda"); |
| if (IS_ERR(res->vdda)) |
| return PTR_ERR(res->vdda); |
| |
| res->clks[0].id = "iface"; |
| res->clks[1].id = "aux"; |
| res->clks[2].id = "master_bus"; |
| res->clks[3].id = "slave_bus"; |
| |
| ret = devm_clk_bulk_get(dev, ARRAY_SIZE(res->clks), res->clks); |
| if (ret < 0) |
| return ret; |
| |
| res->core = devm_reset_control_get_exclusive(dev, "core"); |
| return PTR_ERR_OR_ZERO(res->core); |
| } |
| |
| static void qcom_pcie_deinit_1_0_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_1_0_0 *res = &pcie->res.v1_0_0; |
| |
| reset_control_assert(res->core); |
| clk_bulk_disable_unprepare(ARRAY_SIZE(res->clks), res->clks); |
| regulator_disable(res->vdda); |
| } |
| |
| static int qcom_pcie_init_1_0_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_1_0_0 *res = &pcie->res.v1_0_0; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| int ret; |
| |
| ret = reset_control_deassert(res->core); |
| if (ret) { |
| dev_err(dev, "cannot deassert core reset\n"); |
| return ret; |
| } |
| |
| ret = clk_bulk_prepare_enable(ARRAY_SIZE(res->clks), res->clks); |
| if (ret) { |
| dev_err(dev, "cannot prepare/enable clocks\n"); |
| goto err_assert_reset; |
| } |
| |
| ret = regulator_enable(res->vdda); |
| if (ret) { |
| dev_err(dev, "cannot enable vdda regulator\n"); |
| goto err_disable_clks; |
| } |
| |
| return 0; |
| |
| err_disable_clks: |
| clk_bulk_disable_unprepare(ARRAY_SIZE(res->clks), res->clks); |
| err_assert_reset: |
| reset_control_assert(res->core); |
| |
| return ret; |
| } |
| |
| static int qcom_pcie_post_init_1_0_0(struct qcom_pcie *pcie) |
| { |
| /* change DBI base address */ |
| writel(0, pcie->parf + PARF_DBI_BASE_ADDR); |
| |
| if (IS_ENABLED(CONFIG_PCI_MSI)) { |
| u32 val = readl(pcie->parf + PARF_AXI_MSTR_WR_ADDR_HALT); |
| |
| val |= EN; |
| writel(val, pcie->parf + PARF_AXI_MSTR_WR_ADDR_HALT); |
| } |
| |
| return 0; |
| } |
| |
| static void qcom_pcie_2_3_2_ltssm_enable(struct qcom_pcie *pcie) |
| { |
| u32 val; |
| |
| /* enable link training */ |
| val = readl(pcie->parf + PARF_LTSSM); |
| val |= LTSSM_EN; |
| writel(val, pcie->parf + PARF_LTSSM); |
| } |
| |
| static int qcom_pcie_get_resources_2_3_2(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_3_2 *res = &pcie->res.v2_3_2; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| int ret; |
| |
| res->supplies[0].supply = "vdda"; |
| res->supplies[1].supply = "vddpe-3v3"; |
| ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(res->supplies), |
| res->supplies); |
| if (ret) |
| return ret; |
| |
| res->clks[0].id = "aux"; |
| res->clks[1].id = "cfg"; |
| res->clks[2].id = "bus_master"; |
| res->clks[3].id = "bus_slave"; |
| |
| ret = devm_clk_bulk_get(dev, ARRAY_SIZE(res->clks), res->clks); |
| if (ret < 0) |
| return ret; |
| |
| return 0; |
| } |
| |
| static void qcom_pcie_deinit_2_3_2(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_3_2 *res = &pcie->res.v2_3_2; |
| |
| clk_bulk_disable_unprepare(ARRAY_SIZE(res->clks), res->clks); |
| regulator_bulk_disable(ARRAY_SIZE(res->supplies), res->supplies); |
| } |
| |
| static int qcom_pcie_init_2_3_2(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_3_2 *res = &pcie->res.v2_3_2; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| int ret; |
| |
| ret = regulator_bulk_enable(ARRAY_SIZE(res->supplies), res->supplies); |
| if (ret < 0) { |
| dev_err(dev, "cannot enable regulators\n"); |
| return ret; |
| } |
| |
| ret = clk_bulk_prepare_enable(ARRAY_SIZE(res->clks), res->clks); |
| if (ret) { |
| dev_err(dev, "cannot prepare/enable clocks\n"); |
| regulator_bulk_disable(ARRAY_SIZE(res->supplies), res->supplies); |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_post_init_2_3_2(struct qcom_pcie *pcie) |
| { |
| u32 val; |
| |
| /* enable PCIe clocks and resets */ |
| val = readl(pcie->parf + PARF_PHY_CTRL); |
| val &= ~PHY_TEST_PWR_DOWN; |
| writel(val, pcie->parf + PARF_PHY_CTRL); |
| |
| /* change DBI base address */ |
| writel(0, pcie->parf + PARF_DBI_BASE_ADDR); |
| |
| /* MAC PHY_POWERDOWN MUX DISABLE */ |
| val = readl(pcie->parf + PARF_SYS_CTRL); |
| val &= ~MAC_PHY_POWERDOWN_IN_P2_D_MUX_EN; |
| writel(val, pcie->parf + PARF_SYS_CTRL); |
| |
| val = readl(pcie->parf + PARF_MHI_CLOCK_RESET_CTRL); |
| val |= BYPASS; |
| writel(val, pcie->parf + PARF_MHI_CLOCK_RESET_CTRL); |
| |
| val = readl(pcie->parf + PARF_AXI_MSTR_WR_ADDR_HALT_V2); |
| val |= EN; |
| writel(val, pcie->parf + PARF_AXI_MSTR_WR_ADDR_HALT_V2); |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_get_resources_2_4_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_4_0 *res = &pcie->res.v2_4_0; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| bool is_ipq = of_device_is_compatible(dev->of_node, "qcom,pcie-ipq4019"); |
| int ret; |
| |
| res->clks[0].id = "aux"; |
| res->clks[1].id = "master_bus"; |
| res->clks[2].id = "slave_bus"; |
| res->clks[3].id = "iface"; |
| |
| /* qcom,pcie-ipq4019 is defined without "iface" */ |
| res->num_clks = is_ipq ? 3 : 4; |
| |
| ret = devm_clk_bulk_get(dev, res->num_clks, res->clks); |
| if (ret < 0) |
| return ret; |
| |
| res->resets[0].id = "axi_m"; |
| res->resets[1].id = "axi_s"; |
| res->resets[2].id = "axi_m_sticky"; |
| res->resets[3].id = "pipe_sticky"; |
| res->resets[4].id = "pwr"; |
| res->resets[5].id = "ahb"; |
| res->resets[6].id = "pipe"; |
| res->resets[7].id = "axi_m_vmid"; |
| res->resets[8].id = "axi_s_xpu"; |
| res->resets[9].id = "parf"; |
| res->resets[10].id = "phy"; |
| res->resets[11].id = "phy_ahb"; |
| |
| res->num_resets = is_ipq ? 12 : 6; |
| |
| ret = devm_reset_control_bulk_get_exclusive(dev, res->num_resets, res->resets); |
| if (ret < 0) |
| return ret; |
| |
| return 0; |
| } |
| |
| static void qcom_pcie_deinit_2_4_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_4_0 *res = &pcie->res.v2_4_0; |
| |
| reset_control_bulk_assert(res->num_resets, res->resets); |
| clk_bulk_disable_unprepare(res->num_clks, res->clks); |
| } |
| |
| static int qcom_pcie_init_2_4_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_4_0 *res = &pcie->res.v2_4_0; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| int ret; |
| |
| ret = reset_control_bulk_assert(res->num_resets, res->resets); |
| if (ret < 0) { |
| dev_err(dev, "cannot assert resets\n"); |
| return ret; |
| } |
| |
| usleep_range(10000, 12000); |
| |
| ret = reset_control_bulk_deassert(res->num_resets, res->resets); |
| if (ret < 0) { |
| dev_err(dev, "cannot deassert resets\n"); |
| return ret; |
| } |
| |
| usleep_range(10000, 12000); |
| |
| ret = clk_bulk_prepare_enable(res->num_clks, res->clks); |
| if (ret) { |
| reset_control_bulk_assert(res->num_resets, res->resets); |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_post_init_2_4_0(struct qcom_pcie *pcie) |
| { |
| u32 val; |
| |
| /* enable PCIe clocks and resets */ |
| val = readl(pcie->parf + PARF_PHY_CTRL); |
| val &= ~PHY_TEST_PWR_DOWN; |
| writel(val, pcie->parf + PARF_PHY_CTRL); |
| |
| /* change DBI base address */ |
| writel(0, pcie->parf + PARF_DBI_BASE_ADDR); |
| |
| /* MAC PHY_POWERDOWN MUX DISABLE */ |
| val = readl(pcie->parf + PARF_SYS_CTRL); |
| val &= ~MAC_PHY_POWERDOWN_IN_P2_D_MUX_EN; |
| writel(val, pcie->parf + PARF_SYS_CTRL); |
| |
| val = readl(pcie->parf + PARF_MHI_CLOCK_RESET_CTRL); |
| val |= BYPASS; |
| writel(val, pcie->parf + PARF_MHI_CLOCK_RESET_CTRL); |
| |
| val = readl(pcie->parf + PARF_AXI_MSTR_WR_ADDR_HALT_V2); |
| val |= EN; |
| writel(val, pcie->parf + PARF_AXI_MSTR_WR_ADDR_HALT_V2); |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_get_resources_2_3_3(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_3_3 *res = &pcie->res.v2_3_3; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| int ret; |
| |
| res->clks[0].id = "iface"; |
| res->clks[1].id = "axi_m"; |
| res->clks[2].id = "axi_s"; |
| res->clks[3].id = "ahb"; |
| res->clks[4].id = "aux"; |
| |
| ret = devm_clk_bulk_get(dev, ARRAY_SIZE(res->clks), res->clks); |
| if (ret < 0) |
| return ret; |
| |
| res->rst[0].id = "axi_m"; |
| res->rst[1].id = "axi_s"; |
| res->rst[2].id = "pipe"; |
| res->rst[3].id = "axi_m_sticky"; |
| res->rst[4].id = "sticky"; |
| res->rst[5].id = "ahb"; |
| res->rst[6].id = "sleep"; |
| |
| ret = devm_reset_control_bulk_get_exclusive(dev, ARRAY_SIZE(res->rst), res->rst); |
| if (ret < 0) |
| return ret; |
| |
| return 0; |
| } |
| |
| static void qcom_pcie_deinit_2_3_3(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_3_3 *res = &pcie->res.v2_3_3; |
| |
| clk_bulk_disable_unprepare(ARRAY_SIZE(res->clks), res->clks); |
| } |
| |
| static int qcom_pcie_init_2_3_3(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_3_3 *res = &pcie->res.v2_3_3; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| int ret; |
| |
| ret = reset_control_bulk_assert(ARRAY_SIZE(res->rst), res->rst); |
| if (ret < 0) { |
| dev_err(dev, "cannot assert resets\n"); |
| return ret; |
| } |
| |
| usleep_range(2000, 2500); |
| |
| ret = reset_control_bulk_deassert(ARRAY_SIZE(res->rst), res->rst); |
| if (ret < 0) { |
| dev_err(dev, "cannot deassert resets\n"); |
| return ret; |
| } |
| |
| /* |
| * Don't have a way to see if the reset has completed. |
| * Wait for some time. |
| */ |
| usleep_range(2000, 2500); |
| |
| ret = clk_bulk_prepare_enable(ARRAY_SIZE(res->clks), res->clks); |
| if (ret) { |
| dev_err(dev, "cannot prepare/enable clocks\n"); |
| goto err_assert_resets; |
| } |
| |
| return 0; |
| |
| err_assert_resets: |
| /* |
| * Not checking for failure, will anyway return |
| * the original failure in 'ret'. |
| */ |
| reset_control_bulk_assert(ARRAY_SIZE(res->rst), res->rst); |
| |
| return ret; |
| } |
| |
| static int qcom_pcie_post_init_2_3_3(struct qcom_pcie *pcie) |
| { |
| struct dw_pcie *pci = pcie->pci; |
| u16 offset = dw_pcie_find_capability(pci, PCI_CAP_ID_EXP); |
| u32 val; |
| |
| writel(SLV_ADDR_SPACE_SZ, |
| pcie->parf + PARF_SLV_ADDR_SPACE_SIZE_2_3_3); |
| |
| val = readl(pcie->parf + PARF_PHY_CTRL); |
| val &= ~PHY_TEST_PWR_DOWN; |
| writel(val, pcie->parf + PARF_PHY_CTRL); |
| |
| writel(0, pcie->parf + PARF_DBI_BASE_ADDR); |
| |
| writel(MST_WAKEUP_EN | SLV_WAKEUP_EN | MSTR_ACLK_CGC_DIS |
| | SLV_ACLK_CGC_DIS | CORE_CLK_CGC_DIS | |
| AUX_PWR_DET | L23_CLK_RMV_DIS | L1_CLK_RMV_DIS, |
| pcie->parf + PARF_SYS_CTRL); |
| writel(0, pcie->parf + PARF_Q2A_FLUSH); |
| |
| writel(PCI_COMMAND_MASTER, pci->dbi_base + PCI_COMMAND); |
| writel(DBI_RO_WR_EN, pci->dbi_base + MISC_CONTROL_1_REG); |
| writel(PCIE_CAP_SLOT_VAL, pci->dbi_base + offset + PCI_EXP_SLTCAP); |
| |
| val = readl(pci->dbi_base + offset + PCI_EXP_LNKCAP); |
| val &= ~PCI_EXP_LNKCAP_ASPMS; |
| writel(val, pci->dbi_base + offset + PCI_EXP_LNKCAP); |
| |
| writel(PCI_EXP_DEVCTL2_COMP_TMOUT_DIS, pci->dbi_base + offset + |
| PCI_EXP_DEVCTL2); |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_get_resources_2_7_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_7_0 *res = &pcie->res.v2_7_0; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| unsigned int num_clks, num_opt_clks; |
| unsigned int idx; |
| int ret; |
| |
| res->rst = devm_reset_control_array_get_exclusive(dev); |
| if (IS_ERR(res->rst)) |
| return PTR_ERR(res->rst); |
| |
| res->supplies[0].supply = "vdda"; |
| res->supplies[1].supply = "vddpe-3v3"; |
| ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(res->supplies), |
| res->supplies); |
| if (ret) |
| return ret; |
| |
| idx = 0; |
| res->clks[idx++].id = "aux"; |
| res->clks[idx++].id = "cfg"; |
| res->clks[idx++].id = "bus_master"; |
| res->clks[idx++].id = "bus_slave"; |
| res->clks[idx++].id = "slave_q2a"; |
| |
| num_clks = idx; |
| |
| ret = devm_clk_bulk_get(dev, num_clks, res->clks); |
| if (ret < 0) |
| return ret; |
| |
| res->clks[idx++].id = "tbu"; |
| res->clks[idx++].id = "ddrss_sf_tbu"; |
| res->clks[idx++].id = "aggre0"; |
| res->clks[idx++].id = "aggre1"; |
| res->clks[idx++].id = "noc_aggr"; |
| res->clks[idx++].id = "noc_aggr_4"; |
| res->clks[idx++].id = "noc_aggr_south_sf"; |
| res->clks[idx++].id = "cnoc_qx"; |
| res->clks[idx++].id = "sleep"; |
| res->clks[idx++].id = "cnoc_sf_axi"; |
| |
| num_opt_clks = idx - num_clks; |
| res->num_clks = idx; |
| |
| ret = devm_clk_bulk_get_optional(dev, num_opt_clks, res->clks + num_clks); |
| if (ret < 0) |
| return ret; |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_init_2_7_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_7_0 *res = &pcie->res.v2_7_0; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| u32 val; |
| int ret; |
| |
| ret = regulator_bulk_enable(ARRAY_SIZE(res->supplies), res->supplies); |
| if (ret < 0) { |
| dev_err(dev, "cannot enable regulators\n"); |
| return ret; |
| } |
| |
| ret = clk_bulk_prepare_enable(res->num_clks, res->clks); |
| if (ret < 0) |
| goto err_disable_regulators; |
| |
| ret = reset_control_assert(res->rst); |
| if (ret) { |
| dev_err(dev, "reset assert failed (%d)\n", ret); |
| goto err_disable_clocks; |
| } |
| |
| usleep_range(1000, 1500); |
| |
| ret = reset_control_deassert(res->rst); |
| if (ret) { |
| dev_err(dev, "reset deassert failed (%d)\n", ret); |
| goto err_disable_clocks; |
| } |
| |
| /* Wait for reset to complete, required on SM8450 */ |
| usleep_range(1000, 1500); |
| |
| /* configure PCIe to RC mode */ |
| writel(DEVICE_TYPE_RC, pcie->parf + PARF_DEVICE_TYPE); |
| |
| /* enable PCIe clocks and resets */ |
| val = readl(pcie->parf + PARF_PHY_CTRL); |
| val &= ~PHY_TEST_PWR_DOWN; |
| writel(val, pcie->parf + PARF_PHY_CTRL); |
| |
| /* change DBI base address */ |
| writel(0, pcie->parf + PARF_DBI_BASE_ADDR); |
| |
| /* MAC PHY_POWERDOWN MUX DISABLE */ |
| val = readl(pcie->parf + PARF_SYS_CTRL); |
| val &= ~MAC_PHY_POWERDOWN_IN_P2_D_MUX_EN; |
| writel(val, pcie->parf + PARF_SYS_CTRL); |
| |
| val = readl(pcie->parf + PARF_MHI_CLOCK_RESET_CTRL); |
| val |= BYPASS; |
| writel(val, pcie->parf + PARF_MHI_CLOCK_RESET_CTRL); |
| |
| /* Enable L1 and L1SS */ |
| val = readl(pcie->parf + PARF_PM_CTRL); |
| val &= ~REQ_NOT_ENTR_L1; |
| writel(val, pcie->parf + PARF_PM_CTRL); |
| |
| val = readl(pcie->parf + PARF_AXI_MSTR_WR_ADDR_HALT_V2); |
| val |= EN; |
| writel(val, pcie->parf + PARF_AXI_MSTR_WR_ADDR_HALT_V2); |
| |
| return 0; |
| err_disable_clocks: |
| clk_bulk_disable_unprepare(res->num_clks, res->clks); |
| err_disable_regulators: |
| regulator_bulk_disable(ARRAY_SIZE(res->supplies), res->supplies); |
| |
| return ret; |
| } |
| |
| static void qcom_pcie_deinit_2_7_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_7_0 *res = &pcie->res.v2_7_0; |
| |
| clk_bulk_disable_unprepare(res->num_clks, res->clks); |
| |
| regulator_bulk_disable(ARRAY_SIZE(res->supplies), res->supplies); |
| } |
| |
| static int qcom_pcie_config_sid_1_9_0(struct qcom_pcie *pcie) |
| { |
| /* iommu map structure */ |
| struct { |
| u32 bdf; |
| u32 phandle; |
| u32 smmu_sid; |
| u32 smmu_sid_len; |
| } *map; |
| void __iomem *bdf_to_sid_base = pcie->parf + PARF_BDF_TO_SID_TABLE_N; |
| struct device *dev = pcie->pci->dev; |
| u8 qcom_pcie_crc8_table[CRC8_TABLE_SIZE]; |
| int i, nr_map, size = 0; |
| u32 smmu_sid_base; |
| |
| of_get_property(dev->of_node, "iommu-map", &size); |
| if (!size) |
| return 0; |
| |
| map = kzalloc(size, GFP_KERNEL); |
| if (!map) |
| return -ENOMEM; |
| |
| of_property_read_u32_array(dev->of_node, "iommu-map", (u32 *)map, |
| size / sizeof(u32)); |
| |
| nr_map = size / (sizeof(*map)); |
| |
| crc8_populate_msb(qcom_pcie_crc8_table, QCOM_PCIE_CRC8_POLYNOMIAL); |
| |
| /* Registers need to be zero out first */ |
| memset_io(bdf_to_sid_base, 0, CRC8_TABLE_SIZE * sizeof(u32)); |
| |
| /* Extract the SMMU SID base from the first entry of iommu-map */ |
| smmu_sid_base = map[0].smmu_sid; |
| |
| /* Look for an available entry to hold the mapping */ |
| for (i = 0; i < nr_map; i++) { |
| __be16 bdf_be = cpu_to_be16(map[i].bdf); |
| u32 val; |
| u8 hash; |
| |
| hash = crc8(qcom_pcie_crc8_table, (u8 *)&bdf_be, sizeof(bdf_be), 0); |
| |
| val = readl(bdf_to_sid_base + hash * sizeof(u32)); |
| |
| /* If the register is already populated, look for next available entry */ |
| while (val) { |
| u8 current_hash = hash++; |
| u8 next_mask = 0xff; |
| |
| /* If NEXT field is NULL then update it with next hash */ |
| if (!(val & next_mask)) { |
| val |= (u32)hash; |
| writel(val, bdf_to_sid_base + current_hash * sizeof(u32)); |
| } |
| |
| val = readl(bdf_to_sid_base + hash * sizeof(u32)); |
| } |
| |
| /* BDF [31:16] | SID [15:8] | NEXT [7:0] */ |
| val = map[i].bdf << 16 | (map[i].smmu_sid - smmu_sid_base) << 8 | 0; |
| writel(val, bdf_to_sid_base + hash * sizeof(u32)); |
| } |
| |
| kfree(map); |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_get_resources_2_9_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_9_0 *res = &pcie->res.v2_9_0; |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| int ret; |
| |
| res->clks[0].id = "iface"; |
| res->clks[1].id = "axi_m"; |
| res->clks[2].id = "axi_s"; |
| res->clks[3].id = "axi_bridge"; |
| res->clks[4].id = "rchng"; |
| |
| ret = devm_clk_bulk_get(dev, ARRAY_SIZE(res->clks), res->clks); |
| if (ret < 0) |
| return ret; |
| |
| res->rst = devm_reset_control_array_get_exclusive(dev); |
| if (IS_ERR(res->rst)) |
| return PTR_ERR(res->rst); |
| |
| return 0; |
| } |
| |
| static void qcom_pcie_deinit_2_9_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_9_0 *res = &pcie->res.v2_9_0; |
| |
| clk_bulk_disable_unprepare(ARRAY_SIZE(res->clks), res->clks); |
| } |
| |
| static int qcom_pcie_init_2_9_0(struct qcom_pcie *pcie) |
| { |
| struct qcom_pcie_resources_2_9_0 *res = &pcie->res.v2_9_0; |
| struct device *dev = pcie->pci->dev; |
| int ret; |
| |
| ret = reset_control_assert(res->rst); |
| if (ret) { |
| dev_err(dev, "reset assert failed (%d)\n", ret); |
| return ret; |
| } |
| |
| /* |
| * Delay periods before and after reset deassert are working values |
| * from downstream Codeaurora kernel |
| */ |
| usleep_range(2000, 2500); |
| |
| ret = reset_control_deassert(res->rst); |
| if (ret) { |
| dev_err(dev, "reset deassert failed (%d)\n", ret); |
| return ret; |
| } |
| |
| usleep_range(2000, 2500); |
| |
| return clk_bulk_prepare_enable(ARRAY_SIZE(res->clks), res->clks); |
| } |
| |
| static int qcom_pcie_post_init_2_9_0(struct qcom_pcie *pcie) |
| { |
| struct dw_pcie *pci = pcie->pci; |
| u16 offset = dw_pcie_find_capability(pci, PCI_CAP_ID_EXP); |
| u32 val; |
| int i; |
| |
| writel(SLV_ADDR_SPACE_SZ, |
| pcie->parf + PARF_SLV_ADDR_SPACE_SIZE); |
| |
| val = readl(pcie->parf + PARF_PHY_CTRL); |
| val &= ~PHY_TEST_PWR_DOWN; |
| writel(val, pcie->parf + PARF_PHY_CTRL); |
| |
| writel(0, pcie->parf + PARF_DBI_BASE_ADDR); |
| |
| writel(DEVICE_TYPE_RC, pcie->parf + PARF_DEVICE_TYPE); |
| writel(BYPASS | MSTR_AXI_CLK_EN | AHB_CLK_EN, |
| pcie->parf + PARF_MHI_CLOCK_RESET_CTRL); |
| writel(GEN3_RELATED_OFF_RXEQ_RGRDLESS_RXTS | |
| GEN3_RELATED_OFF_GEN3_ZRXDC_NONCOMPL, |
| pci->dbi_base + GEN3_RELATED_OFF); |
| |
| writel(MST_WAKEUP_EN | SLV_WAKEUP_EN | MSTR_ACLK_CGC_DIS | |
| SLV_ACLK_CGC_DIS | CORE_CLK_CGC_DIS | |
| AUX_PWR_DET | L23_CLK_RMV_DIS | L1_CLK_RMV_DIS, |
| pcie->parf + PARF_SYS_CTRL); |
| |
| writel(0, pcie->parf + PARF_Q2A_FLUSH); |
| |
| dw_pcie_dbi_ro_wr_en(pci); |
| writel(PCIE_CAP_SLOT_VAL, pci->dbi_base + offset + PCI_EXP_SLTCAP); |
| |
| val = readl(pci->dbi_base + offset + PCI_EXP_LNKCAP); |
| val &= ~PCI_EXP_LNKCAP_ASPMS; |
| writel(val, pci->dbi_base + offset + PCI_EXP_LNKCAP); |
| |
| writel(PCI_EXP_DEVCTL2_COMP_TMOUT_DIS, pci->dbi_base + offset + |
| PCI_EXP_DEVCTL2); |
| |
| for (i = 0; i < 256; i++) |
| writel(0, pcie->parf + PARF_BDF_TO_SID_TABLE_N + (4 * i)); |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_link_up(struct dw_pcie *pci) |
| { |
| u16 offset = dw_pcie_find_capability(pci, PCI_CAP_ID_EXP); |
| u16 val = readw(pci->dbi_base + offset + PCI_EXP_LNKSTA); |
| |
| return !!(val & PCI_EXP_LNKSTA_DLLLA); |
| } |
| |
| static int qcom_pcie_host_init(struct dw_pcie_rp *pp) |
| { |
| struct dw_pcie *pci = to_dw_pcie_from_pp(pp); |
| struct qcom_pcie *pcie = to_qcom_pcie(pci); |
| int ret; |
| |
| qcom_ep_reset_assert(pcie); |
| |
| ret = pcie->cfg->ops->init(pcie); |
| if (ret) |
| return ret; |
| |
| ret = phy_set_mode_ext(pcie->phy, PHY_MODE_PCIE, PHY_MODE_PCIE_RC); |
| if (ret) |
| goto err_deinit; |
| |
| ret = phy_power_on(pcie->phy); |
| if (ret) |
| goto err_deinit; |
| |
| if (pcie->cfg->ops->post_init) { |
| ret = pcie->cfg->ops->post_init(pcie); |
| if (ret) |
| goto err_disable_phy; |
| } |
| |
| qcom_ep_reset_deassert(pcie); |
| |
| if (pcie->cfg->ops->config_sid) { |
| ret = pcie->cfg->ops->config_sid(pcie); |
| if (ret) |
| goto err_assert_reset; |
| } |
| |
| return 0; |
| |
| err_assert_reset: |
| qcom_ep_reset_assert(pcie); |
| err_disable_phy: |
| phy_power_off(pcie->phy); |
| err_deinit: |
| pcie->cfg->ops->deinit(pcie); |
| |
| return ret; |
| } |
| |
| static void qcom_pcie_host_deinit(struct dw_pcie_rp *pp) |
| { |
| struct dw_pcie *pci = to_dw_pcie_from_pp(pp); |
| struct qcom_pcie *pcie = to_qcom_pcie(pci); |
| |
| qcom_ep_reset_assert(pcie); |
| phy_power_off(pcie->phy); |
| pcie->cfg->ops->deinit(pcie); |
| } |
| |
| static const struct dw_pcie_host_ops qcom_pcie_dw_ops = { |
| .host_init = qcom_pcie_host_init, |
| .host_deinit = qcom_pcie_host_deinit, |
| }; |
| |
| /* Qcom IP rev.: 2.1.0 Synopsys IP rev.: 4.01a */ |
| static const struct qcom_pcie_ops ops_2_1_0 = { |
| .get_resources = qcom_pcie_get_resources_2_1_0, |
| .init = qcom_pcie_init_2_1_0, |
| .post_init = qcom_pcie_post_init_2_1_0, |
| .deinit = qcom_pcie_deinit_2_1_0, |
| .ltssm_enable = qcom_pcie_2_1_0_ltssm_enable, |
| }; |
| |
| /* Qcom IP rev.: 1.0.0 Synopsys IP rev.: 4.11a */ |
| static const struct qcom_pcie_ops ops_1_0_0 = { |
| .get_resources = qcom_pcie_get_resources_1_0_0, |
| .init = qcom_pcie_init_1_0_0, |
| .post_init = qcom_pcie_post_init_1_0_0, |
| .deinit = qcom_pcie_deinit_1_0_0, |
| .ltssm_enable = qcom_pcie_2_1_0_ltssm_enable, |
| }; |
| |
| /* Qcom IP rev.: 2.3.2 Synopsys IP rev.: 4.21a */ |
| static const struct qcom_pcie_ops ops_2_3_2 = { |
| .get_resources = qcom_pcie_get_resources_2_3_2, |
| .init = qcom_pcie_init_2_3_2, |
| .post_init = qcom_pcie_post_init_2_3_2, |
| .deinit = qcom_pcie_deinit_2_3_2, |
| .ltssm_enable = qcom_pcie_2_3_2_ltssm_enable, |
| }; |
| |
| /* Qcom IP rev.: 2.4.0 Synopsys IP rev.: 4.20a */ |
| static const struct qcom_pcie_ops ops_2_4_0 = { |
| .get_resources = qcom_pcie_get_resources_2_4_0, |
| .init = qcom_pcie_init_2_4_0, |
| .post_init = qcom_pcie_post_init_2_4_0, |
| .deinit = qcom_pcie_deinit_2_4_0, |
| .ltssm_enable = qcom_pcie_2_3_2_ltssm_enable, |
| }; |
| |
| /* Qcom IP rev.: 2.3.3 Synopsys IP rev.: 4.30a */ |
| static const struct qcom_pcie_ops ops_2_3_3 = { |
| .get_resources = qcom_pcie_get_resources_2_3_3, |
| .init = qcom_pcie_init_2_3_3, |
| .post_init = qcom_pcie_post_init_2_3_3, |
| .deinit = qcom_pcie_deinit_2_3_3, |
| .ltssm_enable = qcom_pcie_2_3_2_ltssm_enable, |
| }; |
| |
| /* Qcom IP rev.: 2.7.0 Synopsys IP rev.: 4.30a */ |
| static const struct qcom_pcie_ops ops_2_7_0 = { |
| .get_resources = qcom_pcie_get_resources_2_7_0, |
| .init = qcom_pcie_init_2_7_0, |
| .deinit = qcom_pcie_deinit_2_7_0, |
| .ltssm_enable = qcom_pcie_2_3_2_ltssm_enable, |
| }; |
| |
| /* Qcom IP rev.: 1.9.0 */ |
| static const struct qcom_pcie_ops ops_1_9_0 = { |
| .get_resources = qcom_pcie_get_resources_2_7_0, |
| .init = qcom_pcie_init_2_7_0, |
| .deinit = qcom_pcie_deinit_2_7_0, |
| .ltssm_enable = qcom_pcie_2_3_2_ltssm_enable, |
| .config_sid = qcom_pcie_config_sid_1_9_0, |
| }; |
| |
| /* Qcom IP rev.: 2.9.0 Synopsys IP rev.: 5.00a */ |
| static const struct qcom_pcie_ops ops_2_9_0 = { |
| .get_resources = qcom_pcie_get_resources_2_9_0, |
| .init = qcom_pcie_init_2_9_0, |
| .post_init = qcom_pcie_post_init_2_9_0, |
| .deinit = qcom_pcie_deinit_2_9_0, |
| .ltssm_enable = qcom_pcie_2_3_2_ltssm_enable, |
| }; |
| |
| static const struct qcom_pcie_cfg cfg_1_0_0 = { |
| .ops = &ops_1_0_0, |
| }; |
| |
| static const struct qcom_pcie_cfg cfg_1_9_0 = { |
| .ops = &ops_1_9_0, |
| }; |
| |
| static const struct qcom_pcie_cfg cfg_2_1_0 = { |
| .ops = &ops_2_1_0, |
| }; |
| |
| static const struct qcom_pcie_cfg cfg_2_3_2 = { |
| .ops = &ops_2_3_2, |
| }; |
| |
| static const struct qcom_pcie_cfg cfg_2_3_3 = { |
| .ops = &ops_2_3_3, |
| }; |
| |
| static const struct qcom_pcie_cfg cfg_2_4_0 = { |
| .ops = &ops_2_4_0, |
| }; |
| |
| static const struct qcom_pcie_cfg cfg_2_7_0 = { |
| .ops = &ops_2_7_0, |
| }; |
| |
| static const struct qcom_pcie_cfg cfg_2_9_0 = { |
| .ops = &ops_2_9_0, |
| }; |
| |
| static const struct dw_pcie_ops dw_pcie_ops = { |
| .link_up = qcom_pcie_link_up, |
| .start_link = qcom_pcie_start_link, |
| }; |
| |
| static int qcom_pcie_icc_init(struct qcom_pcie *pcie) |
| { |
| struct dw_pcie *pci = pcie->pci; |
| int ret; |
| |
| pcie->icc_mem = devm_of_icc_get(pci->dev, "pcie-mem"); |
| if (IS_ERR(pcie->icc_mem)) |
| return PTR_ERR(pcie->icc_mem); |
| |
| /* |
| * Some Qualcomm platforms require interconnect bandwidth constraints |
| * to be set before enabling interconnect clocks. |
| * |
| * Set an initial peak bandwidth corresponding to single-lane Gen 1 |
| * for the pcie-mem path. |
| */ |
| ret = icc_set_bw(pcie->icc_mem, 0, MBps_to_icc(250)); |
| if (ret) { |
| dev_err(pci->dev, "failed to set interconnect bandwidth: %d\n", |
| ret); |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static void qcom_pcie_icc_update(struct qcom_pcie *pcie) |
| { |
| struct dw_pcie *pci = pcie->pci; |
| u32 offset, status, bw; |
| int speed, width; |
| int ret; |
| |
| if (!pcie->icc_mem) |
| return; |
| |
| offset = dw_pcie_find_capability(pci, PCI_CAP_ID_EXP); |
| status = readw(pci->dbi_base + offset + PCI_EXP_LNKSTA); |
| |
| /* Only update constraints if link is up. */ |
| if (!(status & PCI_EXP_LNKSTA_DLLLA)) |
| return; |
| |
| speed = FIELD_GET(PCI_EXP_LNKSTA_CLS, status); |
| width = FIELD_GET(PCI_EXP_LNKSTA_NLW, status); |
| |
| switch (speed) { |
| case 1: |
| bw = MBps_to_icc(250); |
| break; |
| case 2: |
| bw = MBps_to_icc(500); |
| break; |
| default: |
| WARN_ON_ONCE(1); |
| fallthrough; |
| case 3: |
| bw = MBps_to_icc(985); |
| break; |
| } |
| |
| ret = icc_set_bw(pcie->icc_mem, 0, width * bw); |
| if (ret) { |
| dev_err(pci->dev, "failed to set interconnect bandwidth: %d\n", |
| ret); |
| } |
| } |
| |
| static int qcom_pcie_link_transition_count(struct seq_file *s, void *data) |
| { |
| struct qcom_pcie *pcie = (struct qcom_pcie *)dev_get_drvdata(s->private); |
| |
| seq_printf(s, "L0s transition count: %u\n", |
| readl_relaxed(pcie->mhi + PARF_DEBUG_CNT_PM_LINKST_IN_L0S)); |
| |
| seq_printf(s, "L1 transition count: %u\n", |
| readl_relaxed(pcie->mhi + PARF_DEBUG_CNT_PM_LINKST_IN_L1)); |
| |
| seq_printf(s, "L1.1 transition count: %u\n", |
| readl_relaxed(pcie->mhi + PARF_DEBUG_CNT_AUX_CLK_IN_L1SUB_L1)); |
| |
| seq_printf(s, "L1.2 transition count: %u\n", |
| readl_relaxed(pcie->mhi + PARF_DEBUG_CNT_AUX_CLK_IN_L1SUB_L2)); |
| |
| seq_printf(s, "L2 transition count: %u\n", |
| readl_relaxed(pcie->mhi + PARF_DEBUG_CNT_PM_LINKST_IN_L2)); |
| |
| return 0; |
| } |
| |
| static void qcom_pcie_init_debugfs(struct qcom_pcie *pcie) |
| { |
| struct dw_pcie *pci = pcie->pci; |
| struct device *dev = pci->dev; |
| char *name; |
| |
| name = devm_kasprintf(dev, GFP_KERNEL, "%pOFP", dev->of_node); |
| if (!name) |
| return; |
| |
| pcie->debugfs = debugfs_create_dir(name, NULL); |
| debugfs_create_devm_seqfile(dev, "link_transition_count", pcie->debugfs, |
| qcom_pcie_link_transition_count); |
| } |
| |
| static int qcom_pcie_probe(struct platform_device *pdev) |
| { |
| const struct qcom_pcie_cfg *pcie_cfg; |
| struct device *dev = &pdev->dev; |
| struct qcom_pcie *pcie; |
| struct dw_pcie_rp *pp; |
| struct resource *res; |
| struct dw_pcie *pci; |
| int ret; |
| |
| pcie_cfg = of_device_get_match_data(dev); |
| if (!pcie_cfg || !pcie_cfg->ops) { |
| dev_err(dev, "Invalid platform data\n"); |
| return -EINVAL; |
| } |
| |
| pcie = devm_kzalloc(dev, sizeof(*pcie), GFP_KERNEL); |
| if (!pcie) |
| return -ENOMEM; |
| |
| pci = devm_kzalloc(dev, sizeof(*pci), GFP_KERNEL); |
| if (!pci) |
| return -ENOMEM; |
| |
| pm_runtime_enable(dev); |
| ret = pm_runtime_get_sync(dev); |
| if (ret < 0) |
| goto err_pm_runtime_put; |
| |
| pci->dev = dev; |
| pci->ops = &dw_pcie_ops; |
| pp = &pci->pp; |
| |
| pcie->pci = pci; |
| |
| pcie->cfg = pcie_cfg; |
| |
| pcie->reset = devm_gpiod_get_optional(dev, "perst", GPIOD_OUT_HIGH); |
| if (IS_ERR(pcie->reset)) { |
| ret = PTR_ERR(pcie->reset); |
| goto err_pm_runtime_put; |
| } |
| |
| pcie->parf = devm_platform_ioremap_resource_byname(pdev, "parf"); |
| if (IS_ERR(pcie->parf)) { |
| ret = PTR_ERR(pcie->parf); |
| goto err_pm_runtime_put; |
| } |
| |
| pcie->elbi = devm_platform_ioremap_resource_byname(pdev, "elbi"); |
| if (IS_ERR(pcie->elbi)) { |
| ret = PTR_ERR(pcie->elbi); |
| goto err_pm_runtime_put; |
| } |
| |
| /* MHI region is optional */ |
| res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mhi"); |
| if (res) { |
| pcie->mhi = devm_ioremap_resource(dev, res); |
| if (IS_ERR(pcie->mhi)) { |
| ret = PTR_ERR(pcie->mhi); |
| goto err_pm_runtime_put; |
| } |
| } |
| |
| pcie->phy = devm_phy_optional_get(dev, "pciephy"); |
| if (IS_ERR(pcie->phy)) { |
| ret = PTR_ERR(pcie->phy); |
| goto err_pm_runtime_put; |
| } |
| |
| ret = qcom_pcie_icc_init(pcie); |
| if (ret) |
| goto err_pm_runtime_put; |
| |
| ret = pcie->cfg->ops->get_resources(pcie); |
| if (ret) |
| goto err_pm_runtime_put; |
| |
| pp->ops = &qcom_pcie_dw_ops; |
| |
| ret = phy_init(pcie->phy); |
| if (ret) |
| goto err_pm_runtime_put; |
| |
| platform_set_drvdata(pdev, pcie); |
| |
| ret = dw_pcie_host_init(pp); |
| if (ret) { |
| dev_err(dev, "cannot initialize host\n"); |
| goto err_phy_exit; |
| } |
| |
| qcom_pcie_icc_update(pcie); |
| |
| if (pcie->mhi) |
| qcom_pcie_init_debugfs(pcie); |
| |
| return 0; |
| |
| err_phy_exit: |
| phy_exit(pcie->phy); |
| err_pm_runtime_put: |
| pm_runtime_put(dev); |
| pm_runtime_disable(dev); |
| |
| return ret; |
| } |
| |
| static int qcom_pcie_suspend_noirq(struct device *dev) |
| { |
| struct qcom_pcie *pcie = dev_get_drvdata(dev); |
| int ret; |
| |
| /* |
| * Set minimum bandwidth required to keep data path functional during |
| * suspend. |
| */ |
| ret = icc_set_bw(pcie->icc_mem, 0, kBps_to_icc(1)); |
| if (ret) { |
| dev_err(dev, "Failed to set interconnect bandwidth: %d\n", ret); |
| return ret; |
| } |
| |
| /* |
| * Turn OFF the resources only for controllers without active PCIe |
| * devices. For controllers with active devices, the resources are kept |
| * ON and the link is expected to be in L0/L1 (sub)states. |
| * |
| * Turning OFF the resources for controllers with active PCIe devices |
| * will trigger access violation during the end of the suspend cycle, |
| * as kernel tries to access the PCIe devices config space for masking |
| * MSIs. |
| * |
| * Also, it is not desirable to put the link into L2/L3 state as that |
| * implies VDD supply will be removed and the devices may go into |
| * powerdown state. This will affect the lifetime of the storage devices |
| * like NVMe. |
| */ |
| if (!dw_pcie_link_up(pcie->pci)) { |
| qcom_pcie_host_deinit(&pcie->pci->pp); |
| pcie->suspended = true; |
| } |
| |
| return 0; |
| } |
| |
| static int qcom_pcie_resume_noirq(struct device *dev) |
| { |
| struct qcom_pcie *pcie = dev_get_drvdata(dev); |
| int ret; |
| |
| if (pcie->suspended) { |
| ret = qcom_pcie_host_init(&pcie->pci->pp); |
| if (ret) |
| return ret; |
| |
| pcie->suspended = false; |
| } |
| |
| qcom_pcie_icc_update(pcie); |
| |
| return 0; |
| } |
| |
| static const struct of_device_id qcom_pcie_match[] = { |
| { .compatible = "qcom,pcie-apq8064", .data = &cfg_2_1_0 }, |
| { .compatible = "qcom,pcie-apq8084", .data = &cfg_1_0_0 }, |
| { .compatible = "qcom,pcie-ipq4019", .data = &cfg_2_4_0 }, |
| { .compatible = "qcom,pcie-ipq6018", .data = &cfg_2_9_0 }, |
| { .compatible = "qcom,pcie-ipq8064", .data = &cfg_2_1_0 }, |
| { .compatible = "qcom,pcie-ipq8064-v2", .data = &cfg_2_1_0 }, |
| { .compatible = "qcom,pcie-ipq8074", .data = &cfg_2_3_3 }, |
| { .compatible = "qcom,pcie-ipq8074-gen3", .data = &cfg_2_9_0 }, |
| { .compatible = "qcom,pcie-msm8996", .data = &cfg_2_3_2 }, |
| { .compatible = "qcom,pcie-qcs404", .data = &cfg_2_4_0 }, |
| { .compatible = "qcom,pcie-sa8540p", .data = &cfg_1_9_0 }, |
| { .compatible = "qcom,pcie-sc7280", .data = &cfg_1_9_0 }, |
| { .compatible = "qcom,pcie-sc8180x", .data = &cfg_1_9_0 }, |
| { .compatible = "qcom,pcie-sc8280xp", .data = &cfg_1_9_0 }, |
| { .compatible = "qcom,pcie-sdm845", .data = &cfg_2_7_0 }, |
| { .compatible = "qcom,pcie-sdx55", .data = &cfg_1_9_0 }, |
| { .compatible = "qcom,pcie-sm8150", .data = &cfg_1_9_0 }, |
| { .compatible = "qcom,pcie-sm8250", .data = &cfg_1_9_0 }, |
| { .compatible = "qcom,pcie-sm8350", .data = &cfg_1_9_0 }, |
| { .compatible = "qcom,pcie-sm8450-pcie0", .data = &cfg_1_9_0 }, |
| { .compatible = "qcom,pcie-sm8450-pcie1", .data = &cfg_1_9_0 }, |
| { .compatible = "qcom,pcie-sm8550", .data = &cfg_1_9_0 }, |
| { } |
| }; |
| |
| static void qcom_fixup_class(struct pci_dev *dev) |
| { |
| dev->class = PCI_CLASS_BRIDGE_PCI_NORMAL; |
| } |
| DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_QCOM, 0x0101, qcom_fixup_class); |
| DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_QCOM, 0x0104, qcom_fixup_class); |
| DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_QCOM, 0x0106, qcom_fixup_class); |
| DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_QCOM, 0x0107, qcom_fixup_class); |
| DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_QCOM, 0x0302, qcom_fixup_class); |
| DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_QCOM, 0x1000, qcom_fixup_class); |
| DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_QCOM, 0x1001, qcom_fixup_class); |
| |
| static const struct dev_pm_ops qcom_pcie_pm_ops = { |
| NOIRQ_SYSTEM_SLEEP_PM_OPS(qcom_pcie_suspend_noirq, qcom_pcie_resume_noirq) |
| }; |
| |
| static struct platform_driver qcom_pcie_driver = { |
| .probe = qcom_pcie_probe, |
| .driver = { |
| .name = "qcom-pcie", |
| .suppress_bind_attrs = true, |
| .of_match_table = qcom_pcie_match, |
| .pm = &qcom_pcie_pm_ops, |
| .probe_type = PROBE_PREFER_ASYNCHRONOUS, |
| }, |
| }; |
| builtin_platform_driver(qcom_pcie_driver); |