Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * APEI Error INJection support
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * EINJ provides a hardware error injection mechanism, this is useful
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  * for debugging and testing of other APEI and RAS features.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  * For more information about EINJ, please refer to ACPI Specification
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  * version 4.0, section 17.5.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  * Copyright 2009-2010 Intel Corp.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  *   Author: Huang Ying <ying.huang@intel.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/debugfs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/seq_file.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <linux/nmi.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #include <asm/unaligned.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #include "apei-internal.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) #undef pr_fmt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #define pr_fmt(fmt) "EINJ: " fmt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #define SPIN_UNIT		100			/* 100ns */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) /* Firmware should respond within 1 milliseconds */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #define FIRMWARE_TIMEOUT	(1 * NSEC_PER_MSEC)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) #define ACPI5_VENDOR_BIT	BIT(31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #define MEM_ERROR_MASK		(ACPI_EINJ_MEMORY_CORRECTABLE | \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 				ACPI_EINJ_MEMORY_UNCORRECTABLE | \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 				ACPI_EINJ_MEMORY_FATAL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40)  * ACPI version 5 provides a SET_ERROR_TYPE_WITH_ADDRESS action.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) static int acpi5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) struct set_error_type_with_address {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	u32	type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	u32	vendor_extension;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	u32	flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	u32	apicid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	u64	memory_address;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	u64	memory_address_range;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	u32	pcie_sbdf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) enum {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	SETWA_FLAGS_APICID = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	SETWA_FLAGS_MEM = 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	SETWA_FLAGS_PCIE_SBDF = 4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60)  * Vendor extensions for platform specific operations
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) struct vendor_error_type_extension {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	u32	length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	u32	pcie_sbdf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	u16	vendor_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	u16	device_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	u8	rev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	u8	reserved[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) static u32 notrigger;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) static u32 vendor_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) static struct debugfs_blob_wrapper vendor_blob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) static char vendor_dev[64];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78)  * Some BIOSes allow parameters to the SET_ERROR_TYPE entries in the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79)  * EINJ table through an unpublished extension. Use with caution as
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80)  * most will ignore the parameter and make their own choice of address
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81)  * for error injection.  This extension is used only if
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82)  * param_extension module parameter is specified.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) struct einj_parameter {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	u64 type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	u64 reserved1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	u64 reserved2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	u64 param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	u64 param2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) #define EINJ_OP_BUSY			0x1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) #define EINJ_STATUS_SUCCESS		0x0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) #define EINJ_STATUS_FAIL		0x1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) #define EINJ_STATUS_INVAL		0x2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) #define EINJ_TAB_ENTRY(tab)						\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	((struct acpi_whea_header *)((char *)(tab) +			\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 				    sizeof(struct acpi_table_einj)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) static bool param_extension;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) module_param(param_extension, bool, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) static struct acpi_table_einj *einj_tab;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) static struct apei_resources einj_resources;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) static struct apei_exec_ins_type einj_ins_type[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	[ACPI_EINJ_READ_REGISTER] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 		.flags = APEI_EXEC_INS_ACCESS_REGISTER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 		.run   = apei_exec_read_register,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	[ACPI_EINJ_READ_REGISTER_VALUE] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 		.flags = APEI_EXEC_INS_ACCESS_REGISTER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 		.run   = apei_exec_read_register_value,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	[ACPI_EINJ_WRITE_REGISTER] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		.flags = APEI_EXEC_INS_ACCESS_REGISTER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 		.run   = apei_exec_write_register,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	[ACPI_EINJ_WRITE_REGISTER_VALUE] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 		.flags = APEI_EXEC_INS_ACCESS_REGISTER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 		.run   = apei_exec_write_register_value,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	[ACPI_EINJ_NOOP] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 		.flags = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 		.run   = apei_exec_noop,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)  * Prevent EINJ interpreter to run simultaneously, because the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)  * corresponding firmware implementation may not work properly when
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)  * invoked simultaneously.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) static DEFINE_MUTEX(einj_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) static void *einj_param;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) static void einj_exec_ctx_init(struct apei_exec_context *ctx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	apei_exec_ctx_init(ctx, einj_ins_type, ARRAY_SIZE(einj_ins_type),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 			   EINJ_TAB_ENTRY(einj_tab), einj_tab->entries);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static int __einj_get_available_error_type(u32 *type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	struct apei_exec_context ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	einj_exec_ctx_init(&ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	rc = apei_exec_run(&ctx, ACPI_EINJ_GET_ERROR_TYPE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 		return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	*type = apei_exec_ctx_get_output(&ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) /* Get error injection capabilities of the platform */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) static int einj_get_available_error_type(u32 *type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	mutex_lock(&einj_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	rc = __einj_get_available_error_type(type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	mutex_unlock(&einj_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) static int einj_timedout(u64 *t)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	if ((s64)*t < SPIN_UNIT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 		pr_warn(FW_WARN "Firmware does not respond in time\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	*t -= SPIN_UNIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	ndelay(SPIN_UNIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	touch_nmi_watchdog();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) static void check_vendor_extension(u64 paddr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 				   struct set_error_type_with_address *v5param)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	int	offset = v5param->vendor_extension;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	struct	vendor_error_type_extension *v;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 	u32	sbdf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	if (!offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	v = acpi_os_map_iomem(paddr + offset, sizeof(*v));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	if (!v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	sbdf = v->pcie_sbdf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 	sprintf(vendor_dev, "%x:%x:%x.%x vendor_id=%x device_id=%x rev_id=%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 		sbdf >> 24, (sbdf >> 16) & 0xff,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 		(sbdf >> 11) & 0x1f, (sbdf >> 8) & 0x7,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 		 v->vendor_id, v->device_id, v->rev_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	acpi_os_unmap_iomem(v, sizeof(*v));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) static void *einj_get_parameter_address(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	u64 pa_v4 = 0, pa_v5 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	struct acpi_whea_header *entry;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 	entry = EINJ_TAB_ENTRY(einj_tab);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	for (i = 0; i < einj_tab->entries; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 		if (entry->action == ACPI_EINJ_SET_ERROR_TYPE &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 		    entry->instruction == ACPI_EINJ_WRITE_REGISTER &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 		    entry->register_region.space_id ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 		    ACPI_ADR_SPACE_SYSTEM_MEMORY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 			pa_v4 = get_unaligned(&entry->register_region.address);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 		if (entry->action == ACPI_EINJ_SET_ERROR_TYPE_WITH_ADDRESS &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 		    entry->instruction == ACPI_EINJ_WRITE_REGISTER &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 		    entry->register_region.space_id ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 		    ACPI_ADR_SPACE_SYSTEM_MEMORY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 			pa_v5 = get_unaligned(&entry->register_region.address);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 		entry++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 	if (pa_v5) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 		struct set_error_type_with_address *v5param;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 		v5param = acpi_os_map_iomem(pa_v5, sizeof(*v5param));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 		if (v5param) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 			acpi5 = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 			check_vendor_extension(pa_v5, v5param);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 			return v5param;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	if (param_extension && pa_v4) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 		struct einj_parameter *v4param;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 		v4param = acpi_os_map_iomem(pa_v4, sizeof(*v4param));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 		if (!v4param)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 			return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 		if (v4param->reserved1 || v4param->reserved2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 			acpi_os_unmap_iomem(v4param, sizeof(*v4param));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 			return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 		return v4param;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) /* do sanity check to trigger table */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) static int einj_check_trigger_header(struct acpi_einj_trigger *trigger_tab)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	if (trigger_tab->header_size != sizeof(struct acpi_einj_trigger))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	if (trigger_tab->table_size > PAGE_SIZE ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	    trigger_tab->table_size < trigger_tab->header_size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	if (trigger_tab->entry_count !=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	    (trigger_tab->table_size - trigger_tab->header_size) /
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 	    sizeof(struct acpi_einj_entry))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) static struct acpi_generic_address *einj_get_trigger_parameter_region(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	struct acpi_einj_trigger *trigger_tab, u64 param1, u64 param2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	struct acpi_whea_header *entry;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	entry = (struct acpi_whea_header *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 		((char *)trigger_tab + sizeof(struct acpi_einj_trigger));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	for (i = 0; i < trigger_tab->entry_count; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 		if (entry->action == ACPI_EINJ_TRIGGER_ERROR &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 		entry->instruction <= ACPI_EINJ_WRITE_REGISTER_VALUE &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 		entry->register_region.space_id ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 			ACPI_ADR_SPACE_SYSTEM_MEMORY &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 		(entry->register_region.address & param2) == (param1 & param2))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 			return &entry->register_region;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 		entry++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 	return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) /* Execute instructions in trigger error action table */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) static int __einj_error_trigger(u64 trigger_paddr, u32 type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 				u64 param1, u64 param2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 	struct acpi_einj_trigger *trigger_tab = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	struct apei_exec_context trigger_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 	struct apei_resources trigger_resources;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 	struct acpi_whea_header *trigger_entry;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 	struct resource *r;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	u32 table_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 	int rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 	struct acpi_generic_address *trigger_param_region = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	r = request_mem_region(trigger_paddr, sizeof(*trigger_tab),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 			       "APEI EINJ Trigger Table");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	if (!r) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 		pr_err("Can not request [mem %#010llx-%#010llx] for Trigger table\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 		       (unsigned long long)trigger_paddr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 		       (unsigned long long)trigger_paddr +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 			    sizeof(*trigger_tab) - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 	trigger_tab = ioremap_cache(trigger_paddr, sizeof(*trigger_tab));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 	if (!trigger_tab) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 		pr_err("Failed to map trigger table!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 		goto out_rel_header;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 	rc = einj_check_trigger_header(trigger_tab);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 	if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 		pr_warn(FW_BUG "Invalid trigger error action table.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 		goto out_rel_header;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 	/* No action structures in the TRIGGER_ERROR table, nothing to do */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	if (!trigger_tab->entry_count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 		goto out_rel_header;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 	rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 	table_size = trigger_tab->table_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 	r = request_mem_region(trigger_paddr + sizeof(*trigger_tab),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 			       table_size - sizeof(*trigger_tab),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 			       "APEI EINJ Trigger Table");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 	if (!r) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 		pr_err("Can not request [mem %#010llx-%#010llx] for Trigger Table Entry\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 		       (unsigned long long)trigger_paddr + sizeof(*trigger_tab),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 		       (unsigned long long)trigger_paddr + table_size - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 		goto out_rel_header;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 	iounmap(trigger_tab);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 	trigger_tab = ioremap_cache(trigger_paddr, table_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 	if (!trigger_tab) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 		pr_err("Failed to map trigger table!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 		goto out_rel_entry;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 	trigger_entry = (struct acpi_whea_header *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 		((char *)trigger_tab + sizeof(struct acpi_einj_trigger));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 	apei_resources_init(&trigger_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	apei_exec_ctx_init(&trigger_ctx, einj_ins_type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 			   ARRAY_SIZE(einj_ins_type),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 			   trigger_entry, trigger_tab->entry_count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 	rc = apei_exec_collect_resources(&trigger_ctx, &trigger_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 		goto out_fini;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 	rc = apei_resources_sub(&trigger_resources, &einj_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 		goto out_fini;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	 * Some firmware will access target address specified in
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 	 * param1 to trigger the error when injecting memory error.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	 * This will cause resource conflict with regular memory.  So
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 	 * remove it from trigger table resources.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 	if ((param_extension || acpi5) && (type & MEM_ERROR_MASK) && param2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 		struct apei_resources addr_resources;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 		apei_resources_init(&addr_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 		trigger_param_region = einj_get_trigger_parameter_region(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 			trigger_tab, param1, param2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 		if (trigger_param_region) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 			rc = apei_resources_add(&addr_resources,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 				trigger_param_region->address,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 				trigger_param_region->bit_width/8, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 			if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 				goto out_fini;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 			rc = apei_resources_sub(&trigger_resources,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 					&addr_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 		apei_resources_fini(&addr_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 		if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 			goto out_fini;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 	rc = apei_resources_request(&trigger_resources, "APEI EINJ Trigger");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 		goto out_fini;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 	rc = apei_exec_pre_map_gars(&trigger_ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 		goto out_release;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 	rc = apei_exec_run(&trigger_ctx, ACPI_EINJ_TRIGGER_ERROR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 	apei_exec_post_unmap_gars(&trigger_ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) out_release:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 	apei_resources_release(&trigger_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) out_fini:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 	apei_resources_fini(&trigger_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) out_rel_entry:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 	release_mem_region(trigger_paddr + sizeof(*trigger_tab),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 			   table_size - sizeof(*trigger_tab));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) out_rel_header:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 	release_mem_region(trigger_paddr, sizeof(*trigger_tab));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 	if (trigger_tab)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 		iounmap(trigger_tab);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) 	return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) static int __einj_error_inject(u32 type, u32 flags, u64 param1, u64 param2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 			       u64 param3, u64 param4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) 	struct apei_exec_context ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 	u64 val, trigger_paddr, timeout = FIRMWARE_TIMEOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 	int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 	einj_exec_ctx_init(&ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 	rc = apei_exec_run_optional(&ctx, ACPI_EINJ_BEGIN_OPERATION);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) 		return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 	apei_exec_ctx_set_input(&ctx, type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) 	if (acpi5) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 		struct set_error_type_with_address *v5param = einj_param;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) 		v5param->type = type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) 		if (type & ACPI5_VENDOR_BIT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) 			switch (vendor_flags) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) 			case SETWA_FLAGS_APICID:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) 				v5param->apicid = param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) 			case SETWA_FLAGS_MEM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) 				v5param->memory_address = param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 				v5param->memory_address_range = param2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) 			case SETWA_FLAGS_PCIE_SBDF:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) 				v5param->pcie_sbdf = param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 			v5param->flags = vendor_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) 		} else if (flags) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) 				v5param->flags = flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 				v5param->memory_address = param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 				v5param->memory_address_range = param2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 				v5param->apicid = param3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 				v5param->pcie_sbdf = param4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) 			switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) 			case ACPI_EINJ_PROCESSOR_CORRECTABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) 			case ACPI_EINJ_PROCESSOR_UNCORRECTABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) 			case ACPI_EINJ_PROCESSOR_FATAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) 				v5param->apicid = param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) 				v5param->flags = SETWA_FLAGS_APICID;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) 			case ACPI_EINJ_MEMORY_CORRECTABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) 			case ACPI_EINJ_MEMORY_UNCORRECTABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) 			case ACPI_EINJ_MEMORY_FATAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) 				v5param->memory_address = param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) 				v5param->memory_address_range = param2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) 				v5param->flags = SETWA_FLAGS_MEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) 			case ACPI_EINJ_PCIX_CORRECTABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) 			case ACPI_EINJ_PCIX_UNCORRECTABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) 			case ACPI_EINJ_PCIX_FATAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) 				v5param->pcie_sbdf = param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) 				v5param->flags = SETWA_FLAGS_PCIE_SBDF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) 		rc = apei_exec_run(&ctx, ACPI_EINJ_SET_ERROR_TYPE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) 		if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) 			return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) 		if (einj_param) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) 			struct einj_parameter *v4param = einj_param;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) 			v4param->param1 = param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) 			v4param->param2 = param2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) 	rc = apei_exec_run(&ctx, ACPI_EINJ_EXECUTE_OPERATION);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) 		return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) 	for (;;) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) 		rc = apei_exec_run(&ctx, ACPI_EINJ_CHECK_BUSY_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) 		if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) 			return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) 		val = apei_exec_ctx_get_output(&ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) 		if (!(val & EINJ_OP_BUSY))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) 		if (einj_timedout(&timeout))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) 			return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) 	rc = apei_exec_run(&ctx, ACPI_EINJ_GET_COMMAND_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) 		return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) 	val = apei_exec_ctx_get_output(&ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) 	if (val != EINJ_STATUS_SUCCESS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) 		return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) 	rc = apei_exec_run(&ctx, ACPI_EINJ_GET_TRIGGER_TABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) 		return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) 	trigger_paddr = apei_exec_ctx_get_output(&ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) 	if (notrigger == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) 		rc = __einj_error_trigger(trigger_paddr, type, param1, param2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) 		if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) 			return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) 	rc = apei_exec_run_optional(&ctx, ACPI_EINJ_END_OPERATION);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) 	return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) /* Inject the specified hardware error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) static int einj_error_inject(u32 type, u32 flags, u64 param1, u64 param2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) 			     u64 param3, u64 param4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) 	int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) 	u64 base_addr, size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) 	/* If user manually set "flags", make sure it is legal */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) 	if (flags && (flags &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) 		~(SETWA_FLAGS_APICID|SETWA_FLAGS_MEM|SETWA_FLAGS_PCIE_SBDF)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) 	 * We need extra sanity checks for memory errors.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) 	 * Other types leap directly to injection.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) 	/* ensure param1/param2 existed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) 	if (!(param_extension || acpi5))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) 		goto inject;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) 	/* ensure injection is memory related */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) 	if (type & ACPI5_VENDOR_BIT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) 		if (vendor_flags != SETWA_FLAGS_MEM)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) 			goto inject;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) 	} else if (!(type & MEM_ERROR_MASK) && !(flags & SETWA_FLAGS_MEM))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) 		goto inject;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) 	 * Disallow crazy address masks that give BIOS leeway to pick
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) 	 * injection address almost anywhere. Insist on page or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) 	 * better granularity and that target address is normal RAM or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) 	 * NVDIMM.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) 	base_addr = param1 & param2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) 	size = ~param2 + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) 	if (((param2 & PAGE_MASK) != PAGE_MASK) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) 	    ((region_intersects(base_addr, size, IORESOURCE_SYSTEM_RAM, IORES_DESC_NONE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) 				!= REGION_INTERSECTS) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) 	     (region_intersects(base_addr, size, IORESOURCE_MEM, IORES_DESC_PERSISTENT_MEMORY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) 				!= REGION_INTERSECTS)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) inject:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) 	mutex_lock(&einj_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) 	rc = __einj_error_inject(type, flags, param1, param2, param3, param4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) 	mutex_unlock(&einj_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) 	return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) static u32 error_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) static u32 error_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) static u64 error_param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) static u64 error_param2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) static u64 error_param3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) static u64 error_param4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) static struct dentry *einj_debug_dir;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) static int available_error_type_show(struct seq_file *m, void *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) 	int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) 	u32 available_error_type = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) 	rc = einj_get_available_error_type(&available_error_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) 		return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) 	if (available_error_type & 0x0001)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) 		seq_printf(m, "0x00000001\tProcessor Correctable\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) 	if (available_error_type & 0x0002)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) 		seq_printf(m, "0x00000002\tProcessor Uncorrectable non-fatal\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) 	if (available_error_type & 0x0004)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) 		seq_printf(m, "0x00000004\tProcessor Uncorrectable fatal\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) 	if (available_error_type & 0x0008)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) 		seq_printf(m, "0x00000008\tMemory Correctable\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) 	if (available_error_type & 0x0010)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) 		seq_printf(m, "0x00000010\tMemory Uncorrectable non-fatal\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) 	if (available_error_type & 0x0020)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) 		seq_printf(m, "0x00000020\tMemory Uncorrectable fatal\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) 	if (available_error_type & 0x0040)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) 		seq_printf(m, "0x00000040\tPCI Express Correctable\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) 	if (available_error_type & 0x0080)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) 		seq_printf(m, "0x00000080\tPCI Express Uncorrectable non-fatal\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) 	if (available_error_type & 0x0100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) 		seq_printf(m, "0x00000100\tPCI Express Uncorrectable fatal\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) 	if (available_error_type & 0x0200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) 		seq_printf(m, "0x00000200\tPlatform Correctable\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) 	if (available_error_type & 0x0400)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) 		seq_printf(m, "0x00000400\tPlatform Uncorrectable non-fatal\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) 	if (available_error_type & 0x0800)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) 		seq_printf(m, "0x00000800\tPlatform Uncorrectable fatal\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) DEFINE_SHOW_ATTRIBUTE(available_error_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) static int error_type_get(void *data, u64 *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) 	*val = error_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) static int error_type_set(void *data, u64 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) 	int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) 	u32 available_error_type = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) 	u32 tval, vendor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) 	 * Vendor defined types have 0x80000000 bit set, and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) 	 * are not enumerated by ACPI_EINJ_GET_ERROR_TYPE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) 	vendor = val & ACPI5_VENDOR_BIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) 	tval = val & 0x7fffffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) 	/* Only one error type can be specified */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) 	if (tval & (tval - 1))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) 	if (!vendor) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) 		rc = einj_get_available_error_type(&available_error_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) 		if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) 			return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) 		if (!(val & available_error_type))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) 			return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) 	error_type = val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) DEFINE_DEBUGFS_ATTRIBUTE(error_type_fops, error_type_get, error_type_set,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) 			 "0x%llx\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) static int error_inject_set(void *data, u64 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) 	if (!error_type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) 	return einj_error_inject(error_type, error_flags, error_param1, error_param2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) 		error_param3, error_param4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) DEFINE_DEBUGFS_ATTRIBUTE(error_inject_fops, NULL, error_inject_set, "%llu\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) static int einj_check_table(struct acpi_table_einj *einj_tab)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) 	if ((einj_tab->header_length !=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) 	     (sizeof(struct acpi_table_einj) - sizeof(einj_tab->header)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) 	    && (einj_tab->header_length != sizeof(struct acpi_table_einj)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) 	if (einj_tab->header.length < sizeof(struct acpi_table_einj))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) 	if (einj_tab->entries !=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) 	    (einj_tab->header.length - sizeof(struct acpi_table_einj)) /
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) 	    sizeof(struct acpi_einj_entry))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) static int __init einj_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) 	int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) 	acpi_status status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) 	struct apei_exec_context ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) 	if (acpi_disabled) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) 		pr_warn("ACPI disabled.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) 	status = acpi_get_table(ACPI_SIG_EINJ, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) 				(struct acpi_table_header **)&einj_tab);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) 	if (status == AE_NOT_FOUND) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) 		pr_warn("EINJ table not found.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) 	else if (ACPI_FAILURE(status)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) 		pr_err("Failed to get EINJ table: %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) 				acpi_format_exception(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) 	rc = einj_check_table(einj_tab);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) 	if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) 		pr_warn(FW_BUG "Invalid EINJ table.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) 		goto err_put_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) 	rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) 	einj_debug_dir = debugfs_create_dir("einj", apei_get_debugfs_dir());
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) 	debugfs_create_file("available_error_type", S_IRUSR, einj_debug_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) 			    NULL, &available_error_type_fops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) 	debugfs_create_file_unsafe("error_type", 0600, einj_debug_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) 				   NULL, &error_type_fops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) 	debugfs_create_file_unsafe("error_inject", 0200, einj_debug_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) 				   NULL, &error_inject_fops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) 	apei_resources_init(&einj_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) 	einj_exec_ctx_init(&ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) 	rc = apei_exec_collect_resources(&ctx, &einj_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) 	if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) 		pr_err("Error collecting EINJ resources.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) 		goto err_fini;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) 	rc = apei_resources_request(&einj_resources, "APEI EINJ");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) 	if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) 		pr_err("Error requesting memory/port resources.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) 		goto err_fini;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) 	rc = apei_exec_pre_map_gars(&ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) 	if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) 		pr_err("Error pre-mapping GARs.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) 		goto err_release;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) 	rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) 	einj_param = einj_get_parameter_address();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) 	if ((param_extension || acpi5) && einj_param) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) 		debugfs_create_x32("flags", S_IRUSR | S_IWUSR, einj_debug_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) 				   &error_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) 		debugfs_create_x64("param1", S_IRUSR | S_IWUSR, einj_debug_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) 				   &error_param1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) 		debugfs_create_x64("param2", S_IRUSR | S_IWUSR, einj_debug_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) 				   &error_param2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) 		debugfs_create_x64("param3", S_IRUSR | S_IWUSR, einj_debug_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) 				   &error_param3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) 		debugfs_create_x64("param4", S_IRUSR | S_IWUSR, einj_debug_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) 				   &error_param4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) 		debugfs_create_x32("notrigger", S_IRUSR | S_IWUSR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) 				   einj_debug_dir, &notrigger);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) 	if (vendor_dev[0]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) 		vendor_blob.data = vendor_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) 		vendor_blob.size = strlen(vendor_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) 		debugfs_create_blob("vendor", S_IRUSR, einj_debug_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) 				    &vendor_blob);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) 		debugfs_create_x32("vendor_flags", S_IRUSR | S_IWUSR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) 				   einj_debug_dir, &vendor_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) 	pr_info("Error INJection is initialized.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) err_release:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) 	apei_resources_release(&einj_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) err_fini:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) 	apei_resources_fini(&einj_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) 	debugfs_remove_recursive(einj_debug_dir);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) err_put_table:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) 	acpi_put_table((struct acpi_table_header *)einj_tab);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) 	return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) static void __exit einj_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) 	struct apei_exec_context ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) 	if (einj_param) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) 		acpi_size size = (acpi5) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) 			sizeof(struct set_error_type_with_address) :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) 			sizeof(struct einj_parameter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) 		acpi_os_unmap_iomem(einj_param, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) 	einj_exec_ctx_init(&ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) 	apei_exec_post_unmap_gars(&ctx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) 	apei_resources_release(&einj_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) 	apei_resources_fini(&einj_resources);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) 	debugfs_remove_recursive(einj_debug_dir);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) 	acpi_put_table((struct acpi_table_header *)einj_tab);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) module_init(einj_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) module_exit(einj_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) MODULE_AUTHOR("Huang Ying");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) MODULE_DESCRIPTION("APEI Error INJection support");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) MODULE_LICENSE("GPL");