Unverified Commit 85ded495 authored by Vijendar Mukunda's avatar Vijendar Mukunda Committed by Mark Brown
Browse files

ASoC: amd: add acp init/de-init functions 



Add Renoir ACP PCI driver init/deinit functions.

Signed-off-by: default avatarVijendar Mukunda <Vijendar.Mukunda@amd.com>
Reviewed-by: default avatarPierre-Louis Bossart <pierre-louis.bossart@linux.intel.com>
Link: https://lore.kernel.org/r/20200518171704.24999-4-Vijendar.Mukunda@amd.com


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

sound/soc/amd/renoir/rn-pci-acp3x.c

+143 −0
Original line number Diff line number Diff line
@@ -7,13 +7,146 @@ 
#include <linux/pci.h>

#include <linux/module.h>

#include <linux/io.h>

#include <linux/delay.h>



#include "rn_acp3x.h"



static int acp_power_gating;

module_param(acp_power_gating, int, 0644);

MODULE_PARM_DESC(acp_power_gating, "Enable acp power gating");



struct acp_dev_data {

	void __iomem *acp_base;

};



static int rn_acp_power_on(void __iomem *acp_base)

{

	u32 val;

	int timeout;



	val = rn_readl(acp_base + ACP_PGFSM_STATUS);



	if (val == 0)

		return val;



	if ((val & ACP_PGFSM_STATUS_MASK) !=

				ACP_POWER_ON_IN_PROGRESS)

		rn_writel(ACP_PGFSM_CNTL_POWER_ON_MASK,

			  acp_base + ACP_PGFSM_CONTROL);

	timeout = 0;

	while (++timeout < 500) {

		val = rn_readl(acp_base + ACP_PGFSM_STATUS);

		if (!val)

			return 0;

		udelay(1);

	}

	return -ETIMEDOUT;

}



static int rn_acp_power_off(void __iomem *acp_base)

{

	u32 val;

	int timeout;



	rn_writel(ACP_PGFSM_CNTL_POWER_OFF_MASK,

		  acp_base + ACP_PGFSM_CONTROL);

	timeout = 0;

	while (++timeout < 500) {

		val = rn_readl(acp_base + ACP_PGFSM_STATUS);

		if ((val & ACP_PGFSM_STATUS_MASK) == ACP_POWERED_OFF)

			return 0;

		udelay(1);

	}

	return -ETIMEDOUT;

}



static int rn_acp_reset(void __iomem *acp_base)

{

	u32 val;

	int timeout;



	rn_writel(1, acp_base + ACP_SOFT_RESET);

	timeout = 0;

	while (++timeout < 500) {

		val = rn_readl(acp_base + ACP_SOFT_RESET);

		if (val & ACP_SOFT_RESET_SOFTRESET_AUDDONE_MASK)

			break;

		cpu_relax();

	}

	rn_writel(0, acp_base + ACP_SOFT_RESET);

	timeout = 0;

	while (++timeout < 500) {

		val = rn_readl(acp_base + ACP_SOFT_RESET);

		if (!val)

			return 0;

		cpu_relax();

	}

	return -ETIMEDOUT;

}



static void rn_acp_enable_interrupts(void __iomem *acp_base)

{

	u32 ext_intr_ctrl;



	rn_writel(0x01, acp_base + ACP_EXTERNAL_INTR_ENB);

	ext_intr_ctrl = rn_readl(acp_base + ACP_EXTERNAL_INTR_CNTL);

	ext_intr_ctrl |= ACP_ERROR_MASK;

	rn_writel(ext_intr_ctrl, acp_base + ACP_EXTERNAL_INTR_CNTL);

}



static void rn_acp_disable_interrupts(void __iomem *acp_base)

{

	rn_writel(ACP_EXT_INTR_STAT_CLEAR_MASK, acp_base +

		  ACP_EXTERNAL_INTR_STAT);

	rn_writel(0x00, acp_base + ACP_EXTERNAL_INTR_ENB);

}



static int rn_acp_init(void __iomem *acp_base)

{

	int ret;



	/* power on */

	ret = rn_acp_power_on(acp_base);

	if (ret) {

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

		return ret;

	}

	rn_writel(0x01, acp_base + ACP_CONTROL);

	/* Reset */

	ret = rn_acp_reset(acp_base);

	if (ret) {

		pr_err("ACP reset failed\n");

		return ret;

	}

	rn_writel(0x03, acp_base + ACP_CLKMUX_SEL);

	rn_acp_enable_interrupts(acp_base);

	return 0;

}



static int rn_acp_deinit(void __iomem *acp_base)

{

	int ret;



	rn_acp_disable_interrupts(acp_base);

	/* Reset */

	ret = rn_acp_reset(acp_base);

	if (ret) {

		pr_err("ACP reset failed\n");

		return ret;

	}

	rn_writel(0x00, acp_base + ACP_CLKMUX_SEL);

	rn_writel(0x00, acp_base + ACP_CONTROL);

	/* power off */

	if (acp_power_gating) {

		ret = rn_acp_power_off(acp_base);

		if (ret) {

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

			return ret;

		}

	}

	return 0;

}



static int snd_rn_acp_probe(struct pci_dev *pci,

			    const struct pci_device_id *pci_id)

{
@@ -48,6 +181,9 @@ static int snd_rn_acp_probe(struct pci_dev *pci, 
	}

	pci_set_master(pci);

	pci_set_drvdata(pci, adata);

	ret = rn_acp_init(adata->acp_base);

	if (ret)

		goto release_regions;

	return 0;



release_regions:
@@ -60,6 +196,13 @@ static int snd_rn_acp_probe(struct pci_dev *pci, 


static void snd_rn_acp_remove(struct pci_dev *pci)

{

	struct acp_dev_data *adata;

	int ret;



	adata = pci_get_drvdata(pci);

	ret = rn_acp_deinit(adata->acp_base);

	if (ret)

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

	pci_disable_msi(pci);

	pci_release_regions(pci);

	pci_disable_device(pci);

sound/soc/amd/renoir/rn_acp3x.h

+16 −0
Original line number Diff line number Diff line
@@ -9,6 +9,22 @@ 


#define ACP_PHY_BASE_ADDRESS 0x1240000

#define ACP_DEVICE_ID 0x15E2

#define ACP_POWER_ON 0x00

#define ACP_POWER_ON_IN_PROGRESS 0x01

#define ACP_POWER_OFF 0x02

#define ACP_POWER_OFF_IN_PROGRESS 0x03

#define ACP_SOFT_RESET_SOFTRESET_AUDDONE_MASK	0x00010001



#define ACP_PGFSM_CNTL_POWER_ON_MASK    0x01

#define ACP_PGFSM_CNTL_POWER_OFF_MASK   0x00

#define ACP_PGFSM_STATUS_MASK           0x03

#define ACP_POWERED_ON                  0x00

#define ACP_POWER_ON_IN_PROGRESS        0x01

#define ACP_POWERED_OFF                 0x02

#define ACP_POWER_OFF_IN_PROGRESS       0x03



#define ACP_ERROR_MASK 0x20000000

#define ACP_EXT_INTR_STAT_CLEAR_MASK 0xFFFFFFFF



static inline u32 rn_readl(void __iomem *base_addr)

{