| // SPDX-License-Identifier: GPL-2.0-only |
| /* |
| * AMD Pink Sardine ACP PCI Driver |
| * |
| * Copyright 2022 Advanced Micro Devices, Inc. |
| */ |
| |
| #include <linux/pci.h> |
| #include <linux/bitops.h> |
| #include <linux/module.h> |
| #include <linux/io.h> |
| #include <linux/delay.h> |
| #include <linux/platform_device.h> |
| #include <linux/acpi.h> |
| #include <linux/interrupt.h> |
| #include <sound/pcm_params.h> |
| #include <linux/pm_runtime.h> |
| #include <linux/iopoll.h> |
| #include <linux/soundwire/sdw_amd.h> |
| #include "../mach-config.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 & ACP_PGFSM_STATUS_MASK) != ACP_POWER_ON_IN_PROGRESS) |
| writel(ACP_PGFSM_CNTL_POWER_ON_MASK, acp_base + ACP_PGFSM_CONTROL); |
| |
| return readl_poll_timeout(acp_base + ACP_PGFSM_STATUS, val, !val, DELAY_US, ACP_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, ACP_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, ACP_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); |
| 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); |
| return 0; |
| } |
| |
| static irqreturn_t acp63_irq_thread(int irq, void *context) |
| { |
| struct sdw_dma_dev_data *sdw_dma_data; |
| struct acp63_dev_data *adata = context; |
| u32 stream_index; |
| |
| sdw_dma_data = dev_get_drvdata(&adata->sdw_dma_dev->dev); |
| |
| for (stream_index = 0; stream_index < ACP63_SDW0_DMA_MAX_STREAMS; stream_index++) { |
| if (adata->sdw0_dma_intr_stat[stream_index]) { |
| if (sdw_dma_data->sdw0_dma_stream[stream_index]) |
| snd_pcm_period_elapsed(sdw_dma_data->sdw0_dma_stream[stream_index]); |
| adata->sdw0_dma_intr_stat[stream_index] = 0; |
| } |
| } |
| for (stream_index = 0; stream_index < ACP63_SDW1_DMA_MAX_STREAMS; stream_index++) { |
| if (adata->sdw1_dma_intr_stat[stream_index]) { |
| if (sdw_dma_data->sdw1_dma_stream[stream_index]) |
| snd_pcm_period_elapsed(sdw_dma_data->sdw1_dma_stream[stream_index]); |
| adata->sdw1_dma_intr_stat[stream_index] = 0; |
| } |
| } |
| return IRQ_HANDLED; |
| } |
| |
| static irqreturn_t acp63_irq_handler(int irq, void *dev_id) |
| { |
| struct acp63_dev_data *adata; |
| struct pdm_dev_data *ps_pdm_data; |
| struct amd_sdw_manager *amd_manager; |
| u32 ext_intr_stat, ext_intr_stat1; |
| u32 stream_id = 0; |
| u16 irq_flag = 0; |
| u16 sdw_dma_irq_flag = 0; |
| u16 index; |
| |
| adata = dev_id; |
| if (!adata) |
| return IRQ_NONE; |
| /* ACP interrupts will be cleared by reading particular bit and writing |
| * same value to the status register. writing zero's doesn't have any |
| * effect. |
| * Bit by bit checking of IRQ field is implemented. |
| */ |
| ext_intr_stat = readl(adata->acp63_base + ACP_EXTERNAL_INTR_STAT); |
| if (ext_intr_stat & ACP_SDW0_STAT) { |
| writel(ACP_SDW0_STAT, adata->acp63_base + ACP_EXTERNAL_INTR_STAT); |
| amd_manager = dev_get_drvdata(&adata->sdw->pdev[0]->dev); |
| if (amd_manager) |
| schedule_work(&amd_manager->amd_sdw_irq_thread); |
| irq_flag = 1; |
| } |
| |
| ext_intr_stat1 = readl(adata->acp63_base + ACP_EXTERNAL_INTR_STAT1); |
| if (ext_intr_stat1 & ACP_SDW1_STAT) { |
| writel(ACP_SDW1_STAT, adata->acp63_base + ACP_EXTERNAL_INTR_STAT1); |
| amd_manager = dev_get_drvdata(&adata->sdw->pdev[1]->dev); |
| if (amd_manager) |
| schedule_work(&amd_manager->amd_sdw_irq_thread); |
| irq_flag = 1; |
| } |
| |
| if (ext_intr_stat & ACP_ERROR_IRQ) { |
| writel(ACP_ERROR_IRQ, adata->acp63_base + ACP_EXTERNAL_INTR_STAT); |
| /* TODO: Report SoundWire Manager instance errors */ |
| writel(0, adata->acp63_base + ACP_SW0_I2S_ERROR_REASON); |
| writel(0, adata->acp63_base + ACP_SW1_I2S_ERROR_REASON); |
| writel(0, adata->acp63_base + ACP_ERROR_STATUS); |
| irq_flag = 1; |
| } |
| |
| if (ext_intr_stat & BIT(PDM_DMA_STAT)) { |
| ps_pdm_data = dev_get_drvdata(&adata->pdm_dev->dev); |
| writel(BIT(PDM_DMA_STAT), adata->acp63_base + ACP_EXTERNAL_INTR_STAT); |
| if (ps_pdm_data->capture_stream) |
| snd_pcm_period_elapsed(ps_pdm_data->capture_stream); |
| irq_flag = 1; |
| } |
| if (ext_intr_stat & ACP_SDW_DMA_IRQ_MASK) { |
| for (index = ACP_AUDIO2_RX_THRESHOLD; index <= ACP_AUDIO0_TX_THRESHOLD; index++) { |
| if (ext_intr_stat & BIT(index)) { |
| writel(BIT(index), adata->acp63_base + ACP_EXTERNAL_INTR_STAT); |
| switch (index) { |
| case ACP_AUDIO0_TX_THRESHOLD: |
| stream_id = ACP_SDW0_AUDIO0_TX; |
| break; |
| case ACP_AUDIO1_TX_THRESHOLD: |
| stream_id = ACP_SDW0_AUDIO1_TX; |
| break; |
| case ACP_AUDIO2_TX_THRESHOLD: |
| stream_id = ACP_SDW0_AUDIO2_TX; |
| break; |
| case ACP_AUDIO0_RX_THRESHOLD: |
| stream_id = ACP_SDW0_AUDIO0_RX; |
| break; |
| case ACP_AUDIO1_RX_THRESHOLD: |
| stream_id = ACP_SDW0_AUDIO1_RX; |
| break; |
| case ACP_AUDIO2_RX_THRESHOLD: |
| stream_id = ACP_SDW0_AUDIO2_RX; |
| break; |
| } |
| |
| adata->sdw0_dma_intr_stat[stream_id] = 1; |
| sdw_dma_irq_flag = 1; |
| } |
| } |
| } |
| |
| if (ext_intr_stat1 & ACP_P1_AUDIO1_RX_THRESHOLD) { |
| writel(ACP_P1_AUDIO1_RX_THRESHOLD, |
| adata->acp63_base + ACP_EXTERNAL_INTR_STAT1); |
| adata->sdw1_dma_intr_stat[ACP_SDW1_AUDIO1_RX] = 1; |
| sdw_dma_irq_flag = 1; |
| } |
| |
| if (ext_intr_stat1 & ACP_P1_AUDIO1_TX_THRESHOLD) { |
| writel(ACP_P1_AUDIO1_TX_THRESHOLD, |
| adata->acp63_base + ACP_EXTERNAL_INTR_STAT1); |
| adata->sdw1_dma_intr_stat[ACP_SDW1_AUDIO1_TX] = 1; |
| sdw_dma_irq_flag = 1; |
| } |
| |
| if (sdw_dma_irq_flag) |
| return IRQ_WAKE_THREAD; |
| |
| if (irq_flag) |
| return IRQ_HANDLED; |
| else |
| return IRQ_NONE; |
| } |
| |
| #if IS_ENABLED(CONFIG_SND_SOC_AMD_SOUNDWIRE) |
| static int acp_scan_sdw_devices(struct device *dev, u64 addr) |
| { |
| struct acpi_device *sdw_dev; |
| struct acp63_dev_data *acp_data; |
| |
| acp_data = dev_get_drvdata(dev); |
| if (!addr) |
| return -ENODEV; |
| |
| sdw_dev = acpi_find_child_device(ACPI_COMPANION(dev), addr, 0); |
| if (!sdw_dev) |
| return -ENODEV; |
| |
| acp_data->info.handle = sdw_dev->handle; |
| acp_data->info.count = AMD_SDW_MAX_MANAGERS; |
| return amd_sdw_scan_controller(&acp_data->info); |
| } |
| |
| static int amd_sdw_probe(struct device *dev) |
| { |
| struct acp63_dev_data *acp_data; |
| struct sdw_amd_res sdw_res; |
| int ret; |
| |
| acp_data = dev_get_drvdata(dev); |
| memset(&sdw_res, 0, sizeof(sdw_res)); |
| sdw_res.addr = acp_data->addr; |
| sdw_res.reg_range = acp_data->reg_range; |
| sdw_res.handle = acp_data->info.handle; |
| sdw_res.parent = dev; |
| sdw_res.dev = dev; |
| sdw_res.acp_lock = &acp_data->acp_lock; |
| sdw_res.count = acp_data->info.count; |
| sdw_res.mmio_base = acp_data->acp63_base; |
| sdw_res.link_mask = acp_data->info.link_mask; |
| ret = sdw_amd_probe(&sdw_res, &acp_data->sdw); |
| if (ret) |
| dev_err(dev, "error: SoundWire probe failed\n"); |
| return ret; |
| } |
| |
| static int amd_sdw_exit(struct acp63_dev_data *acp_data) |
| { |
| if (acp_data->sdw) |
| sdw_amd_exit(acp_data->sdw); |
| acp_data->sdw = NULL; |
| |
| return 0; |
| } |
| |
| static struct snd_soc_acpi_mach *acp63_sdw_machine_select(struct device *dev) |
| { |
| struct snd_soc_acpi_mach *mach; |
| const struct snd_soc_acpi_link_adr *link; |
| struct acp63_dev_data *acp_data = dev_get_drvdata(dev); |
| int ret, i; |
| |
| if (acp_data->info.count) { |
| ret = sdw_amd_get_slave_info(acp_data->sdw); |
| if (ret) { |
| dev_dbg(dev, "failed to read slave information\n"); |
| return NULL; |
| } |
| for (mach = acp_data->machines; mach; mach++) { |
| if (!mach->links) |
| break; |
| link = mach->links; |
| for (i = 0; i < acp_data->info.count && link->num_adr; link++, i++) { |
| if (!snd_soc_acpi_sdw_link_slaves_found(dev, link, |
| acp_data->sdw->ids, |
| acp_data->sdw->num_slaves)) |
| break; |
| } |
| if (i == acp_data->info.count || !link->num_adr) |
| break; |
| } |
| if (mach && mach->link_mask) { |
| mach->mach_params.links = mach->links; |
| mach->mach_params.link_mask = mach->link_mask; |
| return mach; |
| } |
| } |
| dev_dbg(dev, "No SoundWire machine driver found\n"); |
| return NULL; |
| } |
| #else |
| static int acp_scan_sdw_devices(struct device *dev, u64 addr) |
| { |
| return 0; |
| } |
| |
| static int amd_sdw_probe(struct device *dev) |
| { |
| return 0; |
| } |
| |
| static int amd_sdw_exit(struct acp63_dev_data *acp_data) |
| { |
| return 0; |
| } |
| |
| static struct snd_soc_acpi_mach *acp63_sdw_machine_select(struct device *dev) |
| { |
| return NULL; |
| } |
| #endif |
| |
| static int acp63_machine_register(struct device *dev) |
| { |
| struct snd_soc_acpi_mach *mach; |
| struct acp63_dev_data *adata = dev_get_drvdata(dev); |
| int size; |
| |
| if (adata->is_sdw_dev && adata->is_sdw_config) { |
| size = sizeof(*adata->machines); |
| mach = acp63_sdw_machine_select(dev); |
| if (mach) { |
| adata->mach_dev = platform_device_register_data(dev, mach->drv_name, |
| PLATFORM_DEVID_NONE, mach, |
| size); |
| if (IS_ERR(adata->mach_dev)) { |
| dev_err(dev, |
| "cannot register Machine device for SoundWire Interface\n"); |
| return PTR_ERR(adata->mach_dev); |
| } |
| } |
| |
| } else if (adata->is_pdm_dev && !adata->is_sdw_dev && adata->is_pdm_config) { |
| adata->mach_dev = platform_device_register_data(dev, "acp_ps_mach", |
| PLATFORM_DEVID_NONE, NULL, 0); |
| if (IS_ERR(adata->mach_dev)) { |
| dev_err(dev, "cannot register amd_ps_mach device\n"); |
| return PTR_ERR(adata->mach_dev); |
| } |
| } |
| return 0; |
| } |
| |
| static int get_acp63_device_config(struct pci_dev *pci, struct acp63_dev_data *acp_data) |
| { |
| struct acpi_device *pdm_dev; |
| const union acpi_object *obj; |
| u32 config; |
| bool is_dmic_dev = false; |
| bool is_sdw_dev = false; |
| int ret; |
| |
| config = readl(acp_data->acp63_base + ACP_PIN_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; |
| } |
| |
| if (acp_data->is_pdm_config) { |
| pdm_dev = acpi_find_child_device(ACPI_COMPANION(&pci->dev), ACP63_DMIC_ADDR, 0); |
| if (pdm_dev) { |
| /* is_dmic_dev flag will be set when ACP PDM controller device exists */ |
| if (!acpi_dev_get_property(pdm_dev, "acp-audio-device-type", |
| ACPI_TYPE_INTEGER, &obj) && |
| obj->integer.value == ACP_DMIC_DEV) |
| is_dmic_dev = true; |
| } |
| } |
| |
| if (acp_data->is_sdw_config) { |
| ret = acp_scan_sdw_devices(&pci->dev, ACP63_SDW_ADDR); |
| if (!ret && acp_data->info.link_mask) |
| is_sdw_dev = true; |
| } |
| |
| acp_data->is_pdm_dev = is_dmic_dev; |
| acp_data->is_sdw_dev = is_sdw_dev; |
| if (!is_dmic_dev && !is_sdw_dev) { |
| dev_dbg(&pci->dev, "No PDM or SoundWire manager devices found\n"); |
| return -ENODEV; |
| } |
| return 0; |
| } |
| |
| static void acp63_fill_platform_dev_info(struct platform_device_info *pdevinfo, |
| struct device *parent, |
| struct fwnode_handle *fw_node, |
| char *name, unsigned int id, |
| const struct resource *res, |
| unsigned int num_res, |
| const void *data, |
| size_t size_data) |
| { |
| pdevinfo->name = name; |
| pdevinfo->id = id; |
| pdevinfo->parent = parent; |
| pdevinfo->num_res = num_res; |
| pdevinfo->res = res; |
| pdevinfo->data = data; |
| pdevinfo->size_data = size_data; |
| pdevinfo->fwnode = fw_node; |
| } |
| |
| static int create_acp63_platform_devs(struct pci_dev *pci, struct acp63_dev_data *adata, u32 addr) |
| { |
| struct platform_device_info pdevinfo; |
| struct device *parent; |
| int ret; |
| |
| parent = &pci->dev; |
| |
| if (adata->is_sdw_dev || adata->is_pdm_dev) { |
| adata->res = devm_kzalloc(&pci->dev, sizeof(struct resource), GFP_KERNEL); |
| if (!adata->res) { |
| ret = -ENOMEM; |
| goto de_init; |
| } |
| adata->res->flags = IORESOURCE_MEM; |
| adata->res->start = addr; |
| adata->res->end = addr + (ACP63_REG_END - ACP63_REG_START); |
| memset(&pdevinfo, 0, sizeof(pdevinfo)); |
| } |
| |
| if (adata->is_pdm_dev && adata->is_pdm_config) { |
| acp63_fill_platform_dev_info(&pdevinfo, parent, NULL, "acp_ps_pdm_dma", |
| 0, adata->res, 1, NULL, 0); |
| |
| adata->pdm_dev = platform_device_register_full(&pdevinfo); |
| if (IS_ERR(adata->pdm_dev)) { |
| dev_err(&pci->dev, |
| "cannot register %s device\n", pdevinfo.name); |
| ret = PTR_ERR(adata->pdm_dev); |
| goto de_init; |
| } |
| memset(&pdevinfo, 0, sizeof(pdevinfo)); |
| acp63_fill_platform_dev_info(&pdevinfo, parent, NULL, "dmic-codec", |
| 0, NULL, 0, NULL, 0); |
| adata->dmic_codec_dev = platform_device_register_full(&pdevinfo); |
| if (IS_ERR(adata->dmic_codec_dev)) { |
| dev_err(&pci->dev, |
| "cannot register %s device\n", pdevinfo.name); |
| ret = PTR_ERR(adata->dmic_codec_dev); |
| goto unregister_pdm_dev; |
| } |
| } |
| if (adata->is_sdw_dev && adata->is_sdw_config) { |
| ret = amd_sdw_probe(&pci->dev); |
| if (ret) { |
| if (adata->is_pdm_dev) |
| goto unregister_dmic_codec_dev; |
| else |
| goto de_init; |
| } |
| memset(&pdevinfo, 0, sizeof(pdevinfo)); |
| acp63_fill_platform_dev_info(&pdevinfo, parent, NULL, "amd_ps_sdw_dma", |
| 0, adata->res, 1, NULL, 0); |
| |
| adata->sdw_dma_dev = platform_device_register_full(&pdevinfo); |
| if (IS_ERR(adata->sdw_dma_dev)) { |
| dev_err(&pci->dev, |
| "cannot register %s device\n", pdevinfo.name); |
| ret = PTR_ERR(adata->sdw_dma_dev); |
| if (adata->is_pdm_dev) |
| goto unregister_dmic_codec_dev; |
| else |
| goto de_init; |
| } |
| } |
| |
| return 0; |
| unregister_dmic_codec_dev: |
| platform_device_unregister(adata->dmic_codec_dev); |
| unregister_pdm_dev: |
| platform_device_unregister(adata->pdm_dev); |
| de_init: |
| if (acp63_deinit(adata->acp63_base, &pci->dev)) |
| dev_err(&pci->dev, "ACP de-init failed\n"); |
| return ret; |
| } |
| |
| static int snd_acp63_probe(struct pci_dev *pci, |
| const struct pci_device_id *pci_id) |
| { |
| struct acp63_dev_data *adata; |
| u32 addr; |
| u32 irqflags, flag; |
| int ret; |
| |
| irqflags = IRQF_SHARED; |
| |
| /* Return if acp config flag is defined */ |
| flag = snd_amd_acp_find_config(pci); |
| if (flag) |
| return -ENODEV; |
| |
| /* Pink Sardine device check */ |
| switch (pci->revision) { |
| case 0x63: |
| break; |
| default: |
| dev_dbg(&pci->dev, "acp63 pci device not found\n"); |
| return -ENODEV; |
| } |
| if (pci_enable_device(pci)) { |
| dev_err(&pci->dev, "pci_enable_device failed\n"); |
| return -ENODEV; |
| } |
| |
| ret = pci_request_regions(pci, "AMD ACP6.2 audio"); |
| if (ret < 0) { |
| dev_err(&pci->dev, "pci_request_regions failed\n"); |
| goto disable_pci; |
| } |
| adata = devm_kzalloc(&pci->dev, sizeof(struct acp63_dev_data), |
| GFP_KERNEL); |
| if (!adata) { |
| ret = -ENOMEM; |
| goto release_regions; |
| } |
| |
| addr = pci_resource_start(pci, 0); |
| adata->acp63_base = devm_ioremap(&pci->dev, addr, |
| pci_resource_len(pci, 0)); |
| if (!adata->acp63_base) { |
| ret = -ENOMEM; |
| goto release_regions; |
| } |
| adata->addr = addr; |
| adata->reg_range = ACP63_REG_END - ACP63_REG_START; |
| pci_set_master(pci); |
| pci_set_drvdata(pci, adata); |
| mutex_init(&adata->acp_lock); |
| ret = acp63_init(adata->acp63_base, &pci->dev); |
| if (ret) |
| goto release_regions; |
| ret = devm_request_threaded_irq(&pci->dev, pci->irq, acp63_irq_handler, |
| acp63_irq_thread, irqflags, "ACP_PCI_IRQ", adata); |
| if (ret) { |
| dev_err(&pci->dev, "ACP PCI IRQ request failed\n"); |
| goto de_init; |
| } |
| ret = get_acp63_device_config(pci, adata); |
| /* ACP PCI driver probe should be continued even PDM or SoundWire Devices are not found */ |
| if (ret) { |
| dev_dbg(&pci->dev, "get acp device config failed:%d\n", ret); |
| goto skip_pdev_creation; |
| } |
| ret = create_acp63_platform_devs(pci, adata, addr); |
| if (ret < 0) { |
| dev_err(&pci->dev, "ACP platform devices creation failed\n"); |
| goto de_init; |
| } |
| ret = acp63_machine_register(&pci->dev); |
| if (ret) { |
| dev_err(&pci->dev, "ACP machine register failed\n"); |
| goto de_init; |
| } |
| skip_pdev_creation: |
| device_set_wakeup_enable(&pci->dev, true); |
| pm_runtime_set_autosuspend_delay(&pci->dev, ACP_SUSPEND_DELAY_MS); |
| pm_runtime_use_autosuspend(&pci->dev); |
| pm_runtime_put_noidle(&pci->dev); |
| pm_runtime_allow(&pci->dev); |
| return 0; |
| de_init: |
| if (acp63_deinit(adata->acp63_base, &pci->dev)) |
| dev_err(&pci->dev, "ACP de-init failed\n"); |
| release_regions: |
| pci_release_regions(pci); |
| disable_pci: |
| pci_disable_device(pci); |
| |
| return ret; |
| } |
| |
| 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->sdw_en_stat = check_acp_sdw_enable_status(adata); |
| if (adata->sdw_en_stat) |
| return 0; |
| } |
| ret = acp63_deinit(adata->acp63_base, 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) |
| return 0; |
| |
| ret = acp63_init(adata->acp63_base, 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; |
| int ret; |
| |
| adata = dev_get_drvdata(dev); |
| if (adata->sdw_en_stat) |
| return 0; |
| |
| ret = acp63_init(adata->acp63_base, dev); |
| if (ret) |
| dev_err(dev, "ACP init failed\n"); |
| |
| return ret; |
| } |
| |
| static const struct dev_pm_ops acp63_pm_ops = { |
| SET_RUNTIME_PM_OPS(snd_acp63_suspend, snd_acp63_runtime_resume, NULL) |
| SET_SYSTEM_SLEEP_PM_OPS(snd_acp63_suspend, snd_acp63_resume) |
| }; |
| |
| static void snd_acp63_remove(struct pci_dev *pci) |
| { |
| struct acp63_dev_data *adata; |
| int ret; |
| |
| adata = pci_get_drvdata(pci); |
| if (adata->sdw) { |
| amd_sdw_exit(adata); |
| platform_device_unregister(adata->sdw_dma_dev); |
| } |
| if (adata->is_pdm_dev) { |
| platform_device_unregister(adata->pdm_dev); |
| platform_device_unregister(adata->dmic_codec_dev); |
| } |
| if (adata->mach_dev) |
| platform_device_unregister(adata->mach_dev); |
| ret = acp63_deinit(adata->acp63_base, &pci->dev); |
| if (ret) |
| dev_err(&pci->dev, "ACP de-init failed\n"); |
| pm_runtime_forbid(&pci->dev); |
| pm_runtime_get_noresume(&pci->dev); |
| pci_release_regions(pci); |
| pci_disable_device(pci); |
| } |
| |
| static const struct pci_device_id snd_acp63_ids[] = { |
| { PCI_DEVICE(PCI_VENDOR_ID_AMD, ACP_DEVICE_ID), |
| .class = PCI_CLASS_MULTIMEDIA_OTHER << 8, |
| .class_mask = 0xffffff }, |
| { 0, }, |
| }; |
| MODULE_DEVICE_TABLE(pci, snd_acp63_ids); |
| |
| static struct pci_driver ps_acp63_driver = { |
| .name = KBUILD_MODNAME, |
| .id_table = snd_acp63_ids, |
| .probe = snd_acp63_probe, |
| .remove = snd_acp63_remove, |
| .driver = { |
| .pm = &acp63_pm_ops, |
| } |
| }; |
| |
| module_pci_driver(ps_acp63_driver); |
| |
| MODULE_AUTHOR("Vijendar.Mukunda@amd.com"); |
| MODULE_AUTHOR("Syed.SabaKareem@amd.com"); |
| MODULE_DESCRIPTION("AMD ACP Pink Sardine PCI driver"); |
| MODULE_IMPORT_NS(SOUNDWIRE_AMD_INIT); |
| MODULE_IMPORT_NS(SND_AMD_SOUNDWIRE_ACPI); |
| MODULE_LICENSE("GPL v2"); |