162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (C) 2021 Sifive.
462306a36Sopenharmony_ci */
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#include <linux/kernel.h>
762306a36Sopenharmony_ci#include <linux/memory.h>
862306a36Sopenharmony_ci#include <linux/module.h>
962306a36Sopenharmony_ci#include <linux/string.h>
1062306a36Sopenharmony_ci#include <linux/bug.h>
1162306a36Sopenharmony_ci#include <asm/patch.h>
1262306a36Sopenharmony_ci#include <asm/alternative.h>
1362306a36Sopenharmony_ci#include <asm/vendorid_list.h>
1462306a36Sopenharmony_ci#include <asm/errata_list.h>
1562306a36Sopenharmony_ci
1662306a36Sopenharmony_cistruct errata_info_t {
1762306a36Sopenharmony_ci	char name[32];
1862306a36Sopenharmony_ci	bool (*check_func)(unsigned long  arch_id, unsigned long impid);
1962306a36Sopenharmony_ci};
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_cistatic bool errata_cip_453_check_func(unsigned long  arch_id, unsigned long impid)
2262306a36Sopenharmony_ci{
2362306a36Sopenharmony_ci	/*
2462306a36Sopenharmony_ci	 * Affected cores:
2562306a36Sopenharmony_ci	 * Architecture ID: 0x8000000000000007
2662306a36Sopenharmony_ci	 * Implement ID: 0x20181004 <= impid <= 0x20191105
2762306a36Sopenharmony_ci	 */
2862306a36Sopenharmony_ci	if (arch_id != 0x8000000000000007 ||
2962306a36Sopenharmony_ci	    (impid < 0x20181004 || impid > 0x20191105))
3062306a36Sopenharmony_ci		return false;
3162306a36Sopenharmony_ci	return true;
3262306a36Sopenharmony_ci}
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_cistatic bool errata_cip_1200_check_func(unsigned long  arch_id, unsigned long impid)
3562306a36Sopenharmony_ci{
3662306a36Sopenharmony_ci	/*
3762306a36Sopenharmony_ci	 * Affected cores:
3862306a36Sopenharmony_ci	 * Architecture ID: 0x8000000000000007 or 0x1
3962306a36Sopenharmony_ci	 * Implement ID: mimpid[23:0] <= 0x200630 and mimpid != 0x01200626
4062306a36Sopenharmony_ci	 */
4162306a36Sopenharmony_ci	if (arch_id != 0x8000000000000007 && arch_id != 0x1)
4262306a36Sopenharmony_ci		return false;
4362306a36Sopenharmony_ci	if ((impid & 0xffffff) > 0x200630 || impid == 0x1200626)
4462306a36Sopenharmony_ci		return false;
4562306a36Sopenharmony_ci	return true;
4662306a36Sopenharmony_ci}
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_cistatic struct errata_info_t errata_list[ERRATA_SIFIVE_NUMBER] = {
4962306a36Sopenharmony_ci	{
5062306a36Sopenharmony_ci		.name = "cip-453",
5162306a36Sopenharmony_ci		.check_func = errata_cip_453_check_func
5262306a36Sopenharmony_ci	},
5362306a36Sopenharmony_ci	{
5462306a36Sopenharmony_ci		.name = "cip-1200",
5562306a36Sopenharmony_ci		.check_func = errata_cip_1200_check_func
5662306a36Sopenharmony_ci	},
5762306a36Sopenharmony_ci};
5862306a36Sopenharmony_ci
5962306a36Sopenharmony_cistatic u32 __init_or_module sifive_errata_probe(unsigned long archid,
6062306a36Sopenharmony_ci						unsigned long impid)
6162306a36Sopenharmony_ci{
6262306a36Sopenharmony_ci	int idx;
6362306a36Sopenharmony_ci	u32 cpu_req_errata = 0;
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_ci	for (idx = 0; idx < ERRATA_SIFIVE_NUMBER; idx++)
6662306a36Sopenharmony_ci		if (errata_list[idx].check_func(archid, impid))
6762306a36Sopenharmony_ci			cpu_req_errata |= (1U << idx);
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci	return cpu_req_errata;
7062306a36Sopenharmony_ci}
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_cistatic void __init_or_module warn_miss_errata(u32 miss_errata)
7362306a36Sopenharmony_ci{
7462306a36Sopenharmony_ci	int i;
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci	pr_warn("----------------------------------------------------------------\n");
7762306a36Sopenharmony_ci	pr_warn("WARNING: Missing the following errata may cause potential issues\n");
7862306a36Sopenharmony_ci	for (i = 0; i < ERRATA_SIFIVE_NUMBER; i++)
7962306a36Sopenharmony_ci		if (miss_errata & 0x1 << i)
8062306a36Sopenharmony_ci			pr_warn("\tSiFive Errata[%d]:%s\n", i, errata_list[i].name);
8162306a36Sopenharmony_ci	pr_warn("Please enable the corresponding Kconfig to apply them\n");
8262306a36Sopenharmony_ci	pr_warn("----------------------------------------------------------------\n");
8362306a36Sopenharmony_ci}
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_civoid sifive_errata_patch_func(struct alt_entry *begin, struct alt_entry *end,
8662306a36Sopenharmony_ci			      unsigned long archid, unsigned long impid,
8762306a36Sopenharmony_ci			      unsigned int stage)
8862306a36Sopenharmony_ci{
8962306a36Sopenharmony_ci	struct alt_entry *alt;
9062306a36Sopenharmony_ci	u32 cpu_req_errata;
9162306a36Sopenharmony_ci	u32 cpu_apply_errata = 0;
9262306a36Sopenharmony_ci	u32 tmp;
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci	if (stage == RISCV_ALTERNATIVES_EARLY_BOOT)
9562306a36Sopenharmony_ci		return;
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	cpu_req_errata = sifive_errata_probe(archid, impid);
9862306a36Sopenharmony_ci
9962306a36Sopenharmony_ci	for (alt = begin; alt < end; alt++) {
10062306a36Sopenharmony_ci		if (alt->vendor_id != SIFIVE_VENDOR_ID)
10162306a36Sopenharmony_ci			continue;
10262306a36Sopenharmony_ci		if (alt->patch_id >= ERRATA_SIFIVE_NUMBER) {
10362306a36Sopenharmony_ci			WARN(1, "This errata id:%d is not in kernel errata list", alt->patch_id);
10462306a36Sopenharmony_ci			continue;
10562306a36Sopenharmony_ci		}
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ci		tmp = (1U << alt->patch_id);
10862306a36Sopenharmony_ci		if (cpu_req_errata & tmp) {
10962306a36Sopenharmony_ci			mutex_lock(&text_mutex);
11062306a36Sopenharmony_ci			patch_text_nosync(ALT_OLD_PTR(alt), ALT_ALT_PTR(alt),
11162306a36Sopenharmony_ci					  alt->alt_len);
11262306a36Sopenharmony_ci			mutex_unlock(&text_mutex);
11362306a36Sopenharmony_ci			cpu_apply_errata |= tmp;
11462306a36Sopenharmony_ci		}
11562306a36Sopenharmony_ci	}
11662306a36Sopenharmony_ci	if (stage != RISCV_ALTERNATIVES_MODULE &&
11762306a36Sopenharmony_ci	    cpu_apply_errata != cpu_req_errata)
11862306a36Sopenharmony_ci		warn_miss_errata(cpu_req_errata - cpu_apply_errata);
11962306a36Sopenharmony_ci}
120