// SPDX-License-Identifier: GPL-2.0-only
/*
 * Erratas to be applied for Andes CPU cores
 *
 *  Copyright (C) 2023 Renesas Electronics Corporation.
 *
 * Author: Lad Prabhakar <prabhakar.mahadev-lad.rj@bp.renesas.com>
 */

#include <linux/memory.h>
#include <linux/module.h>

#include <asm/alternative.h>
#include <asm/cacheflush.h>
#include <asm/errata_list.h>
#include <asm/text-patching.h>
#include <asm/processor.h>
#include <asm/sbi.h>
#include <asm/vendorid_list.h>
#include <asm/vendor_extensions.h>

#define ANDES_AX45MP_MARCHID            0x8000000000008a45UL
#define ANDES_AX45MP_MIMPID             0x500UL
#define ANDES_SBI_EXT_ANDES             0x0900031E

#define ANDES_SBI_EXT_IOCP_SW_WORKAROUND        1

static long ax45mp_iocp_sw_workaround(void)
{
        struct sbiret ret;

        /*
         * ANDES_SBI_EXT_IOCP_SW_WORKAROUND SBI EXT checks if the IOCP is missing and
         * cache is controllable only then CMO will be applied to the platform.
         */
        ret = sbi_ecall(ANDES_SBI_EXT_ANDES, ANDES_SBI_EXT_IOCP_SW_WORKAROUND,
                        0, 0, 0, 0, 0, 0);

        return ret.error ? 0 : ret.value;
}

static void errata_probe_iocp(unsigned int stage, unsigned long arch_id, unsigned long impid)
{
        static bool done;

        if (!IS_ENABLED(CONFIG_ERRATA_ANDES_CMO))
                return;

        if (done)
                return;

        done = true;

        if (arch_id != ANDES_AX45MP_MARCHID || impid != ANDES_AX45MP_MIMPID)
                return;

        if (!ax45mp_iocp_sw_workaround())
                return;

        /* Set this just to make core cbo code happy */
        riscv_cbom_block_size = 1;
        riscv_noncoherent_supported();
}

void __init_or_module andes_errata_patch_func(struct alt_entry *begin, struct alt_entry *end,
                                              unsigned long archid, unsigned long impid,
                                              unsigned int stage)
{
        BUILD_BUG_ON(ERRATA_ANDES_NUMBER >= RISCV_VENDOR_EXT_ALTERNATIVES_BASE);

        if (stage == RISCV_ALTERNATIVES_BOOT)
                errata_probe_iocp(stage, archid, impid);

        /* we have nothing to patch here ATM so just return back */
}