drivers/soc/imx/gpcv2.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright 2017 Impinj, Inc
   4  * Author: Andrey Smirnov <[email protected]>
   5  *
   6  * Based on the code of analogus driver:
   7  *
   8  * Copyright 2015-2017 Pengutronix, Lucas Stach <[email protected]>
   9  */
  10
  11 #include <linux/clk.h>
  12 #include <linux/of_device.h>
  13 #include <linux/platform_device.h>
  14 #include <linux/pm_domain.h>
  15 #include <linux/regmap.h>
  16 #include <linux/regulator/consumer.h>
  17 #include <linux/sizes.h>
  18 #include <dt-bindings/power/imx7-power.h>
  19 #include <dt-bindings/power/imx8mq-power.h>
  20
  21 #define GPC_LPCR_A_CORE_BSC                     0x000
  22
  23 #define GPC_PGC_CPU_MAPPING             0x0ec
  24
  25 #define IMX7_USB_HSIC_PHY_A_CORE_DOMAIN         BIT(6)
  26 #define IMX7_USB_OTG2_PHY_A_CORE_DOMAIN         BIT(5)
  27 #define IMX7_USB_OTG1_PHY_A_CORE_DOMAIN         BIT(4)
  28 #define IMX7_PCIE_PHY_A_CORE_DOMAIN             BIT(3)
  29 #define IMX7_MIPI_PHY_A_CORE_DOMAIN             BIT(2)
  30
  31 #define IMX8M_PCIE2_A53_DOMAIN                  BIT(15)
  32 #define IMX8M_MIPI_CSI2_A53_DOMAIN              BIT(14)
  33 #define IMX8M_MIPI_CSI1_A53_DOMAIN              BIT(13)
  34 #define IMX8M_DISP_A53_DOMAIN                   BIT(12)
  35 #define IMX8M_HDMI_A53_DOMAIN                   BIT(11)
  36 #define IMX8M_VPU_A53_DOMAIN                    BIT(10)
  37 #define IMX8M_GPU_A53_DOMAIN                    BIT(9)
  38 #define IMX8M_DDR2_A53_DOMAIN                   BIT(8)
  39 #define IMX8M_DDR1_A53_DOMAIN                   BIT(7)
  40 #define IMX8M_OTG2_A53_DOMAIN                   BIT(5)
  41 #define IMX8M_OTG1_A53_DOMAIN                   BIT(4)
  42 #define IMX8M_PCIE1_A53_DOMAIN                  BIT(3)
  43 #define IMX8M_MIPI_A53_DOMAIN                   BIT(2)
  44
  45 #define GPC_PU_PGC_SW_PUP_REQ           0x0f8
  46 #define GPC_PU_PGC_SW_PDN_REQ           0x104
  47
  48 #define IMX7_USB_HSIC_PHY_SW_Pxx_REQ            BIT(4)
  49 #define IMX7_USB_OTG2_PHY_SW_Pxx_REQ            BIT(3)
  50 #define IMX7_USB_OTG1_PHY_SW_Pxx_REQ            BIT(2)
  51 #define IMX7_PCIE_PHY_SW_Pxx_REQ                BIT(1)
  52 #define IMX7_MIPI_PHY_SW_Pxx_REQ                BIT(0)
  53
  54 #define IMX8M_PCIE2_SW_Pxx_REQ                  BIT(13)
  55 #define IMX8M_MIPI_CSI2_SW_Pxx_REQ              BIT(12)
  56 #define IMX8M_MIPI_CSI1_SW_Pxx_REQ              BIT(11)
  57 #define IMX8M_DISP_SW_Pxx_REQ                   BIT(10)
  58 #define IMX8M_HDMI_SW_Pxx_REQ                   BIT(9)
  59 #define IMX8M_VPU_SW_Pxx_REQ                    BIT(8)
  60 #define IMX8M_GPU_SW_Pxx_REQ                    BIT(7)
  61 #define IMX8M_DDR2_SW_Pxx_REQ                   BIT(6)
  62 #define IMX8M_DDR1_SW_Pxx_REQ                   BIT(5)
  63 #define IMX8M_OTG2_SW_Pxx_REQ                   BIT(3)
  64 #define IMX8M_OTG1_SW_Pxx_REQ                   BIT(2)
  65 #define IMX8M_PCIE1_SW_Pxx_REQ                  BIT(1)
  66 #define IMX8M_MIPI_SW_Pxx_REQ                   BIT(0)
  67
  68 #define GPC_M4_PU_PDN_FLG               0x1bc
  69
  70 #define GPC_PU_PWRHSK                   0x1fc
  71
  72 #define IMX8M_GPU_HSK_PWRDNREQN                 BIT(6)
  73 #define IMX8M_VPU_HSK_PWRDNREQN                 BIT(5)
  74 #define IMX8M_DISP_HSK_PWRDNREQN                BIT(4)
  75
  76 /*
  77  * The PGC offset values in Reference Manual
  78  * (Rev. 1, 01/2018 and the older ones) GPC chapter's
  79  * GPC_PGC memory map are incorrect, below offset
  80  * values are from design RTL.
  81  */
  82 #define IMX7_PGC_MIPI                   16
  83 #define IMX7_PGC_PCIE                   17
  84 #define IMX7_PGC_USB_HSIC               20
  85
  86 #define IMX8M_PGC_MIPI                  16
  87 #define IMX8M_PGC_PCIE1                 17
  88 #define IMX8M_PGC_OTG1                  18
  89 #define IMX8M_PGC_OTG2                  19
  90 #define IMX8M_PGC_DDR1                  21
  91 #define IMX8M_PGC_GPU                   23
  92 #define IMX8M_PGC_VPU                   24
  93 #define IMX8M_PGC_DISP                  26
  94 #define IMX8M_PGC_MIPI_CSI1             27
  95 #define IMX8M_PGC_MIPI_CSI2             28
  96 #define IMX8M_PGC_PCIE2                 29
  97
  98 #define GPC_PGC_CTRL(n)                 (0x800 + (n) * 0x40)
  99 #define GPC_PGC_SR(n)                   (GPC_PGC_CTRL(n) + 0xc)
 100
 101 #define GPC_PGC_CTRL_PCR                BIT(0)
 102
 103 #define GPC_CLK_MAX             6
 104
 105 struct imx_pgc_domain {
 106         struct generic_pm_domain genpd;
 107         struct regmap *regmap;
 108         struct regulator *regulator;
 109         struct clk *clk[GPC_CLK_MAX];
 110         int num_clks;
 111
 112         unsigned int pgc;
 113
 114         const struct {
 115                 u32 pxx;
 116                 u32 map;
 117                 u32 hsk;
 118         } bits;
 119
 120         const int voltage;
 121         struct device *dev;
 122 };
 123
 124 struct imx_pgc_domain_data {
 125         const struct imx_pgc_domain *domains;
 126         size_t domains_num;
 127         const struct regmap_access_table *reg_access_table;
 128 };
 129
 130 static int imx_gpc_pu_pgc_sw_pxx_req(struct generic_pm_domain *genpd,
 131                                       bool on)
 132 {
 133         struct imx_pgc_domain *domain = container_of(genpd,
 134                                                       struct imx_pgc_domain,
 135                                                       genpd);
 136         unsigned int offset = on ?
 137                 GPC_PU_PGC_SW_PUP_REQ : GPC_PU_PGC_SW_PDN_REQ;
 138         const bool enable_power_control = !on;
 139         const bool has_regulator = !IS_ERR(domain->regulator);
 140         int i, ret = 0;
 141         u32 pxx_req;
 142
 143         regmap_update_bits(domain->regmap, GPC_PGC_CPU_MAPPING,
 144                            domain->bits.map, domain->bits.map);
 145
 146         if (has_regulator && on) {
 147                 ret = regulator_enable(domain->regulator);
 148                 if (ret) {
 149                         dev_err(domain->dev, "failed to enable regulator\n");
 150                         goto unmap;
 151                 }
 152         }
 153
 154         /* Enable reset clocks for all devices in the domain */
 155         for (i = 0; i < domain->num_clks; i++)
 156                 clk_prepare_enable(domain->clk[i]);
 157
 158         if (enable_power_control)
 159                 regmap_update_bits(domain->regmap, GPC_PGC_CTRL(domain->pgc),
 160                                    GPC_PGC_CTRL_PCR, GPC_PGC_CTRL_PCR);
 161
 162         if (domain->bits.hsk)
 163                 regmap_update_bits(domain->regmap, GPC_PU_PWRHSK,
 164                                    domain->bits.hsk, on ? domain->bits.hsk : 0);
 165
 166         regmap_update_bits(domain->regmap, offset,
 167                            domain->bits.pxx, domain->bits.pxx);
 168
 169         /*
 170          * As per "5.5.9.4 Example Code 4" in IMX7DRM.pdf wait
 171          * for PUP_REQ/PDN_REQ bit to be cleared
 172          */
 173         ret = regmap_read_poll_timeout(domain->regmap, offset, pxx_req,
 174                                        !(pxx_req & domain->bits.pxx),
 175                                        0, USEC_PER_MSEC);
 176         if (ret) {
 177                 dev_err(domain->dev, "failed to command PGC\n");
 178                 /*
 179                  * If we were in a process of enabling a
 180                  * domain and failed we might as well disable
 181                  * the regulator we just enabled. And if it
 182                  * was the opposite situation and we failed to
 183                  * power down -- keep the regulator on
 184                  */
 185                 on = !on;
 186         }
 187
 188         if (enable_power_control)
 189                 regmap_update_bits(domain->regmap, GPC_PGC_CTRL(domain->pgc),
 190                                    GPC_PGC_CTRL_PCR, 0);
 191
 192         /* Disable reset clocks for all devices in the domain */
 193         for (i = 0; i < domain->num_clks; i++)
 194                 clk_disable_unprepare(domain->clk[i]);
 195
 196         if (has_regulator && !on) {
 197                 int err;
 198
 199                 err = regulator_disable(domain->regulator);
 200                 if (err)
 201                         dev_err(domain->dev,
 202                                 "failed to disable regulator: %d\n", err);
 203                 /* Preserve earlier error code */
 204                 ret = ret ?: err;
 205         }
 206 unmap:
 207         regmap_update_bits(domain->regmap, GPC_PGC_CPU_MAPPING,
 208                            domain->bits.map, 0);
 209         return ret;
 210 }
 211
 212 static int imx_gpc_pu_pgc_sw_pup_req(struct generic_pm_domain *genpd)
 213 {
 214         return imx_gpc_pu_pgc_sw_pxx_req(genpd, true);
 215 }
 216
 217 static int imx_gpc_pu_pgc_sw_pdn_req(struct generic_pm_domain *genpd)
 218 {
 219         return imx_gpc_pu_pgc_sw_pxx_req(genpd, false);
 220 }
 221
 222 static const struct imx_pgc_domain imx7_pgc_domains[] = {
 223         [IMX7_POWER_DOMAIN_MIPI_PHY] = {
 224                 .genpd = {
 225                         .name      = "mipi-phy",
 226                 },
 227                 .bits  = {
 228                         .pxx = IMX7_MIPI_PHY_SW_Pxx_REQ,
 229                         .map = IMX7_MIPI_PHY_A_CORE_DOMAIN,
 230                 },
 231                 .voltage   = 1000000,
 232                 .pgc       = IMX7_PGC_MIPI,
 233         },
 234
 235         [IMX7_POWER_DOMAIN_PCIE_PHY] = {
 236                 .genpd = {
 237                         .name      = "pcie-phy",
 238                 },
 239                 .bits  = {
 240                         .pxx = IMX7_PCIE_PHY_SW_Pxx_REQ,
 241                         .map = IMX7_PCIE_PHY_A_CORE_DOMAIN,
 242                 },
 243                 .voltage   = 1000000,
 244                 .pgc       = IMX7_PGC_PCIE,
 245         },
 246
 247         [IMX7_POWER_DOMAIN_USB_HSIC_PHY] = {
 248                 .genpd = {
 249                         .name      = "usb-hsic-phy",
 250                 },
 251                 .bits  = {
 252                         .pxx = IMX7_USB_HSIC_PHY_SW_Pxx_REQ,
 253                         .map = IMX7_USB_HSIC_PHY_A_CORE_DOMAIN,
 254                 },
 255                 .voltage   = 1200000,
 256                 .pgc       = IMX7_PGC_USB_HSIC,
 257         },
 258 };
 259
 260 static const struct regmap_range imx7_yes_ranges[] = {
 261                 regmap_reg_range(GPC_LPCR_A_CORE_BSC,
 262                                  GPC_M4_PU_PDN_FLG),
 263                 regmap_reg_range(GPC_PGC_CTRL(IMX7_PGC_MIPI),
 264                                  GPC_PGC_SR(IMX7_PGC_MIPI)),
 265                 regmap_reg_range(GPC_PGC_CTRL(IMX7_PGC_PCIE),
 266                                  GPC_PGC_SR(IMX7_PGC_PCIE)),
 267                 regmap_reg_range(GPC_PGC_CTRL(IMX7_PGC_USB_HSIC),
 268                                  GPC_PGC_SR(IMX7_PGC_USB_HSIC)),
 269 };
 270
 271 static const struct regmap_access_table imx7_access_table = {
 272         .yes_ranges     = imx7_yes_ranges,
 273         .n_yes_ranges   = ARRAY_SIZE(imx7_yes_ranges),
 274 };
 275
 276 static const struct imx_pgc_domain_data imx7_pgc_domain_data = {
 277         .domains = imx7_pgc_domains,
 278         .domains_num = ARRAY_SIZE(imx7_pgc_domains),
 279         .reg_access_table = &imx7_access_table,
 280 };
 281
 282 static const struct imx_pgc_domain imx8m_pgc_domains[] = {
 283         [IMX8M_POWER_DOMAIN_MIPI] = {
 284                 .genpd = {
 285                         .name      = "mipi",
 286                 },
 287                 .bits  = {
 288                         .pxx = IMX8M_MIPI_SW_Pxx_REQ,
 289                         .map = IMX8M_MIPI_A53_DOMAIN,
 290                 },
 291                 .pgc       = IMX8M_PGC_MIPI,
 292         },
 293
 294         [IMX8M_POWER_DOMAIN_PCIE1] = {
 295                 .genpd = {
 296                         .name = "pcie1",
 297                 },
 298                 .bits  = {
 299                         .pxx = IMX8M_PCIE1_SW_Pxx_REQ,
 300                         .map = IMX8M_PCIE1_A53_DOMAIN,
 301                 },
 302                 .pgc   = IMX8M_PGC_PCIE1,
 303         },
 304
 305         [IMX8M_POWER_DOMAIN_USB_OTG1] = {
 306                 .genpd = {
 307                         .name = "usb-otg1",
 308                 },
 309                 .bits  = {
 310                         .pxx = IMX8M_OTG1_SW_Pxx_REQ,
 311                         .map = IMX8M_OTG1_A53_DOMAIN,
 312                 },
 313                 .pgc   = IMX8M_PGC_OTG1,
 314         },
 315
 316         [IMX8M_POWER_DOMAIN_USB_OTG2] = {
 317                 .genpd = {
 318                         .name = "usb-otg2",
 319                 },
 320                 .bits  = {
 321                         .pxx = IMX8M_OTG2_SW_Pxx_REQ,
 322                         .map = IMX8M_OTG2_A53_DOMAIN,
 323                 },
 324                 .pgc   = IMX8M_PGC_OTG2,
 325         },
 326
 327         [IMX8M_POWER_DOMAIN_DDR1] = {
 328                 .genpd = {
 329                         .name = "ddr1",
 330                 },
 331                 .bits  = {
 332                         .pxx = IMX8M_DDR1_SW_Pxx_REQ,
 333                         .map = IMX8M_DDR2_A53_DOMAIN,
 334                 },
 335                 .pgc   = IMX8M_PGC_DDR1,
 336         },
 337
 338         [IMX8M_POWER_DOMAIN_GPU] = {
 339                 .genpd = {
 340                         .name = "gpu",
 341                 },
 342                 .bits  = {
 343                         .pxx = IMX8M_GPU_SW_Pxx_REQ,
 344                         .map = IMX8M_GPU_A53_DOMAIN,
 345                         .hsk = IMX8M_GPU_HSK_PWRDNREQN,
 346                 },
 347                 .pgc   = IMX8M_PGC_GPU,
 348         },
 349
 350         [IMX8M_POWER_DOMAIN_VPU] = {
 351                 .genpd = {
 352                         .name = "vpu",
 353                 },
 354                 .bits  = {
 355                         .pxx = IMX8M_VPU_SW_Pxx_REQ,
 356                         .map = IMX8M_VPU_A53_DOMAIN,
 357                         .hsk = IMX8M_VPU_HSK_PWRDNREQN,
 358                 },
 359                 .pgc   = IMX8M_PGC_VPU,
 360         },
 361
 362         [IMX8M_POWER_DOMAIN_DISP] = {
 363                 .genpd = {
 364                         .name = "disp",
 365                 },
 366                 .bits  = {
 367                         .pxx = IMX8M_DISP_SW_Pxx_REQ,
 368                         .map = IMX8M_DISP_A53_DOMAIN,
 369                         .hsk = IMX8M_DISP_HSK_PWRDNREQN,
 370                 },
 371                 .pgc   = IMX8M_PGC_DISP,
 372         },
 373
 374         [IMX8M_POWER_DOMAIN_MIPI_CSI1] = {
 375                 .genpd = {
 376                         .name = "mipi-csi1",
 377                 },
 378                 .bits  = {
 379                         .pxx = IMX8M_MIPI_CSI1_SW_Pxx_REQ,
 380                         .map = IMX8M_MIPI_CSI1_A53_DOMAIN,
 381                 },
 382                 .pgc   = IMX8M_PGC_MIPI_CSI1,
 383         },
 384
 385         [IMX8M_POWER_DOMAIN_MIPI_CSI2] = {
 386                 .genpd = {
 387                         .name = "mipi-csi2",
 388                 },
 389                 .bits  = {
 390                         .pxx = IMX8M_MIPI_CSI2_SW_Pxx_REQ,
 391                         .map = IMX8M_MIPI_CSI2_A53_DOMAIN,
 392                 },
 393                 .pgc   = IMX8M_PGC_MIPI_CSI2,
 394         },
 395
 396         [IMX8M_POWER_DOMAIN_PCIE2] = {
 397                 .genpd = {
 398                         .name = "pcie2",
 399                 },
 400                 .bits  = {
 401                         .pxx = IMX8M_PCIE2_SW_Pxx_REQ,
 402                         .map = IMX8M_PCIE2_A53_DOMAIN,
 403                 },
 404                 .pgc   = IMX8M_PGC_PCIE2,
 405         },
 406 };
 407
 408 static const struct regmap_range imx8m_yes_ranges[] = {
 409                 regmap_reg_range(GPC_LPCR_A_CORE_BSC,
 410                                  GPC_PU_PWRHSK),
 411                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_MIPI),
 412                                  GPC_PGC_SR(IMX8M_PGC_MIPI)),
 413                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_PCIE1),
 414                                  GPC_PGC_SR(IMX8M_PGC_PCIE1)),
 415                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_OTG1),
 416                                  GPC_PGC_SR(IMX8M_PGC_OTG1)),
 417                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_OTG2),
 418                                  GPC_PGC_SR(IMX8M_PGC_OTG2)),
 419                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_DDR1),
 420                                  GPC_PGC_SR(IMX8M_PGC_DDR1)),
 421                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_GPU),
 422                                  GPC_PGC_SR(IMX8M_PGC_GPU)),
 423                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_VPU),
 424                                  GPC_PGC_SR(IMX8M_PGC_VPU)),
 425                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_DISP),
 426                                  GPC_PGC_SR(IMX8M_PGC_DISP)),
 427                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_MIPI_CSI1),
 428                                  GPC_PGC_SR(IMX8M_PGC_MIPI_CSI1)),
 429                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_MIPI_CSI2),
 430                                  GPC_PGC_SR(IMX8M_PGC_MIPI_CSI2)),
 431                 regmap_reg_range(GPC_PGC_CTRL(IMX8M_PGC_PCIE2),
 432                                  GPC_PGC_SR(IMX8M_PGC_PCIE2)),
 433 };
 434
 435 static const struct regmap_access_table imx8m_access_table = {
 436         .yes_ranges     = imx8m_yes_ranges,
 437         .n_yes_ranges   = ARRAY_SIZE(imx8m_yes_ranges),
 438 };
 439
 440 static const struct imx_pgc_domain_data imx8m_pgc_domain_data = {
 441         .domains = imx8m_pgc_domains,
 442         .domains_num = ARRAY_SIZE(imx8m_pgc_domains),
 443         .reg_access_table = &imx8m_access_table,
 444 };
 445
 446 static int imx_pgc_get_clocks(struct imx_pgc_domain *domain)
 447 {
 448         int i, ret;
 449
 450         for (i = 0; ; i++) {
 451                 struct clk *clk = of_clk_get(domain->dev->of_node, i);
 452                 if (IS_ERR(clk))
 453                         break;
 454                 if (i >= GPC_CLK_MAX) {
 455                         dev_err(domain->dev, "more than %d clocks\n",
 456                                 GPC_CLK_MAX);
 457                         ret = -EINVAL;
 458                         goto clk_err;
 459                 }
 460                 domain->clk[i] = clk;
 461         }
 462         domain->num_clks = i;
 463
 464         return 0;
 465
 466 clk_err:
 467         while (i--)
 468                 clk_put(domain->clk[i]);
 469
 470         return ret;
 471 }
 472
 473 static void imx_pgc_put_clocks(struct imx_pgc_domain *domain)
 474 {
 475         int i;
 476
 477         for (i = domain->num_clks - 1; i >= 0; i--)
 478                 clk_put(domain->clk[i]);
 479 }
 480
 481 static int imx_pgc_domain_probe(struct platform_device *pdev)
 482 {
 483         struct imx_pgc_domain *domain = pdev->dev.platform_data;
 484         int ret;
 485
 486         domain->dev = &pdev->dev;
 487
 488         domain->regulator = devm_regulator_get_optional(domain->dev, "power");
 489         if (IS_ERR(domain->regulator)) {
 490                 if (PTR_ERR(domain->regulator) != -ENODEV) {
 491                         if (PTR_ERR(domain->regulator) != -EPROBE_DEFER)
 492                                 dev_err(domain->dev, "Failed to get domain's regulator\n");
 493                         return PTR_ERR(domain->regulator);
 494                 }
 495         } else if (domain->voltage) {
 496                 regulator_set_voltage(domain->regulator,
 497                                       domain->voltage, domain->voltage);
 498         }
 499
 500         ret = imx_pgc_get_clocks(domain);
 501         if (ret) {
 502                 if (ret != -EPROBE_DEFER)
 503                         dev_err(domain->dev, "Failed to get domain's clocks\n");
 504                 return ret;
 505         }
 506
 507         ret = pm_genpd_init(&domain->genpd, NULL, true);
 508         if (ret) {
 509                 dev_err(domain->dev, "Failed to init power domain\n");
 510                 imx_pgc_put_clocks(domain);
 511                 return ret;
 512         }
 513
 514         ret = of_genpd_add_provider_simple(domain->dev->of_node,
 515                                            &domain->genpd);
 516         if (ret) {
 517                 dev_err(domain->dev, "Failed to add genpd provider\n");
 518                 pm_genpd_remove(&domain->genpd);
 519                 imx_pgc_put_clocks(domain);
 520         }
 521
 522         return ret;
 523 }
 524
 525 static int imx_pgc_domain_remove(struct platform_device *pdev)
 526 {
 527         struct imx_pgc_domain *domain = pdev->dev.platform_data;
 528
 529         of_genpd_del_provider(domain->dev->of_node);
 530         pm_genpd_remove(&domain->genpd);
 531         imx_pgc_put_clocks(domain);
 532
 533         return 0;
 534 }
 535
 536 static const struct platform_device_id imx_pgc_domain_id[] = {
 537         { "imx-pgc-domain", },
 538         { },
 539 };
 540
 541 static struct platform_driver imx_pgc_domain_driver = {
 542         .driver = {
 543                 .name = "imx-pgc",
 544         },
 545         .probe    = imx_pgc_domain_probe,
 546         .remove   = imx_pgc_domain_remove,
 547         .id_table = imx_pgc_domain_id,
 548 };
 549 builtin_platform_driver(imx_pgc_domain_driver)
 550
 551 static int imx_gpcv2_probe(struct platform_device *pdev)
 552 {
 553         const struct imx_pgc_domain_data *domain_data =
 554                         of_device_get_match_data(&pdev->dev);
 555
 556         struct regmap_config regmap_config = {
 557                 .reg_bits       = 32,
 558                 .val_bits       = 32,
 559                 .reg_stride     = 4,
 560                 .rd_table       = domain_data->reg_access_table,
 561                 .wr_table       = domain_data->reg_access_table,
 562                 .max_register   = SZ_4K,
 563         };
 564         struct device *dev = &pdev->dev;
 565         struct device_node *pgc_np, *np;
 566         struct regmap *regmap;
 567         void __iomem *base;
 568         int ret;
 569
 570         pgc_np = of_get_child_by_name(dev->of_node, "pgc");
 571         if (!pgc_np) {
 572                 dev_err(dev, "No power domains specified in DT\n");
 573                 return -EINVAL;
 574         }
 575
 576         base = devm_platform_ioremap_resource(pdev, 0);
 577         if (IS_ERR(base))
 578                 return PTR_ERR(base);
 579
 580         regmap = devm_regmap_init_mmio(dev, base, &regmap_config);
 581         if (IS_ERR(regmap)) {
 582                 ret = PTR_ERR(regmap);
 583                 dev_err(dev, "failed to init regmap (%d)\n", ret);
 584                 return ret;
 585         }
 586
 587         for_each_child_of_node(pgc_np, np) {
 588                 struct platform_device *pd_pdev;
 589                 struct imx_pgc_domain *domain;
 590                 u32 domain_index;
 591
 592                 ret = of_property_read_u32(np, "reg", &domain_index);
 593                 if (ret) {
 594                         dev_err(dev, "Failed to read 'reg' property\n");
 595                         of_node_put(np);
 596                         return ret;
 597                 }
 598
 599                 if (domain_index >= domain_data->domains_num) {
 600                         dev_warn(dev,
 601                                  "Domain index %d is out of bounds\n",
 602                                  domain_index);
 603                         continue;
 604                 }
 605
 606                 pd_pdev = platform_device_alloc("imx-pgc-domain",
 607                                                 domain_index);
 608                 if (!pd_pdev) {
 609                         dev_err(dev, "Failed to allocate platform device\n");
 610                         of_node_put(np);
 611                         return -ENOMEM;
 612                 }
 613
 614                 ret = platform_device_add_data(pd_pdev,
 615                                                &domain_data->domains[domain_index],
 616                                                sizeof(domain_data->domains[domain_index]));
 617                 if (ret) {
 618                         platform_device_put(pd_pdev);
 619                         of_node_put(np);
 620                         return ret;
 621                 }
 622
 623                 domain = pd_pdev->dev.platform_data;
 624                 domain->regmap = regmap;
 625                 domain->genpd.power_on  = imx_gpc_pu_pgc_sw_pup_req;
 626                 domain->genpd.power_off = imx_gpc_pu_pgc_sw_pdn_req;
 627
 628                 pd_pdev->dev.parent = dev;
 629                 pd_pdev->dev.of_node = np;
 630
 631                 ret = platform_device_add(pd_pdev);
 632                 if (ret) {
 633                         platform_device_put(pd_pdev);
 634                         of_node_put(np);
 635                         return ret;
 636                 }
 637         }
 638
 639         return 0;
 640 }
 641
 642 static const struct of_device_id imx_gpcv2_dt_ids[] = {
 643         { .compatible = "fsl,imx7d-gpc", .data = &imx7_pgc_domain_data, },
 644         { .compatible = "fsl,imx8mq-gpc", .data = &imx8m_pgc_domain_data, },
 645         { }
 646 };
 647
 648 static struct platform_driver imx_gpc_driver = {
 649         .driver = {
 650                 .name = "imx-gpcv2",
 651                 .of_match_table = imx_gpcv2_dt_ids,
 652         },
 653         .probe = imx_gpcv2_probe,
 654 };
 655 builtin_platform_driver(imx_gpc_driver)