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

Add RPL Platform ACP init/de-init functions.

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

diff --git a/sound/soc/amd/rpl/rpl-pci-acp6x.c b/sound/soc/amd/rpl/rpl-pci-acp6x.c
index 7a82a97..71ae90a 100644 (file)
--- a/sound/soc/amd/rpl/rpl-pci-acp6x.c
+++ b/sound/soc/amd/rpl/rpl-pci-acp6x.c
@@ -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 @@ disable_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);
 }