[PATCH] ipq40xx: add PCIe magic hack to improve VRX518 compatibility

Robert Marko robimarko at gmail.com
Mon Jan 30 15:08:44 PST 2023


On Mon, 30 Jan 2023 at 23:41, Jan Hoffmann <jan at 3e8.eu> wrote:
>
> Some VRX518 modems fail to initialize properly with the error message
> "dc_ep_clk_on failed". As a result, the DSL data path doesn't work.
>
> This hack, which is based on code from the FRITZ!Box 7530 GPL archive,
> fixes the issue. It changes the PCIe vendor/device ID to values matching
> a Lantiq SoC. It also appears to emulate a Lantiq CPU ID register for
> connected PCIe devices, by remapping the matching address area to a
> specially crafted buffer using the address translation unit.
>
> The hack is only active if the "avm,host_magic" property is specified in
> the device tree, so this shouldn't affect any devices other than
> FRITZ!Box 7530/7520.

Shouldn't it be possible for the modem driver itself to be fixed
instead of faking
the PCI details?

Especially considering that now modem support is not self-contained
and will require
patching the DWC Qualcomm PCI driver forever.

Regards,
Robert
>
> Signed-off-by: Jan Hoffmann <jan at 3e8.eu>
> ---
>  .../boot/dts/qcom-ipq4019-fritzbox-7530.dts   |   2 +
>  .../997-pcie-qcom-host-magic.patch            | 215 ++++++++++++++++++
>  2 files changed, 217 insertions(+)
>  create mode 100644 target/linux/ipq40xx/patches-5.15/997-pcie-qcom-host-magic.patch
>
> diff --git a/target/linux/ipq40xx/files/arch/arm/boot/dts/qcom-ipq4019-fritzbox-7530.dts b/target/linux/ipq40xx/files/arch/arm/boot/dts/qcom-ipq4019-fritzbox-7530.dts
> index 336da52f2724..bc167616d3dc 100644
> --- a/target/linux/ipq40xx/files/arch/arm/boot/dts/qcom-ipq4019-fritzbox-7530.dts
> +++ b/target/linux/ipq40xx/files/arch/arm/boot/dts/qcom-ipq4019-fritzbox-7530.dts
> @@ -306,6 +306,8 @@
>         perst-gpio = <&tlmm 38 GPIO_ACTIVE_LOW>;
>         wake-gpio = <&tlmm 50 GPIO_ACTIVE_LOW>;
>
> +       avm,host_magic;
> +
>         bridge at 0,0 {
>                 reg = <0x00000000 0 0 0 0>;
>                 #address-cells = <3>;
> diff --git a/target/linux/ipq40xx/patches-5.15/997-pcie-qcom-host-magic.patch b/target/linux/ipq40xx/patches-5.15/997-pcie-qcom-host-magic.patch
> new file mode 100644
> index 000000000000..f427bccd2f4a
> --- /dev/null
> +++ b/target/linux/ipq40xx/patches-5.15/997-pcie-qcom-host-magic.patch
> @@ -0,0 +1,215 @@
> +This hack is based on code from the FRITZ!Box 7530 GPL archive for
> +firmware version 07.50.
> +
> +If the device tree contains the "avm,host_magic" property, it changes
> +the PCIe vendor/device ID to the values from Lantiq GRX500 SoCs. It also
> +programs the ATU to present a buffer containing a magic value to PCIe
> +devices. This appears to emulate a Lantiq CPU ID register.
> +
> +Without this hack, some VRX518 modems fail to initialize properly (error
> +"dc_ep_clk_on failed"), and the DSL data path doesn't work.
> +--- a/drivers/pci/controller/dwc/pcie-qcom.c
> ++++ b/drivers/pci/controller/dwc/pcie-qcom.c
> +@@ -27,6 +27,7 @@
> + #include <linux/reset.h>
> + #include <linux/slab.h>
> + #include <linux/types.h>
> ++#include <linux/version.h>
> +
> + #include "../../pci.h"
> + #include "pcie-designware.h"
> +@@ -102,6 +103,8 @@
> +
> + #define QCOM_PCIE_CRC8_POLYNOMIAL (BIT(2) | BIT(1) | BIT(0))
> +
> ++#define PCIE_MAGIC_SIZE               0x10000
> ++
> + struct qcom_pcie_resources_2_1_0 {
> +       struct clk_bulk_data clks[QCOM_PCIE_2_1_0_MAX_CLOCKS];
> +       struct reset_control *pci_reset;
> +@@ -197,6 +200,8 @@ struct qcom_pcie {
> +       struct phy *phy;
> +       struct gpio_desc *reset;
> +       const struct qcom_pcie_ops *ops;
> ++      void *magic_cpu_addr;
> ++      dma_addr_t magic_dma_handle;
> + };
> +
> + #define to_qcom_pcie(x)               dev_get_drvdata((x)->dev)
> +@@ -1388,8 +1393,141 @@ err_deinit:
> +       return ret;
> + }
> +
> ++static int qcom_pcie_magic_prog_atu(struct qcom_pcie *pcie,
> ++                                   u32 addr, u32 limit, u32 phys)
> ++{
> ++      struct dw_pcie *pci = pcie->pci;
> ++      struct device *dev = pci->dev;
> ++      u32 retries, val;
> ++      int index;
> ++
> ++      if (!pci->num_ib_windows) {
> ++              dev_err(dev, "No inbound ATU window available for magic\n");
> ++              return -1;
> ++      }
> ++
> ++      /*
> ++       * Use highest window index and reduce window count so the driver
> ++       * won't overwrite the entry later.
> ++       */
> ++      index = --pci->num_ib_windows;
> ++
> ++#if LINUX_VERSION_CODE < KERNEL_VERSION(6,0,0)
> ++      if (pci->iatu_unroll_enabled) {
> ++              dev_err(dev, "Programming ATU for magic not implemented for this hardware\n");
> ++              return -1;
> ++      }
> ++
> ++      dw_pcie_writel_dbi(pci, PCIE_ATU_VIEWPORT,
> ++                         PCIE_ATU_REGION_INBOUND | index);
> ++
> ++      dw_pcie_writel_dbi(pci, PCIE_ATU_LOWER_BASE, addr);
> ++      dw_pcie_writel_dbi(pci, PCIE_ATU_UPPER_BASE, 0);
> ++      dw_pcie_writel_dbi(pci, PCIE_ATU_LIMIT, limit);
> ++      dw_pcie_writel_dbi(pci, PCIE_ATU_LOWER_TARGET, phys);
> ++      dw_pcie_writel_dbi(pci, PCIE_ATU_UPPER_TARGET, 0);
> ++
> ++      dw_pcie_writel_dbi(pci, PCIE_ATU_CR1, PCIE_ATU_TYPE_MEM);
> ++      dw_pcie_writel_dbi(pci, PCIE_ATU_CR2, PCIE_ATU_ENABLE);
> ++
> ++      for (retries = 0; retries < LINK_WAIT_MAX_IATU_RETRIES; retries++) {
> ++              val = dw_pcie_readl_dbi(pci, PCIE_ATU_CR2);
> ++              if (val & PCIE_ATU_ENABLE)
> ++                      return 0;
> ++
> ++              mdelay(LINK_WAIT_IATU);
> ++      }
> ++#else
> ++      dw_pcie_writel_atu_ib(pci, index, PCIE_ATU_LOWER_BASE, addr);
> ++      dw_pcie_writel_atu_ib(pci, index, PCIE_ATU_UPPER_BASE, 0);
> ++      dw_pcie_writel_atu_ib(pci, index, PCIE_ATU_LIMIT, limit);
> ++      dw_pcie_writel_atu_ib(pci, index, PCIE_ATU_LOWER_TARGET, phys);
> ++      dw_pcie_writel_atu_ib(pci, index, PCIE_ATU_UPPER_TARGET, 0);
> ++
> ++      dw_pcie_writel_atu_ib(pci, index, PCIE_ATU_REGION_CTRL1,
> ++                            PCIE_ATU_TYPE_MEM);
> ++      dw_pcie_writel_atu_ib(pci, index, PCIE_ATU_REGION_CTRL2,
> ++                            PCIE_ATU_ENABLE);
> ++
> ++      for (retries = 0; retries < LINK_WAIT_MAX_IATU_RETRIES; retries++) {
> ++              val = dw_pcie_readl_atu_ib(pci, index, PCIE_ATU_REGION_CTRL2);
> ++              if (val & PCIE_ATU_ENABLE)
> ++                      return 0;
> ++
> ++              mdelay(LINK_WAIT_IATU);
> ++      }
> ++#endif
> ++
> ++      dev_err(dev, "Failed to program ATU for magic\n");
> ++      return -1;
> ++}
> ++
> ++static void qcom_pcie_magic_deinit(struct qcom_pcie *pcie)
> ++{
> ++      struct dw_pcie *pci = pcie->pci;
> ++      struct device *dev = pci->dev;
> ++
> ++      if (pcie->magic_cpu_addr) {
> ++              dma_free_coherent(dev, PCIE_MAGIC_SIZE,
> ++                                pcie->magic_cpu_addr,
> ++                                pcie->magic_dma_handle);
> ++
> ++              pcie->magic_cpu_addr = NULL;
> ++      }
> ++}
> ++
> ++static void qcom_pcie_magic_init(struct qcom_pcie *pcie)
> ++{
> ++      struct dw_pcie *pci = pcie->pci;
> ++      struct device *dev = pci->dev;
> ++      u32 *virt;
> ++      u32 phys;
> ++      int ret;
> ++
> ++      if (!of_property_read_bool(dev->of_node, "avm,host_magic"))
> ++              return;
> ++
> ++      dev_info(dev, "Applying PCIe host magic\n");
> ++
> ++      virt = dma_alloc_coherent(dev, PCIE_MAGIC_SIZE, &phys, GFP_ATOMIC);
> ++      BUG_ON(virt == NULL);
> ++
> ++      pcie->magic_cpu_addr = virt;
> ++      pcie->magic_dma_handle = phys;
> ++
> ++      /*
> ++       * This value is the manufacturer ID of Lantiq. The address where
> ++       * it will be visible for the PCIe device matches the location of
> ++       * CPU ID registers on Lantiq SocS (MPS base address is 0x1f107000).
> ++       */
> ++      virt[0x7340/4] = 0x389 << 5;
> ++
> ++      /* Make it visible to PCIe devices using address translation unit */
> ++      ret = qcom_pcie_magic_prog_atu(pcie, 0x1f100000, 0x1f10ffff, phys);
> ++
> ++      dw_pcie_dbi_ro_wr_en(pci);
> ++
> ++      /* Set vendor/device ID of GRX500 PCIe host */
> ++      dw_pcie_writew_dbi(pci, PCI_VENDOR_ID, 0x1bef);
> ++      dw_pcie_writew_dbi(pci, PCI_DEVICE_ID, 0x0030);
> ++
> ++      dw_pcie_dbi_ro_wr_dis(pci);
> ++
> ++      if (ret)
> ++              qcom_pcie_magic_deinit(pcie);
> ++}
> ++
> ++static void qcom_pcie_atu_hack(struct pcie_port *pp)
> ++{
> ++      struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
> ++      struct qcom_pcie *pcie = to_qcom_pcie(pci);
> ++
> ++      qcom_pcie_magic_init(pcie);
> ++}
> ++
> + static const struct dw_pcie_host_ops qcom_pcie_dw_ops = {
> +       .host_init = qcom_pcie_host_init,
> ++      .atu_hack = qcom_pcie_atu_hack,
> + };
> +
> + /* Qcom IP rev.: 2.1.0        Synopsys IP rev.: 4.01a */
> +@@ -1536,6 +1674,7 @@ static int qcom_pcie_probe(struct platfo
> +
> + err_phy_exit:
> +       phy_exit(pcie->phy);
> ++      qcom_pcie_magic_deinit(pcie);
> + err_pm_runtime_put:
> +       pm_runtime_put(dev);
> +       pm_runtime_disable(dev);
> +--- a/drivers/pci/controller/dwc/pcie-designware-host.c
> ++++ b/drivers/pci/controller/dwc/pcie-designware-host.c
> +@@ -400,6 +400,14 @@ int dw_pcie_host_init(struct pcie_port *
> +       }
> +       dw_pcie_iatu_detect(pci);
> +
> ++      /*
> ++       * This needs to be called after ATU detection, but before the driver
> ++       * sets up any ATU entries, to avoid any ATU entry programmed in the
> ++       * hack being overwritten by the driver later.
> ++       */
> ++      if (pp->ops->atu_hack)
> ++              pp->ops->atu_hack(pp);
> ++
> +       dw_pcie_setup_rc(pp);
> +
> +       if (!dw_pcie_link_up(pci) && pci->ops && pci->ops->start_link) {
> +--- a/drivers/pci/controller/dwc/pcie-designware.h
> ++++ b/drivers/pci/controller/dwc/pcie-designware.h
> +@@ -174,6 +174,7 @@ enum dw_pcie_device_mode {
> +
> + struct dw_pcie_host_ops {
> +       int (*host_init)(struct pcie_port *pp);
> ++      void (*atu_hack)(struct pcie_port *pp);
> +       int (*msi_host_init)(struct pcie_port *pp);
> + };
> +
> --
> 2.39.1
>
>
> _______________________________________________
> openwrt-devel mailing list
> openwrt-devel at lists.openwrt.org
> https://lists.openwrt.org/mailman/listinfo/openwrt-devel



More information about the openwrt-devel mailing list