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>

diff --git a/sound/soc/amd/ps/acp62.h b/sound/soc/amd/ps/acp62.h
index 5291585f45f99742cc1502691a9fba6067a21f8a..cb07c0656ff2708f0294a0b495f1b6711153e13e 100644 (file)
--- a/sound/soc/amd/ps/acp62.h
+++ b/sound/soc/amd/ps/acp62.h
@@ -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);

diff --git a/sound/soc/amd/ps/pci-ps.c b/sound/soc/amd/ps/pci-ps.c
index 8bb33845622aea13bcd61cf832ebde4f80561fb6..a87dbf8847e65b50f059dfef765592b77f491c9c 100644 (file)
--- a/sound/soc/amd/ps/pci-ps.c
+++ b/sound/soc/amd/ps/pci-ps.c
@@ -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);
 }