mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-02 00:24:12 +08:00
ASoC: amd: add acp6.2 init/de-init functions
Add Pink Sardine platform ACP6.2 PCI driver init/deinit functions. Signed-off-by: Syed Saba Kareem <Syed.SabaKareem@amd.com> Signed-off-by: Vijendar Mukunda <Vijendar.Mukunda@amd.com> Link: https://lore.kernel.org/r/20220827165657.2343818-4-Syed.SabaKareem@amd.com Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
parent
95e43a170b
commit
9766bb62cf
@ -9,6 +9,18 @@
|
||||
|
||||
#define ACP_DEVICE_ID 0x15E2
|
||||
|
||||
#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 acp62_readl(void __iomem *base_addr)
|
||||
{
|
||||
return readl(base_addr);
|
||||
|
@ -8,6 +8,7 @@
|
||||
#include <linux/pci.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/delay.h>
|
||||
|
||||
#include "acp62.h"
|
||||
|
||||
@ -15,6 +16,100 @@ struct acp62_dev_data {
|
||||
void __iomem *acp62_base;
|
||||
};
|
||||
|
||||
static int acp62_power_on(void __iomem *acp_base)
|
||||
{
|
||||
u32 val;
|
||||
int timeout;
|
||||
|
||||
val = acp62_readl(acp_base + ACP_PGFSM_STATUS);
|
||||
|
||||
if (!val)
|
||||
return val;
|
||||
|
||||
if ((val & ACP_PGFSM_STATUS_MASK) != ACP_POWER_ON_IN_PROGRESS)
|
||||
acp62_writel(ACP_PGFSM_CNTL_POWER_ON_MASK, acp_base + ACP_PGFSM_CONTROL);
|
||||
timeout = 0;
|
||||
while (++timeout < 500) {
|
||||
val = acp62_readl(acp_base + ACP_PGFSM_STATUS);
|
||||
if (!val)
|
||||
return 0;
|
||||
udelay(1);
|
||||
}
|
||||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
static int acp62_reset(void __iomem *acp_base)
|
||||
{
|
||||
u32 val;
|
||||
int timeout;
|
||||
|
||||
acp62_writel(1, acp_base + ACP_SOFT_RESET);
|
||||
timeout = 0;
|
||||
while (++timeout < 500) {
|
||||
val = acp62_readl(acp_base + ACP_SOFT_RESET);
|
||||
if (val & ACP_SOFT_RESET_SOFTRESET_AUDDONE_MASK)
|
||||
break;
|
||||
cpu_relax();
|
||||
}
|
||||
acp62_writel(0, acp_base + ACP_SOFT_RESET);
|
||||
timeout = 0;
|
||||
while (++timeout < 500) {
|
||||
val = acp62_readl(acp_base + ACP_SOFT_RESET);
|
||||
if (!val)
|
||||
return 0;
|
||||
cpu_relax();
|
||||
}
|
||||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
static void acp62_enable_interrupts(void __iomem *acp_base)
|
||||
{
|
||||
acp62_writel(1, acp_base + ACP_EXTERNAL_INTR_ENB);
|
||||
}
|
||||
|
||||
static void acp62_disable_interrupts(void __iomem *acp_base)
|
||||
{
|
||||
acp62_writel(ACP_EXT_INTR_STAT_CLEAR_MASK, acp_base +
|
||||
ACP_EXTERNAL_INTR_STAT);
|
||||
acp62_writel(0, acp_base + ACP_EXTERNAL_INTR_CNTL);
|
||||
acp62_writel(0, acp_base + ACP_EXTERNAL_INTR_ENB);
|
||||
}
|
||||
|
||||
static int acp62_init(void __iomem *acp_base, struct device *dev)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = acp62_power_on(acp_base);
|
||||
if (ret) {
|
||||
dev_err(dev, "ACP power on failed\n");
|
||||
return ret;
|
||||
}
|
||||
acp62_writel(0x01, acp_base + ACP_CONTROL);
|
||||
ret = acp62_reset(acp_base);
|
||||
if (ret) {
|
||||
dev_err(dev, "ACP reset failed\n");
|
||||
return ret;
|
||||
}
|
||||
acp62_writel(0x03, acp_base + ACP_CLKMUX_SEL);
|
||||
acp62_enable_interrupts(acp_base);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int acp62_deinit(void __iomem *acp_base, struct device *dev)
|
||||
{
|
||||
int ret;
|
||||
|
||||
acp62_disable_interrupts(acp_base);
|
||||
ret = acp62_reset(acp_base);
|
||||
if (ret) {
|
||||
dev_err(dev, "ACP reset failed\n");
|
||||
return ret;
|
||||
}
|
||||
acp62_writel(0, acp_base + ACP_CLKMUX_SEL);
|
||||
acp62_writel(0, acp_base + ACP_CONTROL);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int snd_acp62_probe(struct pci_dev *pci,
|
||||
const struct pci_device_id *pci_id)
|
||||
{
|
||||
@ -56,6 +151,10 @@ static int snd_acp62_probe(struct pci_dev *pci,
|
||||
}
|
||||
pci_set_master(pci);
|
||||
pci_set_drvdata(pci, adata);
|
||||
ret = acp62_init(adata->acp62_base, &pci->dev);
|
||||
if (ret)
|
||||
goto release_regions;
|
||||
|
||||
return 0;
|
||||
release_regions:
|
||||
pci_release_regions(pci);
|
||||
@ -67,6 +166,13 @@ disable_pci:
|
||||
|
||||
static void snd_acp62_remove(struct pci_dev *pci)
|
||||
{
|
||||
struct acp62_dev_data *adata;
|
||||
int ret;
|
||||
|
||||
adata = pci_get_drvdata(pci);
|
||||
ret = acp62_deinit(adata->acp62_base, &pci->dev);
|
||||
if (ret)
|
||||
dev_err(&pci->dev, "ACP de-init failed\n");
|
||||
pci_release_regions(pci);
|
||||
pci_disable_device(pci);
|
||||
}
|
||||
|
Loading…
Reference in New Issue
Block a user