Unverified Commit 8c7161f2 authored by Vijendar Mukunda's avatar Vijendar Mukunda Committed by Mark Brown
Browse files

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



Add Yellow Carp platform ACP6x PCI driver init/deinit functions.

Signed-off-by: default avatarVijendar Mukunda <Vijendar.Mukunda@amd.com>
Link: https://lore.kernel.org/r/20211018112044.1705805-4-Vijendar.Mukunda@amd.com


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

sound/soc/amd/yc/acp6x.h

+12 −0
Original line number Diff line number Diff line
@@ -10,6 +10,18 @@ 
#define ACP_DEVICE_ID 0x15E2

#define ACP6x_PHY_BASE_ADDRESS 0x1240000



#define ACP_SOFT_RESET_SOFTRESET_AUDDONE_MASK	0x00010001

#define ACP_PGFSM_CNTL_POWER_ON_MASK	1

#define ACP_PGFSM_CNTL_POWER_OFF_MASK	0

#define ACP_PGFSM_STATUS_MASK		3

#define ACP_POWERED_ON			0

#define ACP_POWER_ON_IN_PROGRESS	1

#define ACP_POWERED_OFF			2

#define ACP_POWER_OFF_IN_PROGRESS	3



#define ACP_ERROR_MASK 0x20000000

#define ACP_EXT_INTR_STAT_CLEAR_MASK 0xFFFFFFFF



static inline u32 acp6x_readl(void __iomem *base_addr)

{

	return readl(base_addr - ACP6x_PHY_BASE_ADDRESS);

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

+109 −0
Original line number Diff line number Diff line
@@ -8,6 +8,7 @@ 
#include <linux/pci.h>

#include <linux/module.h>

#include <linux/io.h>

#include <linux/delay.h>



#include "acp6x.h"
@@ -15,6 +16,103 @@ struct acp6x_dev_data { 
	void __iomem *acp6x_base;

};



static int acp6x_power_on(void __iomem *acp_base)

{

	u32 val;

	int timeout;



	val = acp6x_readl(acp_base + ACP_PGFSM_STATUS);



	if (!val)

		return val;



	if ((val & ACP_PGFSM_STATUS_MASK) != ACP_POWER_ON_IN_PROGRESS)

		acp6x_writel(ACP_PGFSM_CNTL_POWER_ON_MASK, acp_base + ACP_PGFSM_CONTROL);

	timeout = 0;

	while (++timeout < 500) {

		val = acp6x_readl(acp_base + ACP_PGFSM_STATUS);

		if (!val)

			return 0;

		udelay(1);

	}

	return -ETIMEDOUT;

}



static int acp6x_reset(void __iomem *acp_base)

{

	u32 val;

	int timeout;



	acp6x_writel(1, acp_base + ACP_SOFT_RESET);

	timeout = 0;

	while (++timeout < 500) {

		val = acp6x_readl(acp_base + ACP_SOFT_RESET);

		if (val & ACP_SOFT_RESET_SOFTRESET_AUDDONE_MASK)

			break;

		cpu_relax();

	}

	acp6x_writel(0, acp_base + ACP_SOFT_RESET);

	timeout = 0;

	while (++timeout < 500) {

		val = acp6x_readl(acp_base + ACP_SOFT_RESET);

		if (!val)

			return 0;

		cpu_relax();

	}

	return -ETIMEDOUT;

}



static void acp6x_enable_interrupts(void __iomem *acp_base)

{

	acp6x_writel(0x01, acp_base + ACP_EXTERNAL_INTR_ENB);

}



static void acp6x_disable_interrupts(void __iomem *acp_base)

{

	acp6x_writel(ACP_EXT_INTR_STAT_CLEAR_MASK, acp_base +

		     ACP_EXTERNAL_INTR_STAT);

	acp6x_writel(0x00, acp_base + ACP_EXTERNAL_INTR_CNTL);

	acp6x_writel(0x00, acp_base + ACP_EXTERNAL_INTR_ENB);

}



static int acp6x_init(void __iomem *acp_base)

{

	int ret;



	/* power on */

	ret = acp6x_power_on(acp_base);

	if (ret) {

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

		return ret;

	}

	acp6x_writel(0x01, acp_base + ACP_CONTROL);

	/* Reset */

	ret = acp6x_reset(acp_base);

	if (ret) {

		pr_err("ACP reset failed\n");

		return ret;

	}

	acp6x_writel(0x03, acp_base + ACP_CLKMUX_SEL);

	acp6x_enable_interrupts(acp_base);

	return 0;

}



static int acp6x_deinit(void __iomem *acp_base)

{

	int ret;



	acp6x_disable_interrupts(acp_base);

	/* Reset */

	ret = acp6x_reset(acp_base);

	if (ret) {

		pr_err("ACP reset failed\n");

		return ret;

	}

	acp6x_writel(0x00, acp_base + ACP_CLKMUX_SEL);

	acp6x_writel(0x00, acp_base + ACP_CONTROL);

	return 0;

}



static int snd_acp6x_probe(struct pci_dev *pci,

			   const struct pci_device_id *pci_id)

{
@@ -53,6 +151,10 @@ static int snd_acp6x_probe(struct pci_dev *pci, 
	}

	pci_set_master(pci);

	pci_set_drvdata(pci, adata);

	ret = acp6x_init(adata->acp6x_base);

	if (ret)

		goto release_regions;



	return 0;

release_regions:

	pci_release_regions(pci);
@@ -64,6 +166,13 @@ static int snd_acp6x_probe(struct pci_dev *pci, 


static void snd_acp6x_remove(struct pci_dev *pci)

{

	struct acp6x_dev_data *adata;

	int ret;



	adata = pci_get_drvdata(pci);

	ret = acp6x_deinit(adata->acp6x_base);

	if (ret)

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

	pci_release_regions(pci);

	pci_disable_device(pci);

}