root/sound/soc/sdca/sdca_fdl.c
// SPDX-License-Identifier: GPL-2.0
// Copyright (C) 2025 Cirrus Logic, Inc. and
//                    Cirrus Logic International Semiconductor Ltd.

/*
 * The MIPI SDCA specification is available for public downloads at
 * https://www.mipi.org/mipi-sdca-v1-0-download
 */

#include <linux/acpi.h>
#include <linux/device.h>
#include <linux/dev_printk.h>
#include <linux/dmi.h>
#include <linux/firmware.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/pm_runtime.h>
#include <linux/regmap.h>
#include <linux/sprintf.h>
#include <linux/soundwire/sdw.h>
#include <linux/soundwire/sdw_registers.h>
#include <sound/sdca.h>
#include <sound/sdca_fdl.h>
#include <sound/sdca_function.h>
#include <sound/sdca_interrupts.h>
#include <sound/sdca_ump.h>

/**
 * sdca_reset_function - send an SDCA function reset
 * @dev: Device pointer for error messages.
 * @function: Pointer to the SDCA Function.
 * @regmap: Pointer to the SDCA Function regmap.
 *
 * Return: Zero on success or a negative error code.
 */
int sdca_reset_function(struct device *dev, struct sdca_function_data *function,
                        struct regmap *regmap)
{
        unsigned int reg = SDW_SDCA_CTL(function->desc->adr,
                                        SDCA_ENTITY_TYPE_ENTITY_0,
                                        SDCA_CTL_ENTITY_0_FUNCTION_ACTION, 0);
        unsigned int val, poll_us;
        int ret;

        ret = regmap_write(regmap, reg, SDCA_CTL_ENTITY_0_RESET_FUNCTION_NOW);
        if (ret) // Allowed for function reset to not be implemented
                return 0;

        if (!function->reset_max_delay) {
                dev_err(dev, "No reset delay specified in DisCo\n");
                return -EINVAL;
        }

        /*
         * Poll up to 16 times but no more than once per ms, these are just
         * arbitrarily selected values, so may be fine tuned in future.
         */
        poll_us = umin(function->reset_max_delay >> 4, 1000);

        ret = regmap_read_poll_timeout(regmap, reg, val, !val, poll_us,
                                       function->reset_max_delay);
        if (ret) {
                dev_err(dev, "Failed waiting for function reset: %d\n", ret);
                return ret;
        }

        return 0;
}
EXPORT_SYMBOL_NS(sdca_reset_function, "SND_SOC_SDCA");

/**
 * sdca_fdl_sync - wait for a function to finish FDL
 * @dev: Device pointer for error messages.
 * @function: Pointer to the SDCA Function.
 * @info: Pointer to the SDCA interrupt info for this device.
 *
 * Return: Zero on success or a negative error code.
 */
int sdca_fdl_sync(struct device *dev, struct sdca_function_data *function,
                  struct sdca_interrupt_info *info)
{
        static const int fdl_retries = 6;
        unsigned long begin_timeout = msecs_to_jiffies(100);
        unsigned long done_timeout = msecs_to_jiffies(4000);
        int nfdl;
        int i, j;

        for (i = 0; i < fdl_retries; i++) {
                nfdl = 0;

                for (j = 0; j < SDCA_MAX_INTERRUPTS; j++) {
                        struct sdca_interrupt *interrupt = &info->irqs[j];
                        struct fdl_state *fdl_state;
                        unsigned long time;

                        if (interrupt->function != function ||
                            !interrupt->entity || !interrupt->control ||
                            interrupt->entity->type != SDCA_ENTITY_TYPE_XU ||
                            interrupt->control->sel != SDCA_CTL_XU_FDL_CURRENTOWNER)
                                continue;

                        fdl_state = interrupt->priv;
                        nfdl++;

                        /*
                         * Looking for timeout without any new FDL requests
                         * to imply the device has completed initial
                         * firmware setup. Alas the specification doesn't
                         * have any mechanism to detect this.
                         */
                        time = wait_for_completion_timeout(&fdl_state->begin,
                                                           begin_timeout);
                        if (!time) {
                                dev_dbg(dev, "no new FDL starts\n");
                                nfdl--;
                                continue;
                        }

                        time = wait_for_completion_timeout(&fdl_state->done,
                                                           done_timeout);
                        if (!time) {
                                dev_err(dev, "timed out waiting for FDL to complete\n");
                                goto error;
                        }
                }

                if (!nfdl)
                        return 0;
        }

        dev_err(dev, "too many FDL requests\n");

error:
        for (j = 0; j < SDCA_MAX_INTERRUPTS; j++) {
                struct sdca_interrupt *interrupt = &info->irqs[j];
                struct fdl_state *fdl_state;

                if (interrupt->function != function ||
                    !interrupt->entity || !interrupt->control ||
                    interrupt->entity->type != SDCA_ENTITY_TYPE_XU ||
                    interrupt->control->sel != SDCA_CTL_XU_FDL_CURRENTOWNER)
                        continue;

                disable_irq(interrupt->irq);

                fdl_state = interrupt->priv;

                sdca_ump_cancel_timeout(&fdl_state->timeout);
        }

        return -ETIMEDOUT;
}
EXPORT_SYMBOL_NS_GPL(sdca_fdl_sync, "SND_SOC_SDCA");

static char *fdl_get_sku_filename(struct device *dev,
                                  struct sdca_fdl_file *fdl_file)
{
        struct device *parent = dev;
        const char *product_vendor;
        const char *product_sku;

        /*
         * Try to find pci_dev manually because the card may not be ready to be
         * used for snd_soc_card_get_pci_ssid yet
         */
        while (parent) {
                if (dev_is_pci(parent)) {
                        struct pci_dev *pci_dev = to_pci_dev(parent);

                        return kasprintf(GFP_KERNEL, "sdca/%x/%x/%x/%x.bin",
                                         fdl_file->vendor_id,
                                         pci_dev->subsystem_vendor,
                                         pci_dev->subsystem_device,
                                         fdl_file->file_id);
                } else {
                        parent = parent->parent;
                }
        }

        product_vendor = dmi_get_system_info(DMI_SYS_VENDOR);
        if (!product_vendor || !strcmp(product_vendor, "Default string"))
                product_vendor = dmi_get_system_info(DMI_BOARD_VENDOR);
        if (!product_vendor || !strcmp(product_vendor, "Default string"))
                product_vendor = dmi_get_system_info(DMI_CHASSIS_VENDOR);
        if (!product_vendor)
                product_vendor = "unknown";

        product_sku = dmi_get_system_info(DMI_PRODUCT_SKU);
        if (!product_sku || !strcmp(product_sku, "Default string"))
                product_sku = dmi_get_system_info(DMI_PRODUCT_NAME);
        if (!product_sku)
                product_sku = "unknown";

        return kasprintf(GFP_KERNEL, "sdca/%x/%s/%s/%x.bin", fdl_file->vendor_id,
                         product_vendor, product_sku, fdl_file->file_id);
}

static int fdl_load_file(struct sdca_interrupt *interrupt,
                         struct sdca_fdl_set *set, int file_index)
{
        struct device *dev = interrupt->dev;
        struct sdca_fdl_data *fdl_data = &interrupt->function->fdl_data;
        const struct firmware *firmware = NULL;
        struct acpi_sw_file *swf = NULL, *tmp;
        struct sdca_fdl_file *fdl_file;
        char *disk_filename;
        int ret;
        int i;

        if (!set) {
                dev_err(dev, "request to load SWF with no set\n");
                return -EINVAL;
        }

        fdl_file = &set->files[file_index];

        if (fdl_data->swft) {
                tmp = fdl_data->swft->files;
                for (i = 0; i < fdl_data->swft->header.length; i += tmp->file_length,
                     tmp = ACPI_ADD_PTR(struct acpi_sw_file, tmp, tmp->file_length)) {
                        if (tmp->vendor_id == fdl_file->vendor_id &&
                            tmp->file_id == fdl_file->file_id) {
                                dev_dbg(dev, "located SWF in ACPI: %x-%x-%x\n",
                                        tmp->vendor_id, tmp->file_id,
                                        tmp->file_version);
                                swf = tmp;
                                break;
                        }
                }
        }

        disk_filename = fdl_get_sku_filename(dev, fdl_file);
        if (!disk_filename)
                return -ENOMEM;

        dev_dbg(dev, "FDL disk filename: %s\n", disk_filename);

        ret = firmware_request_nowarn(&firmware, disk_filename, dev);
        kfree(disk_filename);
        if (ret) {
                disk_filename = kasprintf(GFP_KERNEL, "sdca/%x/%x.bin",
                                          fdl_file->vendor_id, fdl_file->file_id);
                if (!disk_filename)
                        return -ENOMEM;

                dev_dbg(dev, "FDL disk filename: %s\n", disk_filename);

                ret = firmware_request_nowarn(&firmware, disk_filename, dev);
                kfree(disk_filename);
        }

        if (!ret) {
                tmp = (struct acpi_sw_file *)&firmware->data[0];

                if (firmware->size < sizeof(*tmp) ||
                    tmp->file_length != firmware->size) {
                        dev_err(dev, "bad disk SWF size\n");
                } else if (!swf || swf->file_version <= tmp->file_version) {
                        dev_dbg(dev, "using SWF from disk\n");
                        swf = tmp;
                }
        }

        if (!swf) {
                dev_err(dev, "failed to locate SWF\n");
                return -ENOENT;
        }

        dev_info(dev, "loading SWF: %x-%x-%x\n",
                 swf->vendor_id, swf->file_id, swf->file_version);

        ret = sdca_ump_write_message(dev, interrupt->device_regmap,
                                     interrupt->function_regmap,
                                     interrupt->function, interrupt->entity,
                                     SDCA_CTL_XU_FDL_MESSAGEOFFSET, fdl_file->fdl_offset,
                                     SDCA_CTL_XU_FDL_MESSAGELENGTH, swf->data,
                                     swf->file_length - offsetof(struct acpi_sw_file, data));
        release_firmware(firmware);
        return ret;
}

static struct sdca_fdl_set *fdl_get_set(struct sdca_interrupt *interrupt)
{
        struct device *dev = interrupt->dev;
        struct sdca_fdl_data *fdl_data = &interrupt->function->fdl_data;
        struct sdca_entity *xu = interrupt->entity;
        struct sdca_control_range *range;
        unsigned int val;
        int i, ret;

        ret = regmap_read(interrupt->function_regmap,
                          SDW_SDCA_CTL(interrupt->function->desc->adr, xu->id,
                                       SDCA_CTL_XU_FDL_SET_INDEX, 0),
                          &val);
        if (ret < 0) {
                dev_err(dev, "failed to read FDL set index: %d\n", ret);
                return NULL;
        }

        range = sdca_selector_find_range(dev, xu, SDCA_CTL_XU_FDL_SET_INDEX,
                                         SDCA_FDL_SET_INDEX_NCOLS, 0);

        val = sdca_range_search(range, SDCA_FDL_SET_INDEX_SET_NUMBER,
                                val, SDCA_FDL_SET_INDEX_FILE_SET_ID);

        for (i = 0; i < fdl_data->num_sets; i++) {
                if (fdl_data->sets[i].id == val)
                        return &fdl_data->sets[i];
        }

        dev_err(dev, "invalid fileset id: %d\n", val);
        return NULL;
}

static void fdl_end(struct sdca_interrupt *interrupt)
{
        struct fdl_state *fdl_state = interrupt->priv;

        if (!fdl_state->set)
                return;

        fdl_state->set = NULL;

        pm_runtime_put(interrupt->dev);
        complete(&fdl_state->done);

        dev_dbg(interrupt->dev, "completed FDL process\n");
}

static void sdca_fdl_timeout_work(struct work_struct *work)
{
        struct fdl_state *fdl_state = container_of(work, struct fdl_state,
                                                   timeout.work);
        struct sdca_interrupt *interrupt = fdl_state->interrupt;
        struct device *dev = interrupt->dev;

        dev_err(dev, "FDL transaction timed out\n");

        guard(mutex)(&fdl_state->lock);

        fdl_end(interrupt);
        sdca_reset_function(dev, interrupt->function, interrupt->function_regmap);
}

static int fdl_status_process(struct sdca_interrupt *interrupt, unsigned int status)
{
        struct fdl_state *fdl_state = interrupt->priv;
        int ret;

        switch (status) {
        case SDCA_CTL_XU_FDLD_NEEDS_SET:
                dev_dbg(interrupt->dev, "starting FDL process...\n");

                pm_runtime_get(interrupt->dev);
                complete(&fdl_state->begin);

                fdl_state->file_index = 0;
                fdl_state->set = fdl_get_set(interrupt);
                fallthrough;
        case SDCA_CTL_XU_FDLD_MORE_FILES_OK:
                ret = fdl_load_file(interrupt, fdl_state->set, fdl_state->file_index);
                if (ret) {
                        fdl_end(interrupt);
                        return SDCA_CTL_XU_FDLH_REQ_ABORT;
                }

                return SDCA_CTL_XU_FDLH_FILE_AVAILABLE;
        case SDCA_CTL_XU_FDLD_FILE_OK:
                if (!fdl_state->set) {
                        fdl_end(interrupt);
                        return SDCA_CTL_XU_FDLH_REQ_ABORT;
                }

                fdl_state->file_index++;

                if (fdl_state->file_index < fdl_state->set->num_files)
                        return SDCA_CTL_XU_FDLH_MORE_FILES;
                fallthrough;
        case SDCA_CTL_XU_FDLD_COMPLETE:
                fdl_end(interrupt);
                return SDCA_CTL_XU_FDLH_COMPLETE;
        default:
                fdl_end(interrupt);

                if (status & SDCA_CTL_XU_FDLD_REQ_RESET)
                        return SDCA_CTL_XU_FDLH_RESET_ACK;
                else if (status & SDCA_CTL_XU_FDLD_REQ_ABORT)
                        return SDCA_CTL_XU_FDLH_COMPLETE;

                dev_err(interrupt->dev, "invalid FDL status: %x\n", status);
                return -EINVAL;
        }
}

/**
 * sdca_fdl_process - Process the FDL state machine
 * @interrupt: SDCA interrupt structure
 *
 * Based on section 13.2.5 Flow Diagram for File Download, Host side.
 *
 * Return: Zero on success or a negative error code.
 */
int sdca_fdl_process(struct sdca_interrupt *interrupt)
{
        struct device *dev = interrupt->dev;
        struct sdca_entity_xu *xu = &interrupt->entity->xu;
        struct fdl_state *fdl_state = interrupt->priv;
        unsigned int reg, status;
        int response, ret;

        ret = sdca_ump_get_owner_host(dev, interrupt->function_regmap,
                                      interrupt->function, interrupt->entity,
                                      interrupt->control);
        if (ret)
                goto reset_function;

        sdca_ump_cancel_timeout(&fdl_state->timeout);

        scoped_guard(mutex, &fdl_state->lock) {
                reg = SDW_SDCA_CTL(interrupt->function->desc->adr,
                                   interrupt->entity->id, SDCA_CTL_XU_FDL_STATUS, 0);
                ret = regmap_read(interrupt->function_regmap, reg, &status);
                if (ret < 0) {
                        dev_err(dev, "failed to read FDL status: %d\n", ret);
                        return ret;
                }

                dev_dbg(dev, "FDL status: %#x\n", status);

                ret = fdl_status_process(interrupt, status);
                if (ret < 0)
                        goto reset_function;

                response = ret;

                dev_dbg(dev, "FDL response: %#x\n", response);

                ret = regmap_write(interrupt->function_regmap, reg,
                                   response | (status & ~SDCA_CTL_XU_FDLH_MASK));
                if (ret < 0) {
                        dev_err(dev, "failed to set FDL status signal: %d\n", ret);
                        return ret;
                }

                ret = sdca_ump_set_owner_device(dev, interrupt->function_regmap,
                                                interrupt->function,
                                                interrupt->entity,
                                                interrupt->control);
                if (ret)
                        return ret;

                switch (response) {
                case SDCA_CTL_XU_FDLH_RESET_ACK:
                        dev_dbg(dev, "FDL request reset\n");

                        switch (xu->reset_mechanism) {
                        default:
                                dev_warn(dev, "Requested reset mechanism not implemented\n");
                                fallthrough;
                        case SDCA_XU_RESET_FUNCTION:
                                goto reset_function;
                        }
                case SDCA_CTL_XU_FDLH_COMPLETE:
                        if (status & SDCA_CTL_XU_FDLD_REQ_ABORT ||
                            status == SDCA_CTL_XU_FDLD_COMPLETE)
                                return 0;
                        fallthrough;
                default:
                        sdca_ump_schedule_timeout(&fdl_state->timeout, xu->max_delay);
                        return 0;
                }
        }

reset_function:
        sdca_reset_function(dev, interrupt->function, interrupt->function_regmap);

        return ret;
}
EXPORT_SYMBOL_NS_GPL(sdca_fdl_process, "SND_SOC_SDCA");

/**
 * sdca_fdl_alloc_state - allocate state for an FDL interrupt
 * @interrupt: SDCA interrupt structure.
 *
 * Return: Zero on success or a negative error code.
 */
int sdca_fdl_alloc_state(struct sdca_interrupt *interrupt)
{
        struct device *dev = interrupt->dev;
        struct fdl_state *fdl_state;

        fdl_state = devm_kzalloc(dev, sizeof(*fdl_state), GFP_KERNEL);
        if (!fdl_state)
                return -ENOMEM;

        INIT_DELAYED_WORK(&fdl_state->timeout, sdca_fdl_timeout_work);
        init_completion(&fdl_state->begin);
        init_completion(&fdl_state->done);
        mutex_init(&fdl_state->lock);
        fdl_state->interrupt = interrupt;

        interrupt->priv = fdl_state;

        return 0;
}
EXPORT_SYMBOL_NS_GPL(sdca_fdl_alloc_state, "SND_SOC_SDCA");