Unverified Commit 10599205 authored by Syed Saba Kareem's avatar Syed Saba Kareem Committed by Mark Brown
Browse files

ASoC: amd: add RPL Platform init/de-init functions 



Add RPL Platform ACP init/de-init functions.

Signed-off-by: default avatarSyed Saba Kareem <Syed.SabaKareem@amd.com>
Reviewed-by: default avatarVijendar Mukunda <Vijendar.Mukunda@amd.com>
Link: https://lore.kernel.org/r/20220721061035.91139-3-Syed.SabaKareem@amd.com


Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent 003b9a96

sound/soc/amd/rpl/rpl-pci-acp6x.c

+92 −0
Original line number Diff line number Diff line
@@ -17,6 +17,88 @@ struct rpl_dev_data { 
	void __iomem *acp6x_base;

};



static int rpl_power_on(void __iomem *acp_base)

{

	u32 val;

	int timeout;



	val = rpl_acp_readl(acp_base + ACP_PGFSM_STATUS);



	if (!val)

		return val;



	if ((val & ACP_PGFSM_STATUS_MASK) != ACP_POWER_ON_IN_PROGRESS)

		rpl_acp_writel(ACP_PGFSM_CNTL_POWER_ON_MASK, acp_base + ACP_PGFSM_CONTROL);

	timeout = 0;

	while (++timeout < 500) {

		val = rpl_acp_readl(acp_base + ACP_PGFSM_STATUS);

		if (!val)

			return 0;

		udelay(1);

	}

	return -ETIMEDOUT;

}



static int rpl_reset(void __iomem *acp_base)

{

	u32 val;

	int timeout;



	rpl_acp_writel(1, acp_base + ACP_SOFT_RESET);

	timeout = 0;

	while (++timeout < 500) {

		val = rpl_acp_readl(acp_base + ACP_SOFT_RESET);

		if (val & ACP_SOFT_RESET_SOFTRESET_AUDDONE_MASK)

			break;

		cpu_relax();

	}

	rpl_acp_writel(0, acp_base + ACP_SOFT_RESET);

	timeout = 0;

	while (++timeout < 500) {

		val = rpl_acp_readl(acp_base + ACP_SOFT_RESET);

		if (!val)

			return 0;

		cpu_relax();

	}

	return -ETIMEDOUT;

}



static int rpl_init(void __iomem *acp_base)

{

	int ret;



	/* power on */

	ret = rpl_power_on(acp_base);

	if (ret) {

		pr_err("ACP power on failed\n");

		return ret;

	}

	rpl_acp_writel(0x01, acp_base + ACP_CONTROL);

	/* Reset */

	ret = rpl_reset(acp_base);

	if (ret) {

		pr_err("ACP reset failed\n");

		return ret;

	}

	rpl_acp_writel(0x03, acp_base + ACP_CLKMUX_SEL);

	return 0;

}



static int rpl_deinit(void __iomem *acp_base)

{

	int ret;



	/* Reset */

	ret = rpl_reset(acp_base);

	if (ret) {

		pr_err("ACP reset failed\n");

		return ret;

	}

	rpl_acp_writel(0x00, acp_base + ACP_CLKMUX_SEL);

	rpl_acp_writel(0x00, acp_base + ACP_CONTROL);

	return 0;

}



static int snd_rpl_probe(struct pci_dev *pci,

			 const struct pci_device_id *pci_id)

{
@@ -59,6 +141,9 @@ static int snd_rpl_probe(struct pci_dev *pci, 
	}

	pci_set_master(pci);

	pci_set_drvdata(pci, adata);

	ret = rpl_init(adata->acp6x_base);

	if (ret)

		goto release_regions;

	return 0;

release_regions:

	pci_release_regions(pci);
@@ -70,6 +155,13 @@ static int snd_rpl_probe(struct pci_dev *pci, 


static void snd_rpl_remove(struct pci_dev *pci)

{

	struct rpl_dev_data *adata;

	int ret;



	adata = pci_get_drvdata(pci);

	ret = rpl_deinit(adata->acp6x_base);

	if (ret)

		dev_err(&pci->dev, "ACP de-init failed\n");

	pci_release_regions(pci);

	pci_disable_device(pci);

}