drivers/pci/controller/dwc/pcie-bt1.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2021 BAIKAL ELECTRONICS, JSC
   4  *
   5  * Authors:
   6  *   Vadim Vlasov <Vadim.Vlasov@baikalelectronics.ru>
   7  *   Serge Semin <Sergey.Semin@baikalelectronics.ru>
   8  *
   9  * Baikal-T1 PCIe controller driver
  10  */
  11
  12 #include <linux/bitfield.h>
  13 #include <linux/bits.h>
  14 #include <linux/clk.h>
  15 #include <linux/delay.h>
  16 #include <linux/gpio/consumer.h>
  17 #include <linux/kernel.h>
  18 #include <linux/mfd/syscon.h>
  19 #include <linux/module.h>
  20 #include <linux/pci.h>
  21 #include <linux/platform_device.h>
  22 #include <linux/regmap.h>
  23 #include <linux/reset.h>
  24 #include <linux/types.h>
  25
  26 #include "pcie-designware.h"
  27
  28 /* Baikal-T1 System CCU control registers */
  29 #define BT1_CCU_PCIE_CLKC                       0x140
  30 #define BT1_CCU_PCIE_REQ_PCS_CLK                BIT(16)
  31 #define BT1_CCU_PCIE_REQ_MAC_CLK                BIT(17)
  32 #define BT1_CCU_PCIE_REQ_PIPE_CLK               BIT(18)
  33
  34 #define BT1_CCU_PCIE_RSTC                       0x144
  35 #define BT1_CCU_PCIE_REQ_LINK_RST               BIT(13)
  36 #define BT1_CCU_PCIE_REQ_SMLH_RST               BIT(14)
  37 #define BT1_CCU_PCIE_REQ_PHY_RST                BIT(16)
  38 #define BT1_CCU_PCIE_REQ_CORE_RST               BIT(24)
  39 #define BT1_CCU_PCIE_REQ_STICKY_RST             BIT(26)
  40 #define BT1_CCU_PCIE_REQ_NSTICKY_RST            BIT(27)
  41
  42 #define BT1_CCU_PCIE_PMSC                       0x148
  43 #define BT1_CCU_PCIE_LTSSM_STATE_MASK           GENMASK(5, 0)
  44 #define BT1_CCU_PCIE_LTSSM_DET_QUIET            0x00
  45 #define BT1_CCU_PCIE_LTSSM_DET_ACT              0x01
  46 #define BT1_CCU_PCIE_LTSSM_POLL_ACT             0x02
  47 #define BT1_CCU_PCIE_LTSSM_POLL_COMP            0x03
  48 #define BT1_CCU_PCIE_LTSSM_POLL_CONF            0x04
  49 #define BT1_CCU_PCIE_LTSSM_PRE_DET_QUIET        0x05
  50 #define BT1_CCU_PCIE_LTSSM_DET_WAIT             0x06
  51 #define BT1_CCU_PCIE_LTSSM_CFG_LNKWD_START      0x07
  52 #define BT1_CCU_PCIE_LTSSM_CFG_LNKWD_ACEPT      0x08
  53 #define BT1_CCU_PCIE_LTSSM_CFG_LNNUM_WAIT       0x09
  54 #define BT1_CCU_PCIE_LTSSM_CFG_LNNUM_ACEPT      0x0a
  55 #define BT1_CCU_PCIE_LTSSM_CFG_COMPLETE         0x0b
  56 #define BT1_CCU_PCIE_LTSSM_CFG_IDLE             0x0c
  57 #define BT1_CCU_PCIE_LTSSM_RCVR_LOCK            0x0d
  58 #define BT1_CCU_PCIE_LTSSM_RCVR_SPEED           0x0e
  59 #define BT1_CCU_PCIE_LTSSM_RCVR_RCVRCFG         0x0f
  60 #define BT1_CCU_PCIE_LTSSM_RCVR_IDLE            0x10
  61 #define BT1_CCU_PCIE_LTSSM_L0                   0x11
  62 #define BT1_CCU_PCIE_LTSSM_L0S                  0x12
  63 #define BT1_CCU_PCIE_LTSSM_L123_SEND_IDLE       0x13
  64 #define BT1_CCU_PCIE_LTSSM_L1_IDLE              0x14
  65 #define BT1_CCU_PCIE_LTSSM_L2_IDLE              0x15
  66 #define BT1_CCU_PCIE_LTSSM_L2_WAKE              0x16
  67 #define BT1_CCU_PCIE_LTSSM_DIS_ENTRY            0x17
  68 #define BT1_CCU_PCIE_LTSSM_DIS_IDLE             0x18
  69 #define BT1_CCU_PCIE_LTSSM_DISABLE              0x19
  70 #define BT1_CCU_PCIE_LTSSM_LPBK_ENTRY           0x1a
  71 #define BT1_CCU_PCIE_LTSSM_LPBK_ACTIVE          0x1b
  72 #define BT1_CCU_PCIE_LTSSM_LPBK_EXIT            0x1c
  73 #define BT1_CCU_PCIE_LTSSM_LPBK_EXIT_TOUT       0x1d
  74 #define BT1_CCU_PCIE_LTSSM_HOT_RST_ENTRY        0x1e
  75 #define BT1_CCU_PCIE_LTSSM_HOT_RST              0x1f
  76 #define BT1_CCU_PCIE_LTSSM_RCVR_EQ0             0x20
  77 #define BT1_CCU_PCIE_LTSSM_RCVR_EQ1             0x21
  78 #define BT1_CCU_PCIE_LTSSM_RCVR_EQ2             0x22
  79 #define BT1_CCU_PCIE_LTSSM_RCVR_EQ3             0x23
  80 #define BT1_CCU_PCIE_SMLH_LINKUP                BIT(6)
  81 #define BT1_CCU_PCIE_RDLH_LINKUP                BIT(7)
  82 #define BT1_CCU_PCIE_PM_LINKSTATE_L0S           BIT(8)
  83 #define BT1_CCU_PCIE_PM_LINKSTATE_L1            BIT(9)
  84 #define BT1_CCU_PCIE_PM_LINKSTATE_L2            BIT(10)
  85 #define BT1_CCU_PCIE_L1_PENDING                 BIT(12)
  86 #define BT1_CCU_PCIE_REQ_EXIT_L1                BIT(14)
  87 #define BT1_CCU_PCIE_LTSSM_RCVR_EQ              BIT(15)
  88 #define BT1_CCU_PCIE_PM_DSTAT_MASK              GENMASK(18, 16)
  89 #define BT1_CCU_PCIE_PM_PME_EN                  BIT(20)
  90 #define BT1_CCU_PCIE_PM_PME_STATUS              BIT(21)
  91 #define BT1_CCU_PCIE_AUX_PM_EN                  BIT(22)
  92 #define BT1_CCU_PCIE_AUX_PWR_DET                BIT(23)
  93 #define BT1_CCU_PCIE_WAKE_DET                   BIT(24)
  94 #define BT1_CCU_PCIE_TURNOFF_REQ                BIT(30)
  95 #define BT1_CCU_PCIE_TURNOFF_ACK                BIT(31)
  96
  97 #define BT1_CCU_PCIE_GENC                       0x14c
  98 #define BT1_CCU_PCIE_LTSSM_EN                   BIT(1)
  99 #define BT1_CCU_PCIE_DBI2_MODE                  BIT(2)
 100 #define BT1_CCU_PCIE_MGMT_EN                    BIT(3)
 101 #define BT1_CCU_PCIE_RXLANE_FLIP_EN             BIT(16)
 102 #define BT1_CCU_PCIE_TXLANE_FLIP_EN             BIT(17)
 103 #define BT1_CCU_PCIE_SLV_XFER_PEND              BIT(24)
 104 #define BT1_CCU_PCIE_RCV_XFER_PEND              BIT(25)
 105 #define BT1_CCU_PCIE_DBI_XFER_PEND              BIT(26)
 106 #define BT1_CCU_PCIE_DMA_XFER_PEND              BIT(27)
 107
 108 #define BT1_CCU_PCIE_LTSSM_LINKUP(_pmsc) \
 109 ({ \
 110         int __state = FIELD_GET(BT1_CCU_PCIE_LTSSM_STATE_MASK, _pmsc); \
 111         __state >= BT1_CCU_PCIE_LTSSM_L0 && __state <= BT1_CCU_PCIE_LTSSM_L2_WAKE; \
 112 })
 113
 114 /* Baikal-T1 PCIe specific control registers */
 115 #define BT1_PCIE_AXI2MGM_LANENUM                0xd04
 116 #define BT1_PCIE_AXI2MGM_LANESEL_MASK           GENMASK(3, 0)
 117
 118 #define BT1_PCIE_AXI2MGM_ADDRCTL                0xd08
 119 #define BT1_PCIE_AXI2MGM_PHYREG_ADDR_MASK       GENMASK(20, 0)
 120 #define BT1_PCIE_AXI2MGM_READ_FLAG              BIT(29)
 121 #define BT1_PCIE_AXI2MGM_DONE                   BIT(30)
 122 #define BT1_PCIE_AXI2MGM_BUSY                   BIT(31)
 123
 124 #define BT1_PCIE_AXI2MGM_WRITEDATA              0xd0c
 125 #define BT1_PCIE_AXI2MGM_WDATA                  GENMASK(15, 0)
 126
 127 #define BT1_PCIE_AXI2MGM_READDATA               0xd10
 128 #define BT1_PCIE_AXI2MGM_RDATA                  GENMASK(15, 0)
 129
 130 /* Generic Baikal-T1 PCIe interface resources */
 131 #define BT1_PCIE_NUM_APP_CLKS                   ARRAY_SIZE(bt1_pcie_app_clks)
 132 #define BT1_PCIE_NUM_CORE_CLKS                  ARRAY_SIZE(bt1_pcie_core_clks)
 133 #define BT1_PCIE_NUM_APP_RSTS                   ARRAY_SIZE(bt1_pcie_app_rsts)
 134 #define BT1_PCIE_NUM_CORE_RSTS                  ARRAY_SIZE(bt1_pcie_core_rsts)
 135
 136 /* PCIe bus setup delays and timeouts */
 137 #define BT1_PCIE_RST_DELAY_MS                   100
 138 #define BT1_PCIE_RUN_DELAY_US                   100
 139 #define BT1_PCIE_REQ_DELAY_US                   1
 140 #define BT1_PCIE_REQ_TIMEOUT_US                 1000
 141 #define BT1_PCIE_LNK_DELAY_US                   1000
 142 #define BT1_PCIE_LNK_TIMEOUT_US                 1000000
 143
 144 static const enum dw_pcie_app_clk bt1_pcie_app_clks[] = {
 145         DW_PCIE_DBI_CLK, DW_PCIE_MSTR_CLK, DW_PCIE_SLV_CLK,
 146 };
 147
 148 static const enum dw_pcie_core_clk bt1_pcie_core_clks[] = {
 149         DW_PCIE_REF_CLK,
 150 };
 151
 152 static const enum dw_pcie_app_rst bt1_pcie_app_rsts[] = {
 153         DW_PCIE_MSTR_RST, DW_PCIE_SLV_RST,
 154 };
 155
 156 static const enum dw_pcie_core_rst bt1_pcie_core_rsts[] = {
 157         DW_PCIE_NON_STICKY_RST, DW_PCIE_STICKY_RST, DW_PCIE_CORE_RST,
 158         DW_PCIE_PIPE_RST, DW_PCIE_PHY_RST, DW_PCIE_HOT_RST, DW_PCIE_PWR_RST,
 159 };
 160
 161 struct bt1_pcie {
 162         struct dw_pcie dw;
 163         struct platform_device *pdev;
 164         struct regmap *sys_regs;
 165 };
 166 #define to_bt1_pcie(_dw) container_of(_dw, struct bt1_pcie, dw)
 167
 168 /*
 169  * Baikal-T1 MMIO space must be read/written by the dword-aligned
 170  * instructions. Note the methods are optimized to have the dword operations
 171  * performed with minimum overhead as the most frequently used ones.
 172  */
 173 static int bt1_pcie_read_mmio(void __iomem *addr, int size, u32 *val)
 174 {
 175         unsigned int ofs = (uintptr_t)addr & 0x3;
 176
 177         if (!IS_ALIGNED((uintptr_t)addr, size))
 178                 return -EINVAL;
 179
 180         *val = readl(addr - ofs) >> ofs * BITS_PER_BYTE;
 181         if (size == 4) {
 182                 return 0;
 183         } else if (size == 2) {
 184                 *val &= 0xffff;
 185                 return 0;
 186         } else if (size == 1) {
 187                 *val &= 0xff;
 188                 return 0;
 189         }
 190
 191         return -EINVAL;
 192 }
 193
 194 static int bt1_pcie_write_mmio(void __iomem *addr, int size, u32 val)
 195 {
 196         unsigned int ofs = (uintptr_t)addr & 0x3;
 197         u32 tmp, mask;
 198
 199         if (!IS_ALIGNED((uintptr_t)addr, size))
 200                 return -EINVAL;
 201
 202         if (size == 4) {
 203                 writel(val, addr);
 204                 return 0;
 205         } else if (size == 2 || size == 1) {
 206                 mask = GENMASK(size * BITS_PER_BYTE - 1, 0);
 207                 tmp = readl(addr - ofs) & ~(mask << ofs * BITS_PER_BYTE);
 208                 tmp |= (val & mask) << ofs * BITS_PER_BYTE;
 209                 writel(tmp, addr - ofs);
 210                 return 0;
 211         }
 212
 213         return -EINVAL;
 214 }
 215
 216 static u32 bt1_pcie_read_dbi(struct dw_pcie *pci, void __iomem *base, u32 reg,
 217                              size_t size)
 218 {
 219         int ret;
 220         u32 val;
 221
 222         ret = bt1_pcie_read_mmio(base + reg, size, &val);
 223         if (ret) {
 224                 dev_err(pci->dev, "Read DBI address failed\n");
 225                 return ~0U;
 226         }
 227
 228         return val;
 229 }
 230
 231 static void bt1_pcie_write_dbi(struct dw_pcie *pci, void __iomem *base, u32 reg,
 232                                size_t size, u32 val)
 233 {
 234         int ret;
 235
 236         ret = bt1_pcie_write_mmio(base + reg, size, val);
 237         if (ret)
 238                 dev_err(pci->dev, "Write DBI address failed\n");
 239 }
 240
 241 static void bt1_pcie_write_dbi2(struct dw_pcie *pci, void __iomem *base, u32 reg,
 242                                 size_t size, u32 val)
 243 {
 244         struct bt1_pcie *btpci = to_bt1_pcie(pci);
 245         int ret;
 246
 247         regmap_update_bits(btpci->sys_regs, BT1_CCU_PCIE_GENC,
 248                            BT1_CCU_PCIE_DBI2_MODE, BT1_CCU_PCIE_DBI2_MODE);
 249
 250         ret = bt1_pcie_write_mmio(base + reg, size, val);
 251         if (ret)
 252                 dev_err(pci->dev, "Write DBI2 address failed\n");
 253
 254         regmap_update_bits(btpci->sys_regs, BT1_CCU_PCIE_GENC,
 255                            BT1_CCU_PCIE_DBI2_MODE, 0);
 256 }
 257
 258 static int bt1_pcie_start_link(struct dw_pcie *pci)
 259 {
 260         struct bt1_pcie *btpci = to_bt1_pcie(pci);
 261         u32 val;
 262         int ret;
 263
 264         /*
 265          * Enable LTSSM and make sure it was able to establish both PHY and
 266          * data links. This procedure shall work fine to reach 2.5 GT/s speed.
 267          */
 268         regmap_update_bits(btpci->sys_regs, BT1_CCU_PCIE_GENC,
 269                            BT1_CCU_PCIE_LTSSM_EN, BT1_CCU_PCIE_LTSSM_EN);
 270
 271         ret = regmap_read_poll_timeout(btpci->sys_regs, BT1_CCU_PCIE_PMSC, val,
 272                                        (val & BT1_CCU_PCIE_SMLH_LINKUP),
 273                                        BT1_PCIE_LNK_DELAY_US, BT1_PCIE_LNK_TIMEOUT_US);
 274         if (ret) {
 275                 dev_err(pci->dev, "LTSSM failed to set PHY link up\n");
 276                 return ret;
 277         }
 278
 279         ret = regmap_read_poll_timeout(btpci->sys_regs, BT1_CCU_PCIE_PMSC, val,
 280                                        (val & BT1_CCU_PCIE_RDLH_LINKUP),
 281                                        BT1_PCIE_LNK_DELAY_US, BT1_PCIE_LNK_TIMEOUT_US);
 282         if (ret) {
 283                 dev_err(pci->dev, "LTSSM failed to set data link up\n");
 284                 return ret;
 285         }
 286
 287         /*
 288          * Activate direct speed change after the link is established in an
 289          * attempt to reach a higher bus performance (up to Gen.3 - 8.0 GT/s).
 290          * This is required at least to get 8.0 GT/s speed.
 291          */
 292         val = dw_pcie_readl_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL);
 293         val |= PORT_LOGIC_SPEED_CHANGE;
 294         dw_pcie_writel_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL, val);
 295
 296         ret = regmap_read_poll_timeout(btpci->sys_regs, BT1_CCU_PCIE_PMSC, val,
 297                                        BT1_CCU_PCIE_LTSSM_LINKUP(val),
 298                                        BT1_PCIE_LNK_DELAY_US, BT1_PCIE_LNK_TIMEOUT_US);
 299         if (ret)
 300                 dev_err(pci->dev, "LTSSM failed to get into L0 state\n");
 301
 302         return ret;
 303 }
 304
 305 static void bt1_pcie_stop_link(struct dw_pcie *pci)
 306 {
 307         struct bt1_pcie *btpci = to_bt1_pcie(pci);
 308
 309         regmap_update_bits(btpci->sys_regs, BT1_CCU_PCIE_GENC,
 310                            BT1_CCU_PCIE_LTSSM_EN, 0);
 311 }
 312
 313 static const struct dw_pcie_ops bt1_pcie_ops = {
 314         .read_dbi = bt1_pcie_read_dbi,
 315         .write_dbi = bt1_pcie_write_dbi,
 316         .write_dbi2 = bt1_pcie_write_dbi2,
 317         .start_link = bt1_pcie_start_link,
 318         .stop_link = bt1_pcie_stop_link,
 319 };
 320
 321 static struct pci_ops bt1_pci_ops = {
 322         .map_bus = dw_pcie_own_conf_map_bus,
 323         .read = pci_generic_config_read32,
 324         .write = pci_generic_config_write32,
 325 };
 326
 327 static int bt1_pcie_get_resources(struct bt1_pcie *btpci)
 328 {
 329         struct device *dev = btpci->dw.dev;
 330         int i;
 331
 332         /* DBI access is supposed to be performed by the dword-aligned IOs */
 333         btpci->dw.pp.bridge->ops = &bt1_pci_ops;
 334
 335         /* These CSRs are in MMIO so we won't check the regmap-methods status */
 336         btpci->sys_regs =
 337                 syscon_regmap_lookup_by_phandle(dev->of_node, "baikal,bt1-syscon");
 338         if (IS_ERR(btpci->sys_regs))
 339                 return dev_err_probe(dev, PTR_ERR(btpci->sys_regs),
 340                                      "Failed to get syscon\n");
 341
 342         /* Make sure all the required resources have been specified */
 343         for (i = 0; i < BT1_PCIE_NUM_APP_CLKS; i++) {
 344                 if (!btpci->dw.app_clks[bt1_pcie_app_clks[i]].clk) {
 345                         dev_err(dev, "App clocks set is incomplete\n");
 346                         return -ENOENT;
 347                 }
 348         }
 349
 350         for (i = 0; i < BT1_PCIE_NUM_CORE_CLKS; i++) {
 351                 if (!btpci->dw.core_clks[bt1_pcie_core_clks[i]].clk) {
 352                         dev_err(dev, "Core clocks set is incomplete\n");
 353                         return -ENOENT;
 354                 }
 355         }
 356
 357         for (i = 0; i < BT1_PCIE_NUM_APP_RSTS; i++) {
 358                 if (!btpci->dw.app_rsts[bt1_pcie_app_rsts[i]].rstc) {
 359                         dev_err(dev, "App resets set is incomplete\n");
 360                         return -ENOENT;
 361                 }
 362         }
 363
 364         for (i = 0; i < BT1_PCIE_NUM_CORE_RSTS; i++) {
 365                 if (!btpci->dw.core_rsts[bt1_pcie_core_rsts[i]].rstc) {
 366                         dev_err(dev, "Core resets set is incomplete\n");
 367                         return -ENOENT;
 368                 }
 369         }
 370
 371         return 0;
 372 }
 373
 374 static void bt1_pcie_full_stop_bus(struct bt1_pcie *btpci, bool init)
 375 {
 376         struct device *dev = btpci->dw.dev;
 377         struct dw_pcie *pci = &btpci->dw;
 378         int ret;
 379
 380         /* Disable LTSSM for sure */
 381         regmap_update_bits(btpci->sys_regs, BT1_CCU_PCIE_GENC,
 382                            BT1_CCU_PCIE_LTSSM_EN, 0);
 383
 384         /*
 385          * Application reset controls are trigger-based so assert the core
 386          * resets only.
 387          */
 388         ret = reset_control_bulk_assert(DW_PCIE_NUM_CORE_RSTS, pci->core_rsts);
 389         if (ret)
 390                 dev_err(dev, "Failed to assert core resets\n");
 391
 392         /*
 393          * Clocks are disabled by default at least in accordance with the clk
 394          * enable counter value on init stage.
 395          */
 396         if (!init) {
 397                 clk_bulk_disable_unprepare(DW_PCIE_NUM_CORE_CLKS, pci->core_clks);
 398
 399                 clk_bulk_disable_unprepare(DW_PCIE_NUM_APP_CLKS, pci->app_clks);
 400         }
 401
 402         /* The peripheral devices are unavailable anyway so reset them too */
 403         gpiod_set_value_cansleep(pci->pe_rst, 1);
 404
 405         /* Make sure all the resets are settled */
 406         msleep(BT1_PCIE_RST_DELAY_MS);
 407 }
 408
 409 /*
 410  * Implements the cold reset procedure in accordance with the reference manual
 411  * and available PM signals.
 412  */
 413 static int bt1_pcie_cold_start_bus(struct bt1_pcie *btpci)
 414 {
 415         struct device *dev = btpci->dw.dev;
 416         struct dw_pcie *pci = &btpci->dw;
 417         u32 val;
 418         int ret;
 419
 420         /* First get out of the Power/Hot reset state */
 421         ret = reset_control_deassert(pci->core_rsts[DW_PCIE_PWR_RST].rstc);
 422         if (ret) {
 423                 dev_err(dev, "Failed to deassert PHY reset\n");
 424                 return ret;
 425         }
 426
 427         ret = reset_control_deassert(pci->core_rsts[DW_PCIE_HOT_RST].rstc);
 428         if (ret) {
 429                 dev_err(dev, "Failed to deassert hot reset\n");
 430                 goto err_assert_pwr_rst;
 431         }
 432
 433         /* Wait for the PM-core to stop requesting the PHY reset */
 434         ret = regmap_read_poll_timeout(btpci->sys_regs, BT1_CCU_PCIE_RSTC, val,
 435                                        !(val & BT1_CCU_PCIE_REQ_PHY_RST),
 436                                        BT1_PCIE_REQ_DELAY_US, BT1_PCIE_REQ_TIMEOUT_US);
 437         if (ret) {
 438                 dev_err(dev, "Timed out waiting for PM to stop PHY resetting\n");
 439                 goto err_assert_hot_rst;
 440         }
 441
 442         ret = reset_control_deassert(pci->core_rsts[DW_PCIE_PHY_RST].rstc);
 443         if (ret) {
 444                 dev_err(dev, "Failed to deassert PHY reset\n");
 445                 goto err_assert_hot_rst;
 446         }
 447
 448         /* Clocks can be now enabled, but the ref one is crucial at this stage */
 449         ret = clk_bulk_prepare_enable(DW_PCIE_NUM_APP_CLKS, pci->app_clks);
 450         if (ret) {
 451                 dev_err(dev, "Failed to enable app clocks\n");
 452                 goto err_assert_phy_rst;
 453         }
 454
 455         ret = clk_bulk_prepare_enable(DW_PCIE_NUM_CORE_CLKS, pci->core_clks);
 456         if (ret) {
 457                 dev_err(dev, "Failed to enable ref clocks\n");
 458                 goto err_disable_app_clk;
 459         }
 460
 461         /* Wait for the PM to stop requesting the controller core reset */
 462         ret = regmap_read_poll_timeout(btpci->sys_regs, BT1_CCU_PCIE_RSTC, val,
 463                                        !(val & BT1_CCU_PCIE_REQ_CORE_RST),
 464                                        BT1_PCIE_REQ_DELAY_US, BT1_PCIE_REQ_TIMEOUT_US);
 465         if (ret) {
 466                 dev_err(dev, "Timed out waiting for PM to stop core resetting\n");
 467                 goto err_disable_core_clk;
 468         }
 469
 470         /* PCS-PIPE interface and controller core can be now activated */
 471         ret = reset_control_deassert(pci->core_rsts[DW_PCIE_PIPE_RST].rstc);
 472         if (ret) {
 473                 dev_err(dev, "Failed to deassert PIPE reset\n");
 474                 goto err_disable_core_clk;
 475         }
 476
 477         ret = reset_control_deassert(pci->core_rsts[DW_PCIE_CORE_RST].rstc);
 478         if (ret) {
 479                 dev_err(dev, "Failed to deassert core reset\n");
 480                 goto err_assert_pipe_rst;
 481         }
 482
 483         /* It's recommended to reset the core and application logic together */
 484         ret = reset_control_bulk_reset(DW_PCIE_NUM_APP_RSTS, pci->app_rsts);
 485         if (ret) {
 486                 dev_err(dev, "Failed to reset app domain\n");
 487                 goto err_assert_core_rst;
 488         }
 489
 490         /* Sticky/Non-sticky CSR flags can be now unreset too */
 491         ret = reset_control_deassert(pci->core_rsts[DW_PCIE_STICKY_RST].rstc);
 492         if (ret) {
 493                 dev_err(dev, "Failed to deassert sticky reset\n");
 494                 goto err_assert_core_rst;
 495         }
 496
 497         ret = reset_control_deassert(pci->core_rsts[DW_PCIE_NON_STICKY_RST].rstc);
 498         if (ret) {
 499                 dev_err(dev, "Failed to deassert non-sticky reset\n");
 500                 goto err_assert_sticky_rst;
 501         }
 502
 503         /* Activate the PCIe bus peripheral devices */
 504         gpiod_set_value_cansleep(pci->pe_rst, 0);
 505
 506         /* Make sure the state is settled (LTSSM is still disabled though) */
 507         usleep_range(BT1_PCIE_RUN_DELAY_US, BT1_PCIE_RUN_DELAY_US + 100);
 508
 509         return 0;
 510
 511 err_assert_sticky_rst:
 512         reset_control_assert(pci->core_rsts[DW_PCIE_STICKY_RST].rstc);
 513
 514 err_assert_core_rst:
 515         reset_control_assert(pci->core_rsts[DW_PCIE_CORE_RST].rstc);
 516
 517 err_assert_pipe_rst:
 518         reset_control_assert(pci->core_rsts[DW_PCIE_PIPE_RST].rstc);
 519
 520 err_disable_core_clk:
 521         clk_bulk_disable_unprepare(DW_PCIE_NUM_CORE_CLKS, pci->core_clks);
 522
 523 err_disable_app_clk:
 524         clk_bulk_disable_unprepare(DW_PCIE_NUM_APP_CLKS, pci->app_clks);
 525
 526 err_assert_phy_rst:
 527         reset_control_assert(pci->core_rsts[DW_PCIE_PHY_RST].rstc);
 528
 529 err_assert_hot_rst:
 530         reset_control_assert(pci->core_rsts[DW_PCIE_HOT_RST].rstc);
 531
 532 err_assert_pwr_rst:
 533         reset_control_assert(pci->core_rsts[DW_PCIE_PWR_RST].rstc);
 534
 535         return ret;
 536 }
 537
 538 static int bt1_pcie_host_init(struct dw_pcie_rp *pp)
 539 {
 540         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 541         struct bt1_pcie *btpci = to_bt1_pcie(pci);
 542         int ret;
 543
 544         ret = bt1_pcie_get_resources(btpci);
 545         if (ret)
 546                 return ret;
 547
 548         bt1_pcie_full_stop_bus(btpci, true);
 549
 550         return bt1_pcie_cold_start_bus(btpci);
 551 }
 552
 553 static void bt1_pcie_host_deinit(struct dw_pcie_rp *pp)
 554 {
 555         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 556         struct bt1_pcie *btpci = to_bt1_pcie(pci);
 557
 558         bt1_pcie_full_stop_bus(btpci, false);
 559 }
 560
 561 static const struct dw_pcie_host_ops bt1_pcie_host_ops = {
 562         .host_init = bt1_pcie_host_init,
 563         .host_deinit = bt1_pcie_host_deinit,
 564 };
 565
 566 static struct bt1_pcie *bt1_pcie_create_data(struct platform_device *pdev)
 567 {
 568         struct bt1_pcie *btpci;
 569
 570         btpci = devm_kzalloc(&pdev->dev, sizeof(*btpci), GFP_KERNEL);
 571         if (!btpci)
 572                 return ERR_PTR(-ENOMEM);
 573
 574         btpci->pdev = pdev;
 575
 576         platform_set_drvdata(pdev, btpci);
 577
 578         return btpci;
 579 }
 580
 581 static int bt1_pcie_add_port(struct bt1_pcie *btpci)
 582 {
 583         struct device *dev = &btpci->pdev->dev;
 584         int ret;
 585
 586         ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(64));
 587         if (ret)
 588                 return ret;
 589
 590         btpci->dw.version = DW_PCIE_VER_460A;
 591         btpci->dw.dev = dev;
 592         btpci->dw.ops = &bt1_pcie_ops;
 593
 594         btpci->dw.pp.num_vectors = MAX_MSI_IRQS;
 595         btpci->dw.pp.ops = &bt1_pcie_host_ops;
 596
 597         dw_pcie_cap_set(&btpci->dw, REQ_RES);
 598
 599         ret = dw_pcie_host_init(&btpci->dw.pp);
 600
 601         return dev_err_probe(dev, ret, "Failed to initialize DWC PCIe host\n");
 602 }
 603
 604 static void bt1_pcie_del_port(struct bt1_pcie *btpci)
 605 {
 606         dw_pcie_host_deinit(&btpci->dw.pp);
 607 }
 608
 609 static int bt1_pcie_probe(struct platform_device *pdev)
 610 {
 611         struct bt1_pcie *btpci;
 612
 613         btpci = bt1_pcie_create_data(pdev);
 614         if (IS_ERR(btpci))
 615                 return PTR_ERR(btpci);
 616
 617         return bt1_pcie_add_port(btpci);
 618 }
 619
 620 static void bt1_pcie_remove(struct platform_device *pdev)
 621 {
 622         struct bt1_pcie *btpci = platform_get_drvdata(pdev);
 623
 624         bt1_pcie_del_port(btpci);
 625 }
 626
 627 static const struct of_device_id bt1_pcie_of_match[] = {
 628         { .compatible = "baikal,bt1-pcie" },
 629         {},
 630 };
 631 MODULE_DEVICE_TABLE(of, bt1_pcie_of_match);
 632
 633 static struct platform_driver bt1_pcie_driver = {
 634         .probe = bt1_pcie_probe,
 635         .remove_new = bt1_pcie_remove,
 636         .driver = {
 637                 .name   = "bt1-pcie",
 638                 .of_match_table = bt1_pcie_of_match,
 639         },
 640 };
 641 module_platform_driver(bt1_pcie_driver);
 642
 643 MODULE_AUTHOR("Serge Semin <Sergey.Semin@baikalelectronics.ru>");
 644 MODULE_DESCRIPTION("Baikal-T1 PCIe driver");
 645 MODULE_LICENSE("GPL");