Quelle  ps-common.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * AMD ACP PCI driver callback routines for ACP6.3, ACP7.0 & ACP7.1
 * platforms.
 *
 * Copyright 2025 Advanced Micro Devices, Inc.
 * Authors: Vijendar Mukunda <Vijendar.Mukunda@amd.com>
 */

#include <linux/bitops.h>
#include <linux/delay.h>
#include <linux/export.h>
#include <linux/io.h>
#include <linux/iopoll.h>
#include <linux/pci.h>
#include <linux/platform_device.h>
#include <linux/pm_runtime.h>
#include <sound/pcm_params.h>

#include "acp63.h"

static int acp63_power_on(void __iomem *acp_base)
{
 u32 val;

 val = readl(acp_base + ACP_PGFSM_STATUS);

 if (!val)
  return val;

 if ((val & ACP63_PGFSM_STATUS_MASK) != ACP63_POWER_ON_IN_PROGRESS)
  writel(ACP63_PGFSM_CNTL_POWER_ON_MASK, acp_base + ACP_PGFSM_CONTROL);

 return readl_poll_timeout(acp_base + ACP_PGFSM_STATUS, val, !val, DELAY_US, ACP63_TIMEOUT);
}

static int acp63_reset(void __iomem *acp_base)
{
 u32 val;
 int ret;

 writel(1, acp_base + ACP_SOFT_RESET);

 ret = readl_poll_timeout(acp_base + ACP_SOFT_RESET, val,
     val & ACP_SOFT_RESET_SOFTRESET_AUDDONE_MASK,
     DELAY_US, ACP63_TIMEOUT);
 if (ret)
  return ret;

 writel(0, acp_base + ACP_SOFT_RESET);

 return readl_poll_timeout(acp_base + ACP_SOFT_RESET, val, !val, DELAY_US, ACP63_TIMEOUT);
}

static void acp63_enable_interrupts(void __iomem *acp_base)
{
 writel(1, acp_base + ACP_EXTERNAL_INTR_ENB);
 writel(ACP_ERROR_IRQ, acp_base + ACP_EXTERNAL_INTR_CNTL);
}

static void acp63_disable_interrupts(void __iomem *acp_base)
{
 writel(ACP_EXT_INTR_STAT_CLEAR_MASK, acp_base + ACP_EXTERNAL_INTR_STAT);
 writel(0, acp_base + ACP_EXTERNAL_INTR_CNTL);
 writel(0, acp_base + ACP_EXTERNAL_INTR_ENB);
}

static int acp63_init(void __iomem *acp_base, struct device *dev)
{
 int ret;

 ret = acp63_power_on(acp_base);
 if (ret) {
  dev_err(dev, "ACP power on failed\n");
  return ret;
 }
 writel(0x01, acp_base + ACP_CONTROL);
 ret = acp63_reset(acp_base);
 if (ret) {
  dev_err(dev, "ACP reset failed\n");
  return ret;
 }
 acp63_enable_interrupts(acp_base);
 writel(0, acp_base + ACP_ZSC_DSP_CTRL);
 return 0;
}

static int acp63_deinit(void __iomem *acp_base, struct device *dev)
{
 int ret;

 acp63_disable_interrupts(acp_base);
 ret = acp63_reset(acp_base);
 if (ret) {
  dev_err(dev, "ACP reset failed\n");
  return ret;
 }
 writel(0, acp_base + ACP_CONTROL);
 writel(1, acp_base + ACP_ZSC_DSP_CTRL);
 return 0;
}

static void acp63_get_config(struct pci_dev *pci, struct acp63_dev_data *acp_data)
{
 u32 config;

 config = readl(acp_data->acp63_base + ACP_PIN_CONFIG);
 dev_dbg(&pci->dev, "ACP config value: %d\n", config);
 switch (config) {
 case ACP_CONFIG_4:
 case ACP_CONFIG_5:
 case ACP_CONFIG_10:
 case ACP_CONFIG_11:
  acp_data->is_pdm_config = true;
  break;
 case ACP_CONFIG_2:
 case ACP_CONFIG_3:
  acp_data->is_sdw_config = true;
  break;
 case ACP_CONFIG_6:
 case ACP_CONFIG_7:
 case ACP_CONFIG_12:
 case ACP_CONFIG_8:
 case ACP_CONFIG_13:
 case ACP_CONFIG_14:
  acp_data->is_pdm_config = true;
  acp_data->is_sdw_config = true;
  break;
 default:
  break;
 }
}

static bool check_acp_sdw_enable_status(struct acp63_dev_data *adata)
{
 u32 sdw0_en, sdw1_en;

 sdw0_en = readl(adata->acp63_base + ACP_SW0_EN);
 sdw1_en = readl(adata->acp63_base + ACP_SW1_EN);
 return (sdw0_en || sdw1_en);
}

static void handle_acp63_sdw_pme_event(struct acp63_dev_data *adata)
{
 u32 val;

 val = readl(adata->acp63_base + ACP_SW0_WAKE_EN);
 if (val && adata->sdw->pdev[0])
  pm_request_resume(&adata->sdw->pdev[0]->dev);

 val = readl(adata->acp63_base + ACP_SW1_WAKE_EN);
 if (val && adata->sdw->pdev[1])
  pm_request_resume(&adata->sdw->pdev[1]->dev);
}

static int __maybe_unused snd_acp63_suspend(struct device *dev)
{
 struct acp63_dev_data *adata;
 int ret;

 adata = dev_get_drvdata(dev);
 if (adata->is_sdw_dev) {
  adata->acp_sw_pad_keeper_en = readl(adata->acp63_base + ACP_SW0_PAD_KEEPER_EN);
  adata->acp_pad_pulldown_ctrl = readl(adata->acp63_base + ACP_PAD_PULLDOWN_CTRL);
  adata->sdw_en_stat = check_acp_sdw_enable_status(adata);
  if (adata->sdw_en_stat) {
   writel(1, adata->acp63_base + ACP_ZSC_DSP_CTRL);
   return 0;
  }
 }
 ret = acp_hw_deinit(adata, dev);
 if (ret)
  dev_err(dev, "ACP de-init failed\n");

 return ret;
}

static int __maybe_unused snd_acp63_runtime_resume(struct device *dev)
{
 struct acp63_dev_data *adata;
 int ret;

 adata = dev_get_drvdata(dev);
 if (adata->sdw_en_stat) {
  writel(0, adata->acp63_base + ACP_ZSC_DSP_CTRL);
  return 0;
 }
 ret = acp_hw_init(adata, dev);
 if (ret) {
  dev_err(dev, "ACP init failed\n");
  return ret;
 }

 if (!adata->sdw_en_stat)
  handle_acp63_sdw_pme_event(adata);
 return 0;
}

static int __maybe_unused snd_acp63_resume(struct device *dev)
{
 struct acp63_dev_data *adata;
 u32 acp_sw_pad_keeper_en;
 int ret;

 adata = dev_get_drvdata(dev);
 if (adata->sdw_en_stat) {
  writel(0, adata->acp63_base + ACP_ZSC_DSP_CTRL);
  return 0;
 }

 ret = acp_hw_init(adata, dev);
 if (ret)
  dev_err(dev, "ACP init failed\n");

 acp_sw_pad_keeper_en = readl(adata->acp63_base + ACP_SW0_PAD_KEEPER_EN);
 dev_dbg(dev, "ACP_SW0_PAD_KEEPER_EN:0x%x\n", acp_sw_pad_keeper_en);
 if (!acp_sw_pad_keeper_en) {
  writel(adata->acp_sw_pad_keeper_en, adata->acp63_base + ACP_SW0_PAD_KEEPER_EN);
  writel(adata->acp_pad_pulldown_ctrl, adata->acp63_base + ACP_PAD_PULLDOWN_CTRL);
 }
 return ret;
}

static void acp63_sdw_dma_irq_thread(struct acp63_dev_data *adata)
{
 struct sdw_dma_dev_data *sdw_data;
 u32 stream_id;

 sdw_data = dev_get_drvdata(&adata->sdw_dma_dev->dev);

 for (stream_id = 0; stream_id < ACP63_SDW0_DMA_MAX_STREAMS; stream_id++) {
  if (adata->acp63_sdw0_dma_intr_stat[stream_id]) {
   if (sdw_data->acp63_sdw0_dma_stream[stream_id])
    snd_pcm_period_elapsed(sdw_data->acp63_sdw0_dma_stream[stream_id]);
   adata->acp63_sdw0_dma_intr_stat[stream_id] = 0;
  }
 }
 for (stream_id = 0; stream_id < ACP63_SDW1_DMA_MAX_STREAMS; stream_id++) {
  if (adata->acp63_sdw1_dma_intr_stat[stream_id]) {
   if (sdw_data->acp63_sdw1_dma_stream[stream_id])
    snd_pcm_period_elapsed(sdw_data->acp63_sdw1_dma_stream[stream_id]);
   adata->acp63_sdw1_dma_intr_stat[stream_id] = 0;
  }
 }
}

void acp63_hw_init_ops(struct acp_hw_ops *hw_ops)
{
 hw_ops->acp_init = acp63_init;
 hw_ops->acp_deinit = acp63_deinit;
 hw_ops->acp_get_config = acp63_get_config;
 hw_ops->acp_sdw_dma_irq_thread = acp63_sdw_dma_irq_thread;
 hw_ops->acp_suspend = snd_acp63_suspend;
 hw_ops->acp_resume = snd_acp63_resume;
 hw_ops->acp_suspend_runtime = snd_acp63_suspend;
 hw_ops->acp_resume_runtime = snd_acp63_runtime_resume;
}

static int acp70_power_on(void __iomem *acp_base)
{
 u32 val = 0;

 val = readl(acp_base + ACP_PGFSM_STATUS);

 if (!val)
  return 0;
 if (val & ACP70_PGFSM_STATUS_MASK)
  writel(ACP70_PGFSM_CNTL_POWER_ON_MASK, acp_base + ACP_PGFSM_CONTROL);

 return readl_poll_timeout(acp_base + ACP_PGFSM_STATUS, val, !val, DELAY_US, ACP70_TIMEOUT);
}

static int acp70_reset(void __iomem *acp_base)
{
 u32 val;
 int ret;

 writel(1, acp_base + ACP_SOFT_RESET);

 ret = readl_poll_timeout(acp_base + ACP_SOFT_RESET, val,
     val & ACP_SOFT_RESET_SOFTRESET_AUDDONE_MASK,
     DELAY_US, ACP70_TIMEOUT);
 if (ret)
  return ret;

 writel(0, acp_base + ACP_SOFT_RESET);

 return readl_poll_timeout(acp_base + ACP_SOFT_RESET, val, !val, DELAY_US, ACP70_TIMEOUT);
}

static void acp70_enable_sdw_host_wake_interrupts(void __iomem *acp_base)
{
 u32 ext_intr_cntl1;

 ext_intr_cntl1 = readl(acp_base + ACP_EXTERNAL_INTR_CNTL1);
 ext_intr_cntl1 |= ACP70_SDW_HOST_WAKE_MASK;
 writel(ext_intr_cntl1, acp_base + ACP_EXTERNAL_INTR_CNTL1);
}

static void acp70_enable_interrupts(void __iomem *acp_base)
{
 u32 sdw0_wake_en, sdw1_wake_en;

 writel(1, acp_base + ACP_EXTERNAL_INTR_ENB);
 writel(ACP_ERROR_IRQ, acp_base + ACP_EXTERNAL_INTR_CNTL);
 sdw0_wake_en = readl(acp_base + ACP_SW0_WAKE_EN);
 sdw1_wake_en = readl(acp_base + ACP_SW1_WAKE_EN);
 if (sdw0_wake_en || sdw1_wake_en)
  acp70_enable_sdw_host_wake_interrupts(acp_base);
}

static void acp70_disable_interrupts(void __iomem *acp_base)
{
 writel(ACP_EXT_INTR_STAT_CLEAR_MASK, acp_base + ACP_EXTERNAL_INTR_STAT);
 writel(0, acp_base + ACP_EXTERNAL_INTR_CNTL);
 writel(0, acp_base + ACP_EXTERNAL_INTR_ENB);
}

static int acp70_init(void __iomem *acp_base, struct device *dev)
{
 int ret;

 ret = acp70_power_on(acp_base);
 if (ret) {
  dev_err(dev, "ACP power on failed\n");
  return ret;
 }
 writel(0x01, acp_base + ACP_CONTROL);
 ret = acp70_reset(acp_base);
 if (ret) {
  dev_err(dev, "ACP reset failed\n");
  return ret;
 }
 writel(0, acp_base + ACP_ZSC_DSP_CTRL);
 acp70_enable_interrupts(acp_base);
 writel(0x1, acp_base + ACP_PME_EN);
 return 0;
}

static int acp70_deinit(void __iomem *acp_base, struct device *dev)
{
 int ret;

 acp70_disable_interrupts(acp_base);
 ret = acp70_reset(acp_base);
 if (ret) {
  dev_err(dev, "ACP reset failed\n");
  return ret;
 }
 writel(0x01, acp_base + ACP_ZSC_DSP_CTRL);
 return 0;
}

static void acp70_get_config(struct pci_dev *pci, struct acp63_dev_data *acp_data)
{
 u32 config;

 config = readl(acp_data->acp63_base + ACP_PIN_CONFIG);
 dev_dbg(&pci->dev, "ACP config value: %d\n", config);
 switch (config) {
 case ACP_CONFIG_4:
 case ACP_CONFIG_5:
 case ACP_CONFIG_10:
 case ACP_CONFIG_11:
 case ACP_CONFIG_20:
  acp_data->is_pdm_config = true;
  break;
 case ACP_CONFIG_2:
 case ACP_CONFIG_3:
 case ACP_CONFIG_16:
  acp_data->is_sdw_config = true;
  break;
 case ACP_CONFIG_6:
 case ACP_CONFIG_7:
 case ACP_CONFIG_12:
 case ACP_CONFIG_8:
 case ACP_CONFIG_13:
 case ACP_CONFIG_14:
 case ACP_CONFIG_17:
 case ACP_CONFIG_18:
 case ACP_CONFIG_19:
  acp_data->is_pdm_config = true;
  acp_data->is_sdw_config = true;
  break;
 default:
  break;
 }
}

static void acp70_sdw_dma_irq_thread(struct acp63_dev_data *adata)
{
 struct sdw_dma_dev_data *sdw_data;
 u32 stream_id;

 sdw_data = dev_get_drvdata(&adata->sdw_dma_dev->dev);

 for (stream_id = 0; stream_id < ACP70_SDW0_DMA_MAX_STREAMS; stream_id++) {
  if (adata->acp70_sdw0_dma_intr_stat[stream_id]) {
   if (sdw_data->acp70_sdw0_dma_stream[stream_id])
    snd_pcm_period_elapsed(sdw_data->acp70_sdw0_dma_stream[stream_id]);
   adata->acp70_sdw0_dma_intr_stat[stream_id] = 0;
  }
 }
 for (stream_id = 0; stream_id < ACP70_SDW1_DMA_MAX_STREAMS; stream_id++) {
  if (adata->acp70_sdw1_dma_intr_stat[stream_id]) {
   if (sdw_data->acp70_sdw1_dma_stream[stream_id])
    snd_pcm_period_elapsed(sdw_data->acp70_sdw1_dma_stream[stream_id]);
   adata->acp70_sdw1_dma_intr_stat[stream_id] = 0;
  }
 }
}

static int __maybe_unused snd_acp70_suspend(struct device *dev)
{
 struct acp63_dev_data *adata;
 int ret;

 adata = dev_get_drvdata(dev);
 if (adata->is_sdw_dev) {
  adata->acp_sw_pad_keeper_en = readl(adata->acp63_base + ACP_SW0_PAD_KEEPER_EN);
  adata->acp_pad_pulldown_ctrl = readl(adata->acp63_base + ACP_PAD_PULLDOWN_CTRL);
  adata->sdw_en_stat = check_acp_sdw_enable_status(adata);
  if (adata->sdw_en_stat) {
   writel(1, adata->acp63_base + ACP_ZSC_DSP_CTRL);
   return 0;
  }
 }
 ret = acp_hw_deinit(adata, dev);
 if (ret)
  dev_err(dev, "ACP de-init failed\n");

 return ret;
}

static int __maybe_unused snd_acp70_runtime_resume(struct device *dev)
{
 struct acp63_dev_data *adata;
 int ret;

 adata = dev_get_drvdata(dev);

 if (adata->sdw_en_stat) {
  writel(0, adata->acp63_base + ACP_ZSC_DSP_CTRL);
  writel(1, adata->acp63_base + ACP_PME_EN);
  return 0;
 }

 ret = acp_hw_init(adata, dev);
 if (ret) {
  dev_err(dev, "ACP init failed\n");
  return ret;
 }
 return 0;
}

static int __maybe_unused snd_acp70_resume(struct device *dev)
{
 struct acp63_dev_data *adata;
 u32 acp_sw_pad_keeper_en;
 int ret;

 adata = dev_get_drvdata(dev);

 if (adata->sdw_en_stat) {
  writel(0, adata->acp63_base + ACP_ZSC_DSP_CTRL);
  writel(1, adata->acp63_base + ACP_PME_EN);
  return 0;
 }

 ret = acp_hw_init(adata, dev);
 if (ret)
  dev_err(dev, "ACP init failed\n");

 acp_sw_pad_keeper_en = readl(adata->acp63_base + ACP_SW0_PAD_KEEPER_EN);
 dev_dbg(dev, "ACP_SW0_PAD_KEEPER_EN:0x%x\n", acp_sw_pad_keeper_en);
 if (!acp_sw_pad_keeper_en) {
  writel(adata->acp_sw_pad_keeper_en, adata->acp63_base + ACP_SW0_PAD_KEEPER_EN);
  writel(adata->acp_pad_pulldown_ctrl, adata->acp63_base + ACP_PAD_PULLDOWN_CTRL);
 }
 return ret;
}

void acp70_hw_init_ops(struct acp_hw_ops *hw_ops)
{
 hw_ops->acp_init = acp70_init;
 hw_ops->acp_deinit = acp70_deinit;
 hw_ops->acp_get_config = acp70_get_config;
 hw_ops->acp_sdw_dma_irq_thread = acp70_sdw_dma_irq_thread;
 hw_ops->acp_suspend = snd_acp70_suspend;
 hw_ops->acp_resume = snd_acp70_resume;
 hw_ops->acp_suspend_runtime = snd_acp70_suspend;
 hw_ops->acp_resume_runtime = snd_acp70_runtime_resume;
}