root/sound/soc/sof/amd/acp-common.c
// SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
//
// This file is provided under a dual BSD/GPLv2 license. When using or
// redistributing this file, you may do so under either license.
//
// Copyright(c) 2022 Advanced Micro Devices, Inc.
//
// Authors: Ajit Kumar Pandey <AjitKumar.Pandey@amd.com>
//          V sujith kumar Reddy <Vsujithkumar.Reddy@amd.com>

/* ACP-specific Common code */

#include "../sof-priv.h"
#include "../sof-audio.h"
#include "../ops.h"
#include "acp.h"
#include "acp-dsp-offset.h"
#include <sound/sof/xtensa.h>

/**
 * amd_sof_ipc_dump() - This function is called when IPC tx times out.
 * @sdev: SOF device.
 */
void amd_sof_ipc_dump(struct snd_sof_dev *sdev)
{
        const struct sof_amd_acp_desc *desc = get_chip_info(sdev->pdata);
        u32 base = desc->dsp_intr_base;
        u32 dsp_msg_write = sdev->debug_box.offset +
                            offsetof(struct scratch_ipc_conf, sof_dsp_msg_write);
        u32 dsp_ack_write = sdev->debug_box.offset +
                            offsetof(struct scratch_ipc_conf, sof_dsp_ack_write);
        u32 host_msg_write = sdev->debug_box.offset +
                             offsetof(struct scratch_ipc_conf, sof_host_msg_write);
        u32 host_ack_write = sdev->debug_box.offset +
                             offsetof(struct scratch_ipc_conf, sof_host_ack_write);
        u32 dsp_msg, dsp_ack, host_msg, host_ack, irq_stat;

        dsp_msg = snd_sof_dsp_read(sdev, ACP_DSP_BAR, ACP_SCRATCH_REG_0 + dsp_msg_write);
        dsp_ack = snd_sof_dsp_read(sdev, ACP_DSP_BAR, ACP_SCRATCH_REG_0 + dsp_ack_write);
        host_msg = snd_sof_dsp_read(sdev, ACP_DSP_BAR, ACP_SCRATCH_REG_0 + host_msg_write);
        host_ack = snd_sof_dsp_read(sdev, ACP_DSP_BAR, ACP_SCRATCH_REG_0 + host_ack_write);
        irq_stat = snd_sof_dsp_read(sdev, ACP_DSP_BAR, base + DSP_SW_INTR_STAT_OFFSET);

        dev_err(sdev->dev,
                "dsp_msg = %#x dsp_ack = %#x host_msg = %#x host_ack = %#x irq_stat = %#x\n",
                dsp_msg, dsp_ack, host_msg, host_ack, irq_stat);
}

/**
 * amd_get_registers() - This function is called in case of DSP oops
 * in order to gather information about the registers, filename and
 * linenumber and stack.
 * @sdev: SOF device.
 * @xoops: Stores information about registers.
 * @panic_info: Stores information about filename and line number.
 * @stack: Stores the stack dump.
 * @stack_words: Size of the stack dump.
 */
static void amd_get_registers(struct snd_sof_dev *sdev,
                              struct sof_ipc_dsp_oops_xtensa *xoops,
                              struct sof_ipc_panic_info *panic_info,
                              u32 *stack, size_t stack_words)
{
        u32 offset = sdev->dsp_oops_offset;

        /* first read registers */
        acp_mailbox_read(sdev, offset, xoops, sizeof(*xoops));

        /* then get panic info */
        if (xoops->arch_hdr.totalsize > EXCEPT_MAX_HDR_SIZE) {
                dev_err(sdev->dev, "invalid header size 0x%x. FW oops is bogus\n",
                        xoops->arch_hdr.totalsize);
                return;
        }

        offset += xoops->arch_hdr.totalsize;
        acp_mailbox_read(sdev, offset, panic_info, sizeof(*panic_info));

        /* then get the stack */
        offset += sizeof(*panic_info);
        acp_mailbox_read(sdev, offset, stack, stack_words * sizeof(u32));
}

/**
 * amd_sof_dump() - This function is called when a panic message is
 * received from the firmware.
 * @sdev: SOF device.
 * @flags: parameter not used but required by ops prototype
 */
void amd_sof_dump(struct snd_sof_dev *sdev, u32 flags)
{
        struct sof_ipc_dsp_oops_xtensa xoops;
        struct sof_ipc_panic_info panic_info;
        u32 stack[AMD_STACK_DUMP_SIZE];
        u32 status;

        /* Get information about the panic status from the debug box area.
         * Compute the trace point based on the status.
         */
        if (sdev->dsp_oops_offset > sdev->debug_box.offset) {
                acp_mailbox_read(sdev, sdev->debug_box.offset, &status, sizeof(u32));
        } else {
                /* Read DSP Panic status from dsp_box.
                 * As window information for exception box offset and size is not available
                 * before FW_READY
                 */
                acp_mailbox_read(sdev, sdev->dsp_box.offset, &status, sizeof(u32));
                sdev->dsp_oops_offset = sdev->dsp_box.offset + sizeof(status);
        }

        /* Get information about the registers, the filename and line
         * number and the stack.
         */
        amd_get_registers(sdev, &xoops, &panic_info, stack, AMD_STACK_DUMP_SIZE);

        /* Print the information to the console */
        sof_print_oops_and_stack(sdev, KERN_ERR, status, status, &xoops,
                                 &panic_info, stack, AMD_STACK_DUMP_SIZE);
}

#if IS_ENABLED(CONFIG_SND_SOC_SOF_AMD_SOUNDWIRE)
static int amd_sof_sdw_get_slave_info(struct snd_sof_dev *sdev)
{
        struct acp_dev_data *acp_data = sdev->pdata->hw_pdata;

        return sdw_amd_get_slave_info(acp_data->sdw);
}

static struct snd_soc_acpi_mach *amd_sof_sdw_machine_select(struct snd_sof_dev *sdev)
{
        struct snd_soc_acpi_mach *mach;
        const struct snd_soc_acpi_link_adr *link;
        struct acp_dev_data *acp_data = sdev->pdata->hw_pdata;
        int ret, i;

        if (acp_data->info.count) {
                ret = amd_sof_sdw_get_slave_info(sdev);
                if (ret) {
                        dev_info(sdev->dev, "failed to read slave information\n");
                        return NULL;
                }
                for (mach = sdev->pdata->desc->alt_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(sdev->dev, link,
                                                                        acp_data->sdw->peripherals))
                                        break;
                        }
                        if (i == acp_data->info.count || !link->num_adr)
                                break;
                }
                if (mach && mach->link_mask) {
                        mach->mach_params.subsystem_rev = acp_data->pci_rev;
                        mach->mach_params.links = mach->links;
                        mach->mach_params.link_mask = mach->link_mask;
                        mach->mach_params.platform = dev_name(sdev->dev);
                        return mach;
                }
        }
        dev_info(sdev->dev, "No SoundWire machine driver found\n");
        return NULL;
}

#else
static struct snd_soc_acpi_mach *amd_sof_sdw_machine_select(struct snd_sof_dev *sdev)
{
        return NULL;
}
#endif

struct snd_soc_acpi_mach *amd_sof_machine_select(struct snd_sof_dev *sdev)
{
        struct snd_sof_pdata *sof_pdata = sdev->pdata;
        struct acp_dev_data *acp_data = sdev->pdata->hw_pdata;
        const struct sof_dev_desc *desc = sof_pdata->desc;
        struct snd_soc_acpi_mach *mach = NULL;

        if (desc->machines)
                mach = snd_soc_acpi_find_machine(desc->machines);
        if (!mach) {
                mach = amd_sof_sdw_machine_select(sdev);
                if (!mach) {
                        dev_warn(sdev->dev, "No matching ASoC machine driver found\n");
                        return NULL;
                }
        }

        mach->mach_params.subsystem_rev = acp_data->pci_rev;
        sof_pdata->tplg_filename = mach->sof_tplg_filename;
        sof_pdata->fw_filename = mach->fw_filename;

        return mach;
}

/* AMD Common DSP ops */
const struct snd_sof_dsp_ops sof_acp_common_ops = {
        /* probe and remove */
        .probe                  = amd_sof_acp_probe,
        .remove                 = amd_sof_acp_remove,

        /* Register IO */
        .write                  = sof_io_write,
        .read                   = sof_io_read,

        /* Block IO */
        .block_read             = acp_dsp_block_read,
        .block_write            = acp_dsp_block_write,

        /*Firmware loading */
        .load_firmware          = snd_sof_load_firmware_memcpy,
        .pre_fw_run             = acp_dsp_pre_fw_run,
        .get_bar_index          = acp_get_bar_index,

        /* DSP core boot */
        .run                    = acp_sof_dsp_run,

        /*IPC */
        .send_msg               = acp_sof_ipc_send_msg,
        .ipc_msg_data           = acp_sof_ipc_msg_data,
        .set_stream_data_offset = acp_set_stream_data_offset,
        .get_mailbox_offset     = acp_sof_ipc_get_mailbox_offset,
        .get_window_offset      = acp_sof_ipc_get_window_offset,
        .irq_thread             = acp_sof_ipc_irq_thread,

        /* stream callbacks */
        .pcm_open               = acp_pcm_open,
        .pcm_close              = acp_pcm_close,
        .pcm_hw_params          = acp_pcm_hw_params,
        .pcm_pointer            = acp_pcm_pointer,

        .hw_info                = SNDRV_PCM_INFO_MMAP |
                                  SNDRV_PCM_INFO_MMAP_VALID |
                                  SNDRV_PCM_INFO_INTERLEAVED |
                                  SNDRV_PCM_INFO_PAUSE |
                                  SNDRV_PCM_INFO_NO_PERIOD_WAKEUP,

        /* Machine driver callbacks */
        .machine_select         = amd_sof_machine_select,
        .machine_register       = sof_machine_register,
        .machine_unregister     = sof_machine_unregister,

        /* Trace Logger */
        .trace_init             = acp_sof_trace_init,
        .trace_release          = acp_sof_trace_release,

        /* PM */
        .suspend                = amd_sof_acp_suspend,
        .resume                 = amd_sof_acp_resume,

        .ipc_dump               = amd_sof_ipc_dump,
        .dbg_dump               = amd_sof_dump,
        .debugfs_add_region_item = snd_sof_debugfs_add_region_item_iomem,
        .dsp_arch_ops = &sof_xtensa_arch_ops,

        /* probe client device registation */
        .register_ipc_clients = acp_probes_register,
        .unregister_ipc_clients = acp_probes_unregister,
};
EXPORT_SYMBOL_NS(sof_acp_common_ops, "SND_SOC_SOF_AMD_COMMON");

MODULE_LICENSE("Dual BSD/GPL");
MODULE_DESCRIPTION("ACP SOF COMMON Driver");
MODULE_IMPORT_NS("SND_SOC_SOF_AMD_COMMON");
MODULE_IMPORT_NS("SND_SOC_SOF_XTENSA");
MODULE_IMPORT_NS("SOUNDWIRE_AMD_INIT");