Linux Audio

Check our new training course

Linux debugging, profiling, tracing and performance analysis training

Mar 24-27, 2025, special US time zones
Register
Loading...
Note: File does not exist in v6.8.
  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * Copyright 2017 Impinj, Inc
  4 * Author: Andrey Smirnov <andrew.smirnov@gmail.com>
  5 *
  6 * Based on the code of analogus driver:
  7 *
  8 * Copyright 2015-2017 Pengutronix, Lucas Stach <kernel@pengutronix.de>
  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
105struct 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
124struct 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
130static 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	}
206unmap:
207	regmap_update_bits(domain->regmap, GPC_PGC_CPU_MAPPING,
208			   domain->bits.map, 0);
209	return ret;
210}
211
212static 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
217static 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
222static 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
260static 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
271static 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
276static 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
282static 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
408static 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
435static 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
440static 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
446static 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
466clk_err:
467	while (i--)
468		clk_put(domain->clk[i]);
469
470	return ret;
471}
472
473static 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
481static 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
525static 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
536static const struct platform_device_id imx_pgc_domain_id[] = {
537	{ "imx-pgc-domain", },
538	{ },
539};
540
541static 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};
549builtin_platform_driver(imx_pgc_domain_driver)
550
551static 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
642static 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
648static 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};
655builtin_platform_driver(imx_gpc_driver)