mirror of
				https://github.com/torvalds/linux.git
				synced 2025-10-31 00:28:52 +02:00 
			
		
		
		
	 264200cc3a
			
		
	
	
		264200cc3a
		
			
		
	
	
	
	
		
			
			Fix typos, mostly in comments except CLKGATE_SEPERATED_* (definition and uses updated). Signed-off-by: Bjorn Helgaas <bhelgaas@google.com> Link: https://lore.kernel.org/r/20250723203819.2910289-1-helgaas@kernel.org Signed-off-by: Stephen Boyd <sboyd@kernel.org>
		
			
				
	
	
		
			497 lines
		
	
	
	
		
			17 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			497 lines
		
	
	
	
		
			17 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0+
 | |
| //
 | |
| // Copyright 2023 NXP
 | |
| //
 | |
| 
 | |
| #include <dt-bindings/clock/imx8-clock.h>
 | |
| #include <linux/clk-provider.h>
 | |
| #include <linux/device.h>
 | |
| #include <linux/err.h>
 | |
| #include <linux/io.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/of.h>
 | |
| #include <linux/of_device.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <linux/pm_domain.h>
 | |
| #include <linux/pm_runtime.h>
 | |
| #include <linux/slab.h>
 | |
| 
 | |
| #include "clk.h"
 | |
| 
 | |
| /**
 | |
|  * struct clk_imx_acm_pm_domains - structure for multi power domain
 | |
|  * @pd_dev: power domain device
 | |
|  * @pd_dev_link: power domain device link
 | |
|  * @num_domains: power domain number
 | |
|  */
 | |
| struct clk_imx_acm_pm_domains {
 | |
| 	struct device **pd_dev;
 | |
| 	struct device_link **pd_dev_link;
 | |
| 	int    num_domains;
 | |
| };
 | |
| 
 | |
| /**
 | |
|  * struct clk_imx8_acm_sel - for clock mux
 | |
|  * @name: clock name
 | |
|  * @clkid: clock id
 | |
|  * @parents: clock parents
 | |
|  * @num_parents: clock parents number
 | |
|  * @reg: register offset
 | |
|  * @shift: bit shift in register
 | |
|  * @width: bits width
 | |
|  */
 | |
| struct clk_imx8_acm_sel {
 | |
| 	const char			*name;
 | |
| 	int				clkid;
 | |
| 	const struct clk_parent_data	*parents;	/* For mux */
 | |
| 	int				num_parents;
 | |
| 	u32				reg;
 | |
| 	u8				shift;
 | |
| 	u8				width;
 | |
| };
 | |
| 
 | |
| /**
 | |
|  * struct imx8_acm_soc_data - soc specific data
 | |
|  * @sels: pointer to struct clk_imx8_acm_sel
 | |
|  * @num_sels: numbers of items
 | |
|  * @mclk_sels: pointer to imx8qm/qxp/dxl_mclk_sels
 | |
|  */
 | |
| struct imx8_acm_soc_data {
 | |
| 	struct clk_imx8_acm_sel *sels;
 | |
| 	unsigned int num_sels;
 | |
| 	struct clk_parent_data *mclk_sels;
 | |
| };
 | |
| 
 | |
| /**
 | |
|  * struct imx8_acm_priv - private structure
 | |
|  * @dev_pm: multi power domain
 | |
|  * @soc_data: pointer to soc data
 | |
|  * @reg: base address of registers
 | |
|  * @regs: save registers for suspend
 | |
|  */
 | |
| struct imx8_acm_priv {
 | |
| 	struct clk_imx_acm_pm_domains dev_pm;
 | |
| 	const struct imx8_acm_soc_data *soc_data;
 | |
| 	void __iomem *reg;
 | |
| 	u32 regs[IMX_ADMA_ACM_CLK_END];
 | |
| };
 | |
| 
 | |
| static const struct clk_parent_data imx8qm_aud_clk_sels[] = {
 | |
| 	{ .fw_name = "aud_rec_clk0_lpcg_clk" },
 | |
| 	{ .fw_name = "aud_rec_clk1_lpcg_clk" },
 | |
| 	{ .fw_name = "dummy" },
 | |
| 	{ .fw_name = "hdmi_rx_mclk" },
 | |
| 	{ .fw_name = "ext_aud_mclk0" },
 | |
| 	{ .fw_name = "ext_aud_mclk1" },
 | |
| 	{ .fw_name = "esai0_rx_clk" },
 | |
| 	{ .fw_name = "esai0_rx_hf_clk" },
 | |
| 	{ .fw_name = "esai0_tx_clk" },
 | |
| 	{ .fw_name = "esai0_tx_hf_clk" },
 | |
| 	{ .fw_name = "esai1_rx_clk" },
 | |
| 	{ .fw_name = "esai1_rx_hf_clk" },
 | |
| 	{ .fw_name = "esai1_tx_clk" },
 | |
| 	{ .fw_name = "esai1_tx_hf_clk" },
 | |
| 	{ .fw_name = "spdif0_rx" },
 | |
| 	{ .fw_name = "spdif1_rx" },
 | |
| 	{ .fw_name = "sai0_rx_bclk" },
 | |
| 	{ .fw_name = "sai0_tx_bclk" },
 | |
| 	{ .fw_name = "sai1_rx_bclk" },
 | |
| 	{ .fw_name = "sai1_tx_bclk" },
 | |
| 	{ .fw_name = "sai2_rx_bclk" },
 | |
| 	{ .fw_name = "sai3_rx_bclk" },
 | |
| 	{ .fw_name = "sai4_rx_bclk" },
 | |
| };
 | |
| 
 | |
| static const struct clk_parent_data imx8qm_mclk_out_sels[] = {
 | |
| 	{ .fw_name = "aud_rec_clk0_lpcg_clk" },
 | |
| 	{ .fw_name = "aud_rec_clk1_lpcg_clk" },
 | |
| 	{ .fw_name = "dummy" },
 | |
| 	{ .fw_name = "hdmi_rx_mclk" },
 | |
| 	{ .fw_name = "spdif0_rx" },
 | |
| 	{ .fw_name = "spdif1_rx" },
 | |
| 	{ .fw_name = "sai4_rx_bclk" },
 | |
| 	{ .fw_name = "sai6_rx_bclk" },
 | |
| };
 | |
| 
 | |
| #define ACM_AUD_CLK0_SEL_INDEX  2
 | |
| #define ACM_AUD_CLK1_SEL_INDEX  3
 | |
| 
 | |
| static struct clk_parent_data imx8qm_mclk_sels[] = {
 | |
| 	{ .fw_name = "aud_pll_div_clk0_lpcg_clk" },
 | |
| 	{ .fw_name = "aud_pll_div_clk1_lpcg_clk" },
 | |
| 	{  }, /* clk_hw pointer of "acm_aud_clk0_sel" */
 | |
| 	{  }, /* clk_hw pointer of "acm_aud_clk1_sel" */
 | |
| };
 | |
| 
 | |
| static const struct clk_parent_data imx8qm_asrc_mux_clk_sels[] = {
 | |
| 	{ .fw_name = "sai4_rx_bclk" },
 | |
| 	{ .fw_name = "sai5_tx_bclk" },
 | |
| 	{ .index = -1 },
 | |
| 	{ .fw_name = "dummy" },
 | |
| 
 | |
| };
 | |
| 
 | |
| static struct clk_imx8_acm_sel imx8qm_sels[] = {
 | |
| 	{ "acm_aud_clk0_sel", IMX_ADMA_ACM_AUD_CLK0_SEL, imx8qm_aud_clk_sels, ARRAY_SIZE(imx8qm_aud_clk_sels), 0x000000, 0, 5 },
 | |
| 	{ "acm_aud_clk1_sel", IMX_ADMA_ACM_AUD_CLK1_SEL, imx8qm_aud_clk_sels, ARRAY_SIZE(imx8qm_aud_clk_sels), 0x010000, 0, 5 },
 | |
| 	{ "acm_mclkout0_sel", IMX_ADMA_ACM_MCLKOUT0_SEL, imx8qm_mclk_out_sels, ARRAY_SIZE(imx8qm_mclk_out_sels), 0x020000, 0, 3 },
 | |
| 	{ "acm_mclkout1_sel", IMX_ADMA_ACM_MCLKOUT1_SEL, imx8qm_mclk_out_sels, ARRAY_SIZE(imx8qm_mclk_out_sels), 0x030000, 0, 3 },
 | |
| 	{ "acm_asrc0_mclk_sel", IMX_ADMA_ACM_ASRC0_MUX_CLK_SEL, imx8qm_asrc_mux_clk_sels, ARRAY_SIZE(imx8qm_asrc_mux_clk_sels), 0x040000, 0, 2 },
 | |
| 	{ "acm_esai0_mclk_sel", IMX_ADMA_ACM_ESAI0_MCLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x060000, 0, 2 },
 | |
| 	{ "acm_esai1_mclk_sel", IMX_ADMA_ACM_ESAI1_MCLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x070000, 0, 2 },
 | |
| 	{ "acm_sai0_mclk_sel", IMX_ADMA_ACM_SAI0_MCLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x0E0000, 0, 2 },
 | |
| 	{ "acm_sai1_mclk_sel", IMX_ADMA_ACM_SAI1_MCLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x0F0000, 0, 2 },
 | |
| 	{ "acm_sai2_mclk_sel", IMX_ADMA_ACM_SAI2_MCLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x100000, 0, 2 },
 | |
| 	{ "acm_sai3_mclk_sel", IMX_ADMA_ACM_SAI3_MCLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x110000, 0, 2 },
 | |
| 	{ "acm_sai4_mclk_sel", IMX_ADMA_ACM_SAI4_MCLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x120000, 0, 2 },
 | |
| 	{ "acm_sai5_mclk_sel", IMX_ADMA_ACM_SAI5_MCLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x130000, 0, 2 },
 | |
| 	{ "acm_sai6_mclk_sel", IMX_ADMA_ACM_SAI6_MCLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x140000, 0, 2 },
 | |
| 	{ "acm_sai7_mclk_sel", IMX_ADMA_ACM_SAI7_MCLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x150000, 0, 2 },
 | |
| 	{ "acm_spdif0_mclk_sel", IMX_ADMA_ACM_SPDIF0_TX_CLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x1A0000, 0, 2 },
 | |
| 	{ "acm_spdif1_mclk_sel", IMX_ADMA_ACM_SPDIF1_TX_CLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x1B0000, 0, 2 },
 | |
| 	{ "acm_mqs_mclk_sel", IMX_ADMA_ACM_MQS_TX_CLK_SEL, imx8qm_mclk_sels, ARRAY_SIZE(imx8qm_mclk_sels), 0x1C0000, 0, 2 },
 | |
| };
 | |
| 
 | |
| static const struct clk_parent_data imx8qxp_aud_clk_sels[] = {
 | |
| 	{ .fw_name = "aud_rec_clk0_lpcg_clk" },
 | |
| 	{ .fw_name = "aud_rec_clk1_lpcg_clk" },
 | |
| 	{ .fw_name = "ext_aud_mclk0" },
 | |
| 	{ .fw_name = "ext_aud_mclk1" },
 | |
| 	{ .fw_name = "esai0_rx_clk" },
 | |
| 	{ .fw_name = "esai0_rx_hf_clk" },
 | |
| 	{ .fw_name = "esai0_tx_clk" },
 | |
| 	{ .fw_name = "esai0_tx_hf_clk" },
 | |
| 	{ .fw_name = "spdif0_rx" },
 | |
| 	{ .fw_name = "sai0_rx_bclk" },
 | |
| 	{ .fw_name = "sai0_tx_bclk" },
 | |
| 	{ .fw_name = "sai1_rx_bclk" },
 | |
| 	{ .fw_name = "sai1_tx_bclk" },
 | |
| 	{ .fw_name = "sai2_rx_bclk" },
 | |
| 	{ .fw_name = "sai3_rx_bclk" },
 | |
| };
 | |
| 
 | |
| static const struct clk_parent_data imx8qxp_mclk_out_sels[] = {
 | |
| 	{ .fw_name = "aud_rec_clk0_lpcg_clk" },
 | |
| 	{ .fw_name = "aud_rec_clk1_lpcg_clk" },
 | |
| 	{ .index = -1 },
 | |
| 	{ .index = -1 },
 | |
| 	{ .fw_name = "spdif0_rx" },
 | |
| 	{ .index = -1 },
 | |
| 	{ .index = -1 },
 | |
| 	{ .fw_name = "sai4_rx_bclk" },
 | |
| };
 | |
| 
 | |
| static struct clk_parent_data imx8qxp_mclk_sels[] = {
 | |
| 	{ .fw_name = "aud_pll_div_clk0_lpcg_clk" },
 | |
| 	{ .fw_name = "aud_pll_div_clk1_lpcg_clk" },
 | |
| 	{  }, /* clk_hw pointer of "acm_aud_clk0_sel" */
 | |
| 	{  }, /* clk_hw pointer of "acm_aud_clk1_sel" */
 | |
| };
 | |
| 
 | |
| static struct clk_imx8_acm_sel imx8qxp_sels[] = {
 | |
| 	{ "acm_aud_clk0_sel", IMX_ADMA_ACM_AUD_CLK0_SEL, imx8qxp_aud_clk_sels, ARRAY_SIZE(imx8qxp_aud_clk_sels), 0x000000, 0, 5 },
 | |
| 	{ "acm_aud_clk1_sel", IMX_ADMA_ACM_AUD_CLK1_SEL, imx8qxp_aud_clk_sels, ARRAY_SIZE(imx8qxp_aud_clk_sels), 0x010000, 0, 5 },
 | |
| 	{ "acm_mclkout0_sel", IMX_ADMA_ACM_MCLKOUT0_SEL, imx8qxp_mclk_out_sels, ARRAY_SIZE(imx8qxp_mclk_out_sels), 0x020000, 0, 3 },
 | |
| 	{ "acm_mclkout1_sel", IMX_ADMA_ACM_MCLKOUT1_SEL, imx8qxp_mclk_out_sels, ARRAY_SIZE(imx8qxp_mclk_out_sels), 0x030000, 0, 3 },
 | |
| 	{ "acm_esai0_mclk_sel", IMX_ADMA_ACM_ESAI0_MCLK_SEL, imx8qxp_mclk_sels, ARRAY_SIZE(imx8qxp_mclk_sels), 0x060000, 0, 2 },
 | |
| 	{ "acm_sai0_mclk_sel", IMX_ADMA_ACM_SAI0_MCLK_SEL, imx8qxp_mclk_sels, ARRAY_SIZE(imx8qxp_mclk_sels), 0x0E0000, 0, 2 },
 | |
| 	{ "acm_sai1_mclk_sel", IMX_ADMA_ACM_SAI1_MCLK_SEL, imx8qxp_mclk_sels, ARRAY_SIZE(imx8qxp_mclk_sels), 0x0F0000, 0, 2 },
 | |
| 	{ "acm_sai2_mclk_sel", IMX_ADMA_ACM_SAI2_MCLK_SEL, imx8qxp_mclk_sels, ARRAY_SIZE(imx8qxp_mclk_sels), 0x100000, 0, 2 },
 | |
| 	{ "acm_sai3_mclk_sel", IMX_ADMA_ACM_SAI3_MCLK_SEL, imx8qxp_mclk_sels, ARRAY_SIZE(imx8qxp_mclk_sels), 0x110000, 0, 2 },
 | |
| 	{ "acm_sai4_mclk_sel", IMX_ADMA_ACM_SAI4_MCLK_SEL, imx8qxp_mclk_sels, ARRAY_SIZE(imx8qxp_mclk_sels), 0x140000, 0, 2 },
 | |
| 	{ "acm_sai5_mclk_sel", IMX_ADMA_ACM_SAI5_MCLK_SEL, imx8qxp_mclk_sels, ARRAY_SIZE(imx8qxp_mclk_sels), 0x150000, 0, 2 },
 | |
| 	{ "acm_spdif0_mclk_sel", IMX_ADMA_ACM_SPDIF0_TX_CLK_SEL, imx8qxp_mclk_sels, ARRAY_SIZE(imx8qxp_mclk_sels), 0x1A0000, 0, 2 },
 | |
| 	{ "acm_mqs_mclk_sel", IMX_ADMA_ACM_MQS_TX_CLK_SEL, imx8qxp_mclk_sels, ARRAY_SIZE(imx8qxp_mclk_sels), 0x1C0000, 0, 2 },
 | |
| };
 | |
| 
 | |
| static const struct clk_parent_data imx8dxl_aud_clk_sels[] = {
 | |
| 	{ .fw_name = "aud_rec_clk0_lpcg_clk" },
 | |
| 	{ .fw_name = "aud_rec_clk1_lpcg_clk" },
 | |
| 	{ .fw_name = "ext_aud_mclk0" },
 | |
| 	{ .fw_name = "ext_aud_mclk1" },
 | |
| 	{ .index = -1 },
 | |
| 	{ .index = -1 },
 | |
| 	{ .index = -1 },
 | |
| 	{ .index = -1 },
 | |
| 	{ .fw_name = "spdif0_rx" },
 | |
| 	{ .fw_name = "sai0_rx_bclk" },
 | |
| 	{ .fw_name = "sai0_tx_bclk" },
 | |
| 	{ .fw_name = "sai1_rx_bclk" },
 | |
| 	{ .fw_name = "sai1_tx_bclk" },
 | |
| 	{ .fw_name = "sai2_rx_bclk" },
 | |
| 	{ .fw_name = "sai3_rx_bclk" },
 | |
| };
 | |
| 
 | |
| static const struct clk_parent_data imx8dxl_mclk_out_sels[] = {
 | |
| 	{ .fw_name = "aud_rec_clk0_lpcg_clk" },
 | |
| 	{ .fw_name = "aud_rec_clk1_lpcg_clk" },
 | |
| 	{ .index = -1 },
 | |
| 	{ .index = -1 },
 | |
| 	{ .fw_name = "spdif0_rx" },
 | |
| 	{ .index = -1 },
 | |
| 	{ .index = -1 },
 | |
| 	{ .index = -1 },
 | |
| };
 | |
| 
 | |
| static struct clk_parent_data imx8dxl_mclk_sels[] = {
 | |
| 	{ .fw_name = "aud_pll_div_clk0_lpcg_clk" },
 | |
| 	{ .fw_name = "aud_pll_div_clk1_lpcg_clk" },
 | |
| 	{  }, /* clk_hw pointer of "acm_aud_clk0_sel" */
 | |
| 	{  }, /* clk_hw pointer of "acm_aud_clk1_sel" */
 | |
| };
 | |
| 
 | |
| static struct clk_imx8_acm_sel imx8dxl_sels[] = {
 | |
| 	{ "acm_aud_clk0_sel", IMX_ADMA_ACM_AUD_CLK0_SEL, imx8dxl_aud_clk_sels, ARRAY_SIZE(imx8dxl_aud_clk_sels), 0x000000, 0, 5 },
 | |
| 	{ "acm_aud_clk1_sel", IMX_ADMA_ACM_AUD_CLK1_SEL, imx8dxl_aud_clk_sels, ARRAY_SIZE(imx8dxl_aud_clk_sels), 0x010000, 0, 5 },
 | |
| 	{ "acm_mclkout0_sel", IMX_ADMA_ACM_MCLKOUT0_SEL, imx8dxl_mclk_out_sels, ARRAY_SIZE(imx8dxl_mclk_out_sels), 0x020000, 0, 3 },
 | |
| 	{ "acm_mclkout1_sel", IMX_ADMA_ACM_MCLKOUT1_SEL, imx8dxl_mclk_out_sels, ARRAY_SIZE(imx8dxl_mclk_out_sels), 0x030000, 0, 3 },
 | |
| 	{ "acm_sai0_mclk_sel", IMX_ADMA_ACM_SAI0_MCLK_SEL, imx8dxl_mclk_sels, ARRAY_SIZE(imx8dxl_mclk_sels), 0x0E0000, 0, 2 },
 | |
| 	{ "acm_sai1_mclk_sel", IMX_ADMA_ACM_SAI1_MCLK_SEL, imx8dxl_mclk_sels, ARRAY_SIZE(imx8dxl_mclk_sels), 0x0F0000, 0, 2 },
 | |
| 	{ "acm_sai2_mclk_sel", IMX_ADMA_ACM_SAI2_MCLK_SEL, imx8dxl_mclk_sels, ARRAY_SIZE(imx8dxl_mclk_sels), 0x100000, 0, 2 },
 | |
| 	{ "acm_sai3_mclk_sel", IMX_ADMA_ACM_SAI3_MCLK_SEL, imx8dxl_mclk_sels, ARRAY_SIZE(imx8dxl_mclk_sels), 0x110000, 0, 2 },
 | |
| 	{ "acm_spdif0_mclk_sel", IMX_ADMA_ACM_SPDIF0_TX_CLK_SEL, imx8dxl_mclk_sels, ARRAY_SIZE(imx8dxl_mclk_sels), 0x1A0000, 0, 2 },
 | |
| 	{ "acm_mqs_mclk_sel", IMX_ADMA_ACM_MQS_TX_CLK_SEL, imx8dxl_mclk_sels, ARRAY_SIZE(imx8dxl_mclk_sels), 0x1C0000, 0, 2 },
 | |
| };
 | |
| 
 | |
| /**
 | |
|  * clk_imx_acm_attach_pm_domains: attach multi power domains
 | |
|  * @dev: device pointer
 | |
|  * @dev_pm: power domains for device
 | |
|  */
 | |
| static int clk_imx_acm_attach_pm_domains(struct device *dev,
 | |
| 					 struct clk_imx_acm_pm_domains *dev_pm)
 | |
| {
 | |
| 	int ret;
 | |
| 	int i;
 | |
| 
 | |
| 	dev_pm->num_domains = of_count_phandle_with_args(dev->of_node, "power-domains",
 | |
| 							 "#power-domain-cells");
 | |
| 	if (dev_pm->num_domains <= 1)
 | |
| 		return 0;
 | |
| 
 | |
| 	dev_pm->pd_dev = devm_kmalloc_array(dev, dev_pm->num_domains,
 | |
| 					    sizeof(*dev_pm->pd_dev),
 | |
| 					    GFP_KERNEL);
 | |
| 	if (!dev_pm->pd_dev)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	dev_pm->pd_dev_link = devm_kmalloc_array(dev,
 | |
| 						 dev_pm->num_domains,
 | |
| 						 sizeof(*dev_pm->pd_dev_link),
 | |
| 						 GFP_KERNEL);
 | |
| 	if (!dev_pm->pd_dev_link)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	for (i = 0; i < dev_pm->num_domains; i++) {
 | |
| 		dev_pm->pd_dev[i] = dev_pm_domain_attach_by_id(dev, i);
 | |
| 		if (IS_ERR(dev_pm->pd_dev[i])) {
 | |
| 			ret = PTR_ERR(dev_pm->pd_dev[i]);
 | |
| 			goto detach_pm;
 | |
| 		}
 | |
| 
 | |
| 		dev_pm->pd_dev_link[i] = device_link_add(dev,
 | |
| 							 dev_pm->pd_dev[i],
 | |
| 							 DL_FLAG_STATELESS |
 | |
| 							 DL_FLAG_PM_RUNTIME |
 | |
| 							 DL_FLAG_RPM_ACTIVE);
 | |
| 		if (!dev_pm->pd_dev_link[i]) {
 | |
| 			dev_pm_domain_detach(dev_pm->pd_dev[i], false);
 | |
| 			ret = -EINVAL;
 | |
| 			goto detach_pm;
 | |
| 		}
 | |
| 	}
 | |
| 	return 0;
 | |
| 
 | |
| detach_pm:
 | |
| 	while (--i >= 0) {
 | |
| 		device_link_del(dev_pm->pd_dev_link[i]);
 | |
| 		dev_pm_domain_detach(dev_pm->pd_dev[i], false);
 | |
| 	}
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * clk_imx_acm_detach_pm_domains: detach multi power domains
 | |
|  * @dev: deivice pointer
 | |
|  * @dev_pm: multi power domain for device
 | |
|  */
 | |
| static void clk_imx_acm_detach_pm_domains(struct device *dev,
 | |
| 					  struct clk_imx_acm_pm_domains *dev_pm)
 | |
| {
 | |
| 	int i;
 | |
| 
 | |
| 	if (dev_pm->num_domains <= 1)
 | |
| 		return;
 | |
| 
 | |
| 	for (i = 0; i < dev_pm->num_domains; i++) {
 | |
| 		device_link_del(dev_pm->pd_dev_link[i]);
 | |
| 		dev_pm_domain_detach(dev_pm->pd_dev[i], false);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int imx8_acm_clk_probe(struct platform_device *pdev)
 | |
| {
 | |
| 	struct clk_hw_onecell_data *clk_hw_data;
 | |
| 	struct device *dev = &pdev->dev;
 | |
| 	struct clk_imx8_acm_sel *sels;
 | |
| 	struct imx8_acm_priv *priv;
 | |
| 	struct clk_hw **hws;
 | |
| 	void __iomem *base;
 | |
| 	int ret;
 | |
| 	int i;
 | |
| 
 | |
| 	base = devm_of_iomap(dev, dev->of_node, 0, NULL);
 | |
| 	if (WARN_ON(IS_ERR(base)))
 | |
| 		return PTR_ERR(base);
 | |
| 
 | |
| 	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
 | |
| 	if (!priv)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	priv->reg = base;
 | |
| 	priv->soc_data = of_device_get_match_data(dev);
 | |
| 	platform_set_drvdata(pdev, priv);
 | |
| 
 | |
| 	clk_hw_data = devm_kzalloc(&pdev->dev, struct_size(clk_hw_data, hws, IMX_ADMA_ACM_CLK_END),
 | |
| 				   GFP_KERNEL);
 | |
| 	if (!clk_hw_data)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	clk_hw_data->num = IMX_ADMA_ACM_CLK_END;
 | |
| 	hws = clk_hw_data->hws;
 | |
| 
 | |
| 	ret = clk_imx_acm_attach_pm_domains(&pdev->dev, &priv->dev_pm);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	pm_runtime_enable(&pdev->dev);
 | |
| 	pm_runtime_get_sync(&pdev->dev);
 | |
| 
 | |
| 	sels = priv->soc_data->sels;
 | |
| 	for (i = 0; i < priv->soc_data->num_sels; i++) {
 | |
| 		hws[sels[i].clkid] = devm_clk_hw_register_mux_parent_data_table(dev,
 | |
| 										sels[i].name, sels[i].parents,
 | |
| 										sels[i].num_parents, 0,
 | |
| 										base + sels[i].reg,
 | |
| 										sels[i].shift, sels[i].width,
 | |
| 										0, NULL, NULL);
 | |
| 		if (IS_ERR(hws[sels[i].clkid])) {
 | |
| 			ret = PTR_ERR(hws[sels[i].clkid]);
 | |
| 			imx_check_clk_hws(hws, IMX_ADMA_ACM_CLK_END);
 | |
| 			goto err_clk_register;
 | |
| 		}
 | |
| 
 | |
| 		/*
 | |
| 		 * The IMX_ADMA_ACM_AUD_CLK0_SEL and IMX_ADMA_ACM_AUD_CLK1_SEL are
 | |
| 		 * registered first. After registration, update the clk_hw pointer
 | |
| 		 * to imx8qm/qxp/dxl_mclk_sels structures.
 | |
| 		 */
 | |
| 		if (sels[i].clkid == IMX_ADMA_ACM_AUD_CLK0_SEL)
 | |
| 			priv->soc_data->mclk_sels[ACM_AUD_CLK0_SEL_INDEX].hw =
 | |
| 								hws[IMX_ADMA_ACM_AUD_CLK0_SEL];
 | |
| 		if (sels[i].clkid == IMX_ADMA_ACM_AUD_CLK1_SEL)
 | |
| 			priv->soc_data->mclk_sels[ACM_AUD_CLK1_SEL_INDEX].hw =
 | |
| 								hws[IMX_ADMA_ACM_AUD_CLK1_SEL];
 | |
| 	}
 | |
| 
 | |
| 	ret = devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, clk_hw_data);
 | |
| 	if (ret < 0) {
 | |
| 		dev_err(dev, "failed to register hws for ACM\n");
 | |
| 		goto err_clk_register;
 | |
| 	}
 | |
| 
 | |
| 	pm_runtime_put_sync(&pdev->dev);
 | |
| 	return 0;
 | |
| 
 | |
| err_clk_register:
 | |
| 	pm_runtime_put_sync(&pdev->dev);
 | |
| 	pm_runtime_disable(&pdev->dev);
 | |
| 	clk_imx_acm_detach_pm_domains(&pdev->dev, &priv->dev_pm);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static void imx8_acm_clk_remove(struct platform_device *pdev)
 | |
| {
 | |
| 	struct imx8_acm_priv *priv = dev_get_drvdata(&pdev->dev);
 | |
| 
 | |
| 	pm_runtime_disable(&pdev->dev);
 | |
| 
 | |
| 	clk_imx_acm_detach_pm_domains(&pdev->dev, &priv->dev_pm);
 | |
| }
 | |
| 
 | |
| static const struct imx8_acm_soc_data imx8qm_acm_data = {
 | |
| 	.sels = imx8qm_sels,
 | |
| 	.num_sels = ARRAY_SIZE(imx8qm_sels),
 | |
| 	.mclk_sels = imx8qm_mclk_sels,
 | |
| };
 | |
| 
 | |
| static const struct imx8_acm_soc_data imx8qxp_acm_data = {
 | |
| 	.sels = imx8qxp_sels,
 | |
| 	.num_sels = ARRAY_SIZE(imx8qxp_sels),
 | |
| 	.mclk_sels = imx8qxp_mclk_sels,
 | |
| };
 | |
| 
 | |
| static const struct imx8_acm_soc_data imx8dxl_acm_data = {
 | |
| 	.sels = imx8dxl_sels,
 | |
| 	.num_sels = ARRAY_SIZE(imx8dxl_sels),
 | |
| 	.mclk_sels = imx8dxl_mclk_sels,
 | |
| };
 | |
| 
 | |
| static const struct of_device_id imx8_acm_match[] = {
 | |
| 	{ .compatible = "fsl,imx8qm-acm", .data = &imx8qm_acm_data },
 | |
| 	{ .compatible = "fsl,imx8qxp-acm", .data = &imx8qxp_acm_data },
 | |
| 	{ .compatible = "fsl,imx8dxl-acm", .data = &imx8dxl_acm_data },
 | |
| 	{ /* sentinel */ }
 | |
| };
 | |
| MODULE_DEVICE_TABLE(of, imx8_acm_match);
 | |
| 
 | |
| static int __maybe_unused imx8_acm_runtime_suspend(struct device *dev)
 | |
| {
 | |
| 	struct imx8_acm_priv *priv = dev_get_drvdata(dev);
 | |
| 	struct clk_imx8_acm_sel *sels;
 | |
| 	int i;
 | |
| 
 | |
| 	sels = priv->soc_data->sels;
 | |
| 
 | |
| 	for (i = 0; i < priv->soc_data->num_sels; i++)
 | |
| 		priv->regs[i] = readl_relaxed(priv->reg + sels[i].reg);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __maybe_unused imx8_acm_runtime_resume(struct device *dev)
 | |
| {
 | |
| 	struct imx8_acm_priv *priv = dev_get_drvdata(dev);
 | |
| 	struct clk_imx8_acm_sel *sels;
 | |
| 	int i;
 | |
| 
 | |
| 	sels = priv->soc_data->sels;
 | |
| 
 | |
| 	for (i = 0; i < priv->soc_data->num_sels; i++)
 | |
| 		writel_relaxed(priv->regs[i], priv->reg + sels[i].reg);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct dev_pm_ops imx8_acm_pm_ops = {
 | |
| 	SET_RUNTIME_PM_OPS(imx8_acm_runtime_suspend,
 | |
| 			   imx8_acm_runtime_resume, NULL)
 | |
| 	SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
 | |
| 				      pm_runtime_force_resume)
 | |
| };
 | |
| 
 | |
| static struct platform_driver imx8_acm_clk_driver = {
 | |
| 	.driver = {
 | |
| 		.name = "imx8-acm",
 | |
| 		.of_match_table = imx8_acm_match,
 | |
| 		.pm = &imx8_acm_pm_ops,
 | |
| 	},
 | |
| 	.probe = imx8_acm_clk_probe,
 | |
| 	.remove = imx8_acm_clk_remove,
 | |
| };
 | |
| module_platform_driver(imx8_acm_clk_driver);
 | |
| 
 | |
| MODULE_AUTHOR("Shengjiu Wang <shengjiu.wang@nxp.com>");
 | |
| MODULE_DESCRIPTION("Freescale i.MX8 Audio Clock Mux driver");
 | |
| MODULE_LICENSE("GPL");
 |