Quelle  pci-exynos.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * PCIe host controller driver for Samsung Exynos SoCs
 *
 * Copyright (C) 2013-2020 Samsung Electronics Co., Ltd.
 *  https://www.samsung.com
 *
 * Author: Jingoo Han <jg1.han@samsung.com>
 *    Jaehoon Chung <jh80.chung@samsung.com>
 */

#include <linux/clk.h>
#include <linux/delay.h>
#include <linux/interrupt.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/pci.h>
#include <linux/platform_device.h>
#include <linux/phy/phy.h>
#include <linux/regulator/consumer.h>
#include <linux/mod_devicetable.h>
#include <linux/module.h>

#include "pcie-designware.h"

#define to_exynos_pcie(x) dev_get_drvdata((x)->dev)

/* PCIe ELBI registers */
#define PCIE_IRQ_PULSE   0x000
#define IRQ_INTA_ASSERT   BIT(0)
#define IRQ_INTB_ASSERT   BIT(2)
#define IRQ_INTC_ASSERT   BIT(4)
#define IRQ_INTD_ASSERT   BIT(6)
#define PCIE_IRQ_LEVEL   0x004
#define PCIE_IRQ_SPECIAL  0x008
#define PCIE_IRQ_EN_PULSE  0x00c
#define PCIE_IRQ_EN_LEVEL  0x010
#define PCIE_IRQ_EN_SPECIAL  0x014
#define PCIE_SW_WAKE   0x018
#define PCIE_BUS_EN   BIT(1)
#define PCIE_CORE_RESET   0x01c
#define PCIE_CORE_RESET_ENABLE  BIT(0)
#define PCIE_STICKY_RESET  0x020
#define PCIE_NONSTICKY_RESET  0x024
#define PCIE_APP_INIT_RESET  0x028
#define PCIE_APP_LTSSM_ENABLE  0x02c
#define PCIE_ELBI_RDLH_LINKUP  0x074
#define PCIE_ELBI_XMLH_LINKUP  BIT(4)
#define PCIE_ELBI_LTSSM_ENABLE  0x1
#define PCIE_ELBI_SLV_AWMISC  0x11c
#define PCIE_ELBI_SLV_ARMISC  0x120
#define PCIE_ELBI_SLV_DBI_ENABLE BIT(21)

struct exynos_pcie {
 struct dw_pcie   pci;
 void __iomem   *elbi_base;
 struct clk_bulk_data  *clks;
 struct phy   *phy;
 struct regulator_bulk_data supplies[2];
};

static void exynos_pcie_writel(void __iomem *base, u32 val, u32 reg)
{
 writel(val, base + reg);
}

static u32 exynos_pcie_readl(void __iomem *base, u32 reg)
{
 return readl(base + reg);
}

static void exynos_pcie_sideband_dbi_w_mode(struct exynos_pcie *ep, bool on)
{
 u32 val;

 val = exynos_pcie_readl(ep->elbi_base, PCIE_ELBI_SLV_AWMISC);
 if (on)
  val |= PCIE_ELBI_SLV_DBI_ENABLE;
 else
  val &= ~PCIE_ELBI_SLV_DBI_ENABLE;
 exynos_pcie_writel(ep->elbi_base, val, PCIE_ELBI_SLV_AWMISC);
}

static void exynos_pcie_sideband_dbi_r_mode(struct exynos_pcie *ep, bool on)
{
 u32 val;

 val = exynos_pcie_readl(ep->elbi_base, PCIE_ELBI_SLV_ARMISC);
 if (on)
  val |= PCIE_ELBI_SLV_DBI_ENABLE;
 else
  val &= ~PCIE_ELBI_SLV_DBI_ENABLE;
 exynos_pcie_writel(ep->elbi_base, val, PCIE_ELBI_SLV_ARMISC);
}

static void exynos_pcie_assert_core_reset(struct exynos_pcie *ep)
{
 u32 val;

 val = exynos_pcie_readl(ep->elbi_base, PCIE_CORE_RESET);
 val &= ~PCIE_CORE_RESET_ENABLE;
 exynos_pcie_writel(ep->elbi_base, val, PCIE_CORE_RESET);
 exynos_pcie_writel(ep->elbi_base, 0, PCIE_STICKY_RESET);
 exynos_pcie_writel(ep->elbi_base, 0, PCIE_NONSTICKY_RESET);
}

static void exynos_pcie_deassert_core_reset(struct exynos_pcie *ep)
{
 u32 val;

 val = exynos_pcie_readl(ep->elbi_base, PCIE_CORE_RESET);
 val |= PCIE_CORE_RESET_ENABLE;

 exynos_pcie_writel(ep->elbi_base, val, PCIE_CORE_RESET);
 exynos_pcie_writel(ep->elbi_base, 1, PCIE_STICKY_RESET);
 exynos_pcie_writel(ep->elbi_base, 1, PCIE_NONSTICKY_RESET);
 exynos_pcie_writel(ep->elbi_base, 1, PCIE_APP_INIT_RESET);
 exynos_pcie_writel(ep->elbi_base, 0, PCIE_APP_INIT_RESET);
}

static int exynos_pcie_start_link(struct dw_pcie *pci)
{
 struct exynos_pcie *ep = to_exynos_pcie(pci);
 u32 val;

 val = exynos_pcie_readl(ep->elbi_base, PCIE_SW_WAKE);
 val &= ~PCIE_BUS_EN;
 exynos_pcie_writel(ep->elbi_base, val, PCIE_SW_WAKE);

 /* assert LTSSM enable */
 exynos_pcie_writel(ep->elbi_base, PCIE_ELBI_LTSSM_ENABLE,
     PCIE_APP_LTSSM_ENABLE);
 return 0;
}

static void exynos_pcie_clear_irq_pulse(struct exynos_pcie *ep)
{
 u32 val = exynos_pcie_readl(ep->elbi_base, PCIE_IRQ_PULSE);

 exynos_pcie_writel(ep->elbi_base, val, PCIE_IRQ_PULSE);
}

static irqreturn_t exynos_pcie_irq_handler(int irq, void *arg)
{
 struct exynos_pcie *ep = arg;

 exynos_pcie_clear_irq_pulse(ep);
 return IRQ_HANDLED;
}

static void exynos_pcie_enable_irq_pulse(struct exynos_pcie *ep)
{
 u32 val = IRQ_INTA_ASSERT | IRQ_INTB_ASSERT |
    IRQ_INTC_ASSERT | IRQ_INTD_ASSERT;

 exynos_pcie_writel(ep->elbi_base, val, PCIE_IRQ_EN_PULSE);
 exynos_pcie_writel(ep->elbi_base, 0, PCIE_IRQ_EN_LEVEL);
 exynos_pcie_writel(ep->elbi_base, 0, PCIE_IRQ_EN_SPECIAL);
}

static u32 exynos_pcie_read_dbi(struct dw_pcie *pci, void __iomem *base,
    u32 reg, size_t size)
{
 struct exynos_pcie *ep = to_exynos_pcie(pci);
 u32 val;

 exynos_pcie_sideband_dbi_r_mode(ep, true);
 dw_pcie_read(base + reg, size, &val);
 exynos_pcie_sideband_dbi_r_mode(ep, false);
 return val;
}

static void exynos_pcie_write_dbi(struct dw_pcie *pci, void __iomem *base,
      u32 reg, size_t size, u32 val)
{
 struct exynos_pcie *ep = to_exynos_pcie(pci);

 exynos_pcie_sideband_dbi_w_mode(ep, true);
 dw_pcie_write(base + reg, size, val);
 exynos_pcie_sideband_dbi_w_mode(ep, false);
}

static int exynos_pcie_rd_own_conf(struct pci_bus *bus, unsigned int devfn,
       int where, int size, u32 *val)
{
 struct dw_pcie *pci = to_dw_pcie_from_pp(bus->sysdata);

 if (PCI_SLOT(devfn))
  return PCIBIOS_DEVICE_NOT_FOUND;

 *val = dw_pcie_read_dbi(pci, where, size);
 return PCIBIOS_SUCCESSFUL;
}

static int exynos_pcie_wr_own_conf(struct pci_bus *bus, unsigned int devfn,
       int where, int size, u32 val)
{
 struct dw_pcie *pci = to_dw_pcie_from_pp(bus->sysdata);

 if (PCI_SLOT(devfn))
  return PCIBIOS_DEVICE_NOT_FOUND;

 dw_pcie_write_dbi(pci, where, size, val);
 return PCIBIOS_SUCCESSFUL;
}

static struct pci_ops exynos_pci_ops = {
 .read = exynos_pcie_rd_own_conf,
 .write = exynos_pcie_wr_own_conf,
};

static bool exynos_pcie_link_up(struct dw_pcie *pci)
{
 struct exynos_pcie *ep = to_exynos_pcie(pci);
 u32 val = exynos_pcie_readl(ep->elbi_base, PCIE_ELBI_RDLH_LINKUP);

 return val & PCIE_ELBI_XMLH_LINKUP;
}

static int exynos_pcie_host_init(struct dw_pcie_rp *pp)
{
 struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 struct exynos_pcie *ep = to_exynos_pcie(pci);

 pp->bridge->ops = &exynos_pci_ops;

 exynos_pcie_assert_core_reset(ep);

 phy_init(ep->phy);
 phy_power_on(ep->phy);

 exynos_pcie_deassert_core_reset(ep);
 exynos_pcie_enable_irq_pulse(ep);

 return 0;
}

static const struct dw_pcie_host_ops exynos_pcie_host_ops = {
 .init = exynos_pcie_host_init,
};

static int exynos_add_pcie_port(struct exynos_pcie *ep,
           struct platform_device *pdev)
{
 struct dw_pcie *pci = &ep->pci;
 struct dw_pcie_rp *pp = &pci->pp;
 struct device *dev = &pdev->dev;
 int ret;

 pp->irq = platform_get_irq(pdev, 0);
 if (pp->irq < 0)
  return pp->irq;

 ret = devm_request_irq(dev, pp->irq, exynos_pcie_irq_handler,
          IRQF_SHARED, "exynos-pcie", ep);
 if (ret) {
  dev_err(dev, "failed to request irq\n");
  return ret;
 }

 pp->ops = &exynos_pcie_host_ops;
 pp->msi_irq[0] = -ENODEV;

 ret = dw_pcie_host_init(pp);
 if (ret) {
  dev_err(dev, "failed to initialize host\n");
  return ret;
 }

 return 0;
}

static const struct dw_pcie_ops dw_pcie_ops = {
 .read_dbi = exynos_pcie_read_dbi,
 .write_dbi = exynos_pcie_write_dbi,
 .link_up = exynos_pcie_link_up,
 .start_link = exynos_pcie_start_link,
};

static int exynos_pcie_probe(struct platform_device *pdev)
{
 struct device *dev = &pdev->dev;
 struct exynos_pcie *ep;
 struct device_node *np = dev->of_node;
 int ret;

 ep = devm_kzalloc(dev, sizeof(*ep), GFP_KERNEL);
 if (!ep)
  return -ENOMEM;

 ep->pci.dev = dev;
 ep->pci.ops = &dw_pcie_ops;

 ep->phy = devm_of_phy_get(dev, np, NULL);
 if (IS_ERR(ep->phy))
  return PTR_ERR(ep->phy);

 /* External Local Bus interface (ELBI) registers */
 ep->elbi_base = devm_platform_ioremap_resource_byname(pdev, "elbi");
 if (IS_ERR(ep->elbi_base))
  return PTR_ERR(ep->elbi_base);

 ret = devm_clk_bulk_get_all_enabled(dev, &ep->clks);
 if (ret < 0)
  return ret;

 ep->supplies[0].supply = "vdd18";
 ep->supplies[1].supply = "vdd10";
 ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(ep->supplies),
          ep->supplies);
 if (ret)
  return ret;

 ret = regulator_bulk_enable(ARRAY_SIZE(ep->supplies), ep->supplies);
 if (ret)
  return ret;

 platform_set_drvdata(pdev, ep);

 ret = exynos_add_pcie_port(ep, pdev);
 if (ret < 0)
  goto fail_probe;

 return 0;

fail_probe:
 phy_exit(ep->phy);
 regulator_bulk_disable(ARRAY_SIZE(ep->supplies), ep->supplies);

 return ret;
}

static void exynos_pcie_remove(struct platform_device *pdev)
{
 struct exynos_pcie *ep = platform_get_drvdata(pdev);

 dw_pcie_host_deinit(&ep->pci.pp);
 exynos_pcie_assert_core_reset(ep);
 phy_power_off(ep->phy);
 phy_exit(ep->phy);
 regulator_bulk_disable(ARRAY_SIZE(ep->supplies), ep->supplies);
}

static int exynos_pcie_suspend_noirq(struct device *dev)
{
 struct exynos_pcie *ep = dev_get_drvdata(dev);

 exynos_pcie_assert_core_reset(ep);
 phy_power_off(ep->phy);
 phy_exit(ep->phy);
 regulator_bulk_disable(ARRAY_SIZE(ep->supplies), ep->supplies);

 return 0;
}

static int exynos_pcie_resume_noirq(struct device *dev)
{
 struct exynos_pcie *ep = dev_get_drvdata(dev);
 struct dw_pcie *pci = &ep->pci;
 struct dw_pcie_rp *pp = &pci->pp;
 int ret;

 ret = regulator_bulk_enable(ARRAY_SIZE(ep->supplies), ep->supplies);
 if (ret)
  return ret;

 /* exynos_pcie_host_init controls ep->phy */
 exynos_pcie_host_init(pp);
 dw_pcie_setup_rc(pp);
 exynos_pcie_start_link(pci);
 return dw_pcie_wait_for_link(pci);
}

static const struct dev_pm_ops exynos_pcie_pm_ops = {
 NOIRQ_SYSTEM_SLEEP_PM_OPS(exynos_pcie_suspend_noirq,
      exynos_pcie_resume_noirq)
};

static const struct of_device_id exynos_pcie_of_match[] = {
 { .compatible = "samsung,exynos5433-pcie", },
 { },
};

static struct platform_driver exynos_pcie_driver = {
 .probe  = exynos_pcie_probe,
 .remove  = exynos_pcie_remove,
 .driver = {
  .name = "exynos-pcie",
  .of_match_table = exynos_pcie_of_match,
  .pm  = &exynos_pcie_pm_ops,
 },
};
module_platform_driver(exynos_pcie_driver);
MODULE_DESCRIPTION("Samsung Exynos PCIe host controller driver");
MODULE_LICENSE("GPL v2");
MODULE_DEVICE_TABLE(of, exynos_pcie_of_match);