ghes.c 39.3 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0-only
2 3 4 5 6 7 8 9 10 11 12 13 14 15
/*
 * APEI Generic Hardware Error Source support
 *
 * Generic Hardware Error Source provides a way to report platform
 * hardware errors (such as that from chipset). It works in so called
 * "Firmware First" mode, that is, hardware errors are reported to
 * firmware firstly, then reported to Linux by firmware. This way,
 * some non-standard hardware error registers or non-standard hardware
 * link can be checked by firmware to produce more hardware error
 * information for Linux.
 *
 * For more information about Generic Hardware Error Source, please
 * refer to ACPI Specification version 4.0, section 17.3.2.6
 *
16
 * Copyright 2010,2011 Intel Corp.
17 18 19
 *   Author: Huang Ying <ying.huang@intel.com>
 */

20
#include <linux/arm_sdei.h>
21
#include <linux/kernel.h>
22
#include <linux/moduleparam.h>
23 24 25 26
#include <linux/init.h>
#include <linux/acpi.h>
#include <linux/io.h>
#include <linux/interrupt.h>
27
#include <linux/timer.h>
28
#include <linux/cper.h>
29 30
#include <linux/platform_device.h>
#include <linux/mutex.h>
31
#include <linux/ratelimit.h>
32
#include <linux/vmalloc.h>
33 34 35
#include <linux/irq_work.h>
#include <linux/llist.h>
#include <linux/genalloc.h>
36
#include <linux/pci.h>
37
#include <linux/pfn.h>
38
#include <linux/aer.h>
39
#include <linux/nmi.h>
40
#include <linux/sched/clock.h>
41 42
#include <linux/uuid.h>
#include <linux/ras.h>
43
#include <linux/task_work.h>
44

45
#include <acpi/actbl1.h>
46
#include <acpi/ghes.h>
47
#include <acpi/apei.h>
48
#include <asm/fixmap.h>
49
#include <asm/tlbflush.h>
50
#include <ras/ras_event.h>
51 52 53 54 55 56

#include "apei-internal.h"

#define GHES_PFX	"GHES: "

#define GHES_ESTATUS_MAX_SIZE		65536
57 58 59 60
#define GHES_ESOURCE_PREALLOC_MAX_SIZE	65536

#define GHES_ESTATUS_POOL_MIN_ALLOC_ORDER 3

61 62 63 64 65
/* This is just an estimation for memory pool allocation */
#define GHES_ESTATUS_CACHE_AVG_SIZE	512

#define GHES_ESTATUS_CACHES_SIZE	4

L
Len Brown 已提交
66
#define GHES_ESTATUS_IN_CACHE_MAX_NSEC	10000000000ULL
67 68 69 70 71 72
/* Prevent too many caches are allocated because of RCU */
#define GHES_ESTATUS_CACHE_ALLOCED_MAX	(GHES_ESTATUS_CACHES_SIZE * 3 / 2)

#define GHES_ESTATUS_CACHE_LEN(estatus_len)			\
	(sizeof(struct ghes_estatus_cache) + (estatus_len))
#define GHES_ESTATUS_FROM_CACHE(estatus_cache)			\
73
	((struct acpi_hest_generic_status *)				\
74 75
	 ((struct ghes_estatus_cache *)(estatus_cache) + 1))

76 77
#define GHES_ESTATUS_NODE_LEN(estatus_len)			\
	(sizeof(struct ghes_estatus_node) + (estatus_len))
C
Chen, Gong 已提交
78
#define GHES_ESTATUS_FROM_NODE(estatus_node)			\
79
	((struct acpi_hest_generic_status *)				\
80
	 ((struct ghes_estatus_node *)(estatus_node) + 1))
81

82 83 84 85 86 87
#define GHES_VENDOR_ENTRY_LEN(gdata_len)                               \
	(sizeof(struct ghes_vendor_record_entry) + (gdata_len))
#define GHES_GDATA_FROM_VENDOR_ENTRY(vendor_entry)                     \
	((struct acpi_hest_generic_data *)                              \
	((struct ghes_vendor_record_entry *)(vendor_entry) + 1))

88 89 90 91 92 93 94 95 96
/*
 *  NMI-like notifications vary by architecture, before the compiler can prune
 *  unused static functions it needs a value for these enums.
 */
#ifndef CONFIG_ARM_SDE_INTERFACE
#define FIX_APEI_GHES_SDEI_NORMAL	__end_of_fixed_addresses
#define FIX_APEI_GHES_SDEI_CRITICAL	__end_of_fixed_addresses
#endif

97 98 99 100 101
static inline bool is_hest_type_generic_v2(struct ghes *ghes)
{
	return ghes->generic->header.type == ACPI_HEST_TYPE_GENERIC_ERROR_V2;
}

102 103 104 105 106
/*
 * This driver isn't really modular, however for the time being,
 * continuing to use module_param is the easiest way to remain
 * compatible with existing boot arg use cases.
 */
107
bool ghes_disable;
108 109
module_param_named(disable, ghes_disable, bool, 0);

110
/*
111 112 113
 * All error sources notified with HED (Hardware Error Device) share a
 * single notifier callback, so they need to be linked and checked one
 * by one. This holds true for NMI too.
114
 *
115 116
 * RCU is used for these lists, so ghes_list_mutex is only used for
 * list changing, not for traversing.
117
 */
118
static LIST_HEAD(ghes_hed);
119
static DEFINE_MUTEX(ghes_list_mutex);
120

121 122 123 124
/*
 * Because the memory area used to transfer hardware error information
 * from BIOS to Linux can be determined only in NMI, IRQ or timer
 * handler, but general ioremap can not be used in atomic context, so
125
 * the fixmap is used instead.
126
 *
127
 * This spinlock is used to prevent the fixmap entry from being used
128
 * simultaneously.
129
 */
130
static DEFINE_SPINLOCK(ghes_notify_lock_irq);
131

132 133 134 135 136 137
struct ghes_vendor_record_entry {
	struct work_struct work;
	int error_severity;
	char vendor_record[];
};

138 139 140
static struct gen_pool *ghes_estatus_pool;
static unsigned long ghes_estatus_pool_size_request;

141
static struct ghes_estatus_cache *ghes_estatus_caches[GHES_ESTATUS_CACHES_SIZE];
142 143
static atomic_t ghes_estatus_cache_alloced;

144 145
static int ghes_panic_timeout __read_mostly = 30;

146
static void __iomem *ghes_map(u64 pfn, enum fixed_addresses fixmap_idx)
147
{
148 149
	phys_addr_t paddr;
	pgprot_t prot;
150

151
	paddr = PFN_PHYS(pfn);
152
	prot = arch_apei_get_mem_attribute(paddr);
153
	__set_fixmap(fixmap_idx, paddr, prot);
154

155
	return (void __iomem *) __fix_to_virt(fixmap_idx);
156 157
}

158
static void ghes_unmap(void __iomem *vaddr, enum fixed_addresses fixmap_idx)
159
{
160
	int _idx = virt_to_fix((unsigned long)vaddr);
161

162 163
	WARN_ON_ONCE(fixmap_idx != _idx);
	clear_fixmap(fixmap_idx);
164 165
}

166
int ghes_estatus_pool_init(int num_ghes)
167
{
168
	unsigned long addr, len;
169
	int rc;
170

171 172 173 174
	ghes_estatus_pool = gen_pool_create(GHES_ESTATUS_POOL_MIN_ALLOC_ORDER, -1);
	if (!ghes_estatus_pool)
		return -ENOMEM;

175 176
	len = GHES_ESTATUS_CACHE_AVG_SIZE * GHES_ESTATUS_CACHE_ALLOCED_MAX;
	len += (num_ghes * GHES_ESOURCE_PREALLOC_MAX_SIZE);
177

178
	ghes_estatus_pool_size_request = PAGE_ALIGN(len);
179 180
	addr = (unsigned long)vmalloc(PAGE_ALIGN(len));
	if (!addr)
181
		goto err_pool_alloc;
182

183 184 185 186 187 188 189 190 191 192 193 194 195
	rc = gen_pool_add(ghes_estatus_pool, addr, PAGE_ALIGN(len), -1);
	if (rc)
		goto err_pool_add;

	return 0;

err_pool_add:
	vfree((void *)addr);

err_pool_alloc:
	gen_pool_destroy(ghes_estatus_pool);

	return -ENOMEM;
196 197
}

198 199 200 201 202 203 204 205 206 207
static int map_gen_v2(struct ghes *ghes)
{
	return apei_map_generic_address(&ghes->generic_v2->read_ack_register);
}

static void unmap_gen_v2(struct ghes *ghes)
{
	apei_unmap_generic_address(&ghes->generic_v2->read_ack_register);
}

208 209 210 211 212 213 214 215 216 217 218 219 220 221 222
static void ghes_ack_error(struct acpi_hest_generic_v2 *gv2)
{
	int rc;
	u64 val = 0;

	rc = apei_read(&val, &gv2->read_ack_register);
	if (rc)
		return;

	val &= gv2->read_ack_preserve << gv2->read_ack_register.bit_offset;
	val |= gv2->read_ack_write    << gv2->read_ack_register.bit_offset;

	apei_write(val, &gv2->read_ack_register);
}

223 224 225 226 227 228 229 230 231
static struct ghes *ghes_new(struct acpi_hest_generic *generic)
{
	struct ghes *ghes;
	unsigned int error_block_length;
	int rc;

	ghes = kzalloc(sizeof(*ghes), GFP_KERNEL);
	if (!ghes)
		return ERR_PTR(-ENOMEM);
232

233
	ghes->generic = generic;
234 235 236 237 238 239
	if (is_hest_type_generic_v2(ghes)) {
		rc = map_gen_v2(ghes);
		if (rc)
			goto err_free;
	}

240
	rc = apei_map_generic_address(&generic->error_status_address);
241
	if (rc)
242
		goto err_unmap_read_ack_addr;
243 244
	error_block_length = generic->error_block_length;
	if (error_block_length > GHES_ESTATUS_MAX_SIZE) {
245 246 247 248
		pr_warn(FW_WARN GHES_PFX
			"Error status block length is too long: %u for "
			"generic hardware error source: %d.\n",
			error_block_length, generic->header.source_id);
249 250 251 252 253
		error_block_length = GHES_ESTATUS_MAX_SIZE;
	}
	ghes->estatus = kmalloc(error_block_length, GFP_KERNEL);
	if (!ghes->estatus) {
		rc = -ENOMEM;
254
		goto err_unmap_status_addr;
255 256 257 258
	}

	return ghes;

259
err_unmap_status_addr:
260
	apei_unmap_generic_address(&generic->error_status_address);
261 262 263
err_unmap_read_ack_addr:
	if (is_hest_type_generic_v2(ghes))
		unmap_gen_v2(ghes);
264 265 266 267 268 269 270 271
err_free:
	kfree(ghes);
	return ERR_PTR(rc);
}

static void ghes_fini(struct ghes *ghes)
{
	kfree(ghes->estatus);
272
	apei_unmap_generic_address(&ghes->generic->error_status_address);
273 274
	if (is_hest_type_generic_v2(ghes))
		unmap_gen_v2(ghes);
275 276 277 278 279
}

static inline int ghes_severity(int severity)
{
	switch (severity) {
280 281 282 283 284 285 286 287
	case CPER_SEV_INFORMATIONAL:
		return GHES_SEV_NO;
	case CPER_SEV_CORRECTED:
		return GHES_SEV_CORRECTED;
	case CPER_SEV_RECOVERABLE:
		return GHES_SEV_RECOVERABLE;
	case CPER_SEV_FATAL:
		return GHES_SEV_PANIC;
288
	default:
L
Lucas De Marchi 已提交
289
		/* Unknown, go panic */
290
		return GHES_SEV_PANIC;
291 292 293
	}
}

294
static void ghes_copy_tofrom_phys(void *buffer, u64 paddr, u32 len,
295 296
				  int from_phys,
				  enum fixed_addresses fixmap_idx)
297
{
298 299 300 301 302 303
	void __iomem *vaddr;
	u64 offset;
	u32 trunk;

	while (len > 0) {
		offset = paddr - (paddr & PAGE_MASK);
304
		vaddr = ghes_map(PHYS_PFN(paddr), fixmap_idx);
305 306 307 308 309 310 311 312 313
		trunk = PAGE_SIZE - offset;
		trunk = min(trunk, len);
		if (from_phys)
			memcpy_fromio(buffer, vaddr + offset, trunk);
		else
			memcpy_toio(vaddr + offset, buffer, trunk);
		len -= trunk;
		paddr += trunk;
		buffer += trunk;
314
		ghes_unmap(vaddr, fixmap_idx);
315
	}
316 317
}

318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341
/* Check the top-level record header has an appropriate size. */
static int __ghes_check_estatus(struct ghes *ghes,
				struct acpi_hest_generic_status *estatus)
{
	u32 len = cper_estatus_len(estatus);

	if (len < sizeof(*estatus)) {
		pr_warn_ratelimited(FW_WARN GHES_PFX "Truncated error status block!\n");
		return -EIO;
	}

	if (len > ghes->generic->error_block_length) {
		pr_warn_ratelimited(FW_WARN GHES_PFX "Invalid error status block length!\n");
		return -EIO;
	}

	if (cper_estatus_check_header(estatus)) {
		pr_warn_ratelimited(FW_WARN GHES_PFX "Invalid CPER header!\n");
		return -EIO;
	}

	return 0;
}

342 343 344 345
/* Read the CPER block, returning its address, and header in estatus. */
static int __ghes_peek_estatus(struct ghes *ghes,
			       struct acpi_hest_generic_status *estatus,
			       u64 *buf_paddr, enum fixed_addresses fixmap_idx)
346 347 348 349
{
	struct acpi_hest_generic *g = ghes->generic;
	int rc;

350
	rc = apei_read(buf_paddr, &g->error_status_address);
351
	if (rc) {
352
		*buf_paddr = 0;
353
		pr_warn_ratelimited(FW_WARN GHES_PFX
354 355 356 357
"Failed to read error status block address for hardware error source: %d.\n",
				   g->header.source_id);
		return -EIO;
	}
358
	if (!*buf_paddr)
359 360
		return -ENOENT;

361 362 363
	ghes_copy_tofrom_phys(estatus, *buf_paddr, sizeof(*estatus), 1,
			      fixmap_idx);
	if (!estatus->block_status) {
364
		*buf_paddr = 0;
365
		return -ENOENT;
366
	}
367

368
	return 0;
369
}
370

371 372 373 374 375
static int __ghes_read_estatus(struct acpi_hest_generic_status *estatus,
			       u64 buf_paddr, enum fixed_addresses fixmap_idx,
			       size_t buf_len)
{
	ghes_copy_tofrom_phys(estatus, buf_paddr, buf_len, 1, fixmap_idx);
376
	if (cper_estatus_check(estatus)) {
377 378
		pr_warn_ratelimited(FW_WARN GHES_PFX
				    "Failed to read error status block!\n");
379 380
		return -EIO;
	}
381

382
	return 0;
383 384
}

385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402
static int ghes_read_estatus(struct ghes *ghes,
			     struct acpi_hest_generic_status *estatus,
			     u64 *buf_paddr, enum fixed_addresses fixmap_idx)
{
	int rc;

	rc = __ghes_peek_estatus(ghes, estatus, buf_paddr, fixmap_idx);
	if (rc)
		return rc;

	rc = __ghes_check_estatus(ghes, estatus);
	if (rc)
		return rc;

	return __ghes_read_estatus(estatus, *buf_paddr, fixmap_idx,
				   cper_estatus_len(estatus));
}

403 404 405
static void ghes_clear_estatus(struct ghes *ghes,
			       struct acpi_hest_generic_status *estatus,
			       u64 buf_paddr, enum fixed_addresses fixmap_idx)
406
{
407
	estatus->block_status = 0;
408 409 410 411

	if (!buf_paddr)
		return;

412 413
	ghes_copy_tofrom_phys(estatus, buf_paddr,
			      sizeof(estatus->block_status), 0,
414
			      fixmap_idx);
415 416 417 418 419 420 421

	/*
	 * GHESv2 type HEST entries introduce support for error acknowledgment,
	 * so only acknowledge the error if this support is present.
	 */
	if (is_hest_type_generic_v2(ghes))
		ghes_ack_error(ghes->generic_v2);
422 423
}

424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443
/*
 * Called as task_work before returning to user-space.
 * Ensure any queued work has been done before we return to the context that
 * triggered the notification.
 */
static void ghes_kick_task_work(struct callback_head *head)
{
	struct acpi_hest_generic_status *estatus;
	struct ghes_estatus_node *estatus_node;
	u32 node_len;

	estatus_node = container_of(head, struct ghes_estatus_node, task_work);
	if (IS_ENABLED(CONFIG_ACPI_APEI_MEMORY_FAILURE))
		memory_failure_queue_kick(estatus_node->task_work_cpu);

	estatus = GHES_ESTATUS_FROM_NODE(estatus_node);
	node_len = GHES_ESTATUS_NODE_LEN(cper_estatus_len(estatus));
	gen_pool_free(ghes_estatus_pool, (unsigned long)estatus_node, node_len);
}

444
static bool ghes_do_memory_failure(u64 physical_addr, int flags)
445 446 447
{
	unsigned long pfn;

448 449 450
	if (!IS_ENABLED(CONFIG_ACPI_APEI_MEMORY_FAILURE))
		return false;

451
	pfn = PHYS_PFN(physical_addr);
452 453 454
	if (!pfn_valid(pfn)) {
		pr_warn_ratelimited(FW_WARN GHES_PFX
		"Invalid address in generic error data: %#llx\n",
455
		physical_addr);
456
		return false;
457
	}
458

459 460 461 462 463 464 465 466 467 468 469 470 471 472
	memory_failure_queue(pfn, flags);
	return true;
}

static bool ghes_handle_memory_failure(struct acpi_hest_generic_data *gdata,
				       int sev)
{
	int flags = -1;
	int sec_sev = ghes_severity(gdata->error_severity);
	struct cper_sec_mem_err *mem_err = acpi_hest_get_payload(gdata);

	if (!(mem_err->validation_bits & CPER_MEM_VALID_PA))
		return false;

473 474 475 476 477 478 479
	/* iff following two events can be handled properly by now */
	if (sec_sev == GHES_SEV_CORRECTED &&
	    (gdata->flags & CPER_SEC_ERROR_THRESHOLD_EXCEEDED))
		flags = MF_SOFT_OFFLINE;
	if (sev == GHES_SEV_RECOVERABLE && sec_sev == GHES_SEV_RECOVERABLE)
		flags = 0;

480 481
	if (flags != -1)
		return ghes_do_memory_failure(mem_err->physical_addr, flags);
482 483

	return false;
484 485
}

486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529
static bool ghes_handle_arm_hw_error(struct acpi_hest_generic_data *gdata, int sev)
{
	struct cper_sec_proc_arm *err = acpi_hest_get_payload(gdata);
	bool queued = false;
	int sec_sev, i;
	char *p;

	log_arm_hw_error(err);

	sec_sev = ghes_severity(gdata->error_severity);
	if (sev != GHES_SEV_RECOVERABLE || sec_sev != GHES_SEV_RECOVERABLE)
		return false;

	p = (char *)(err + 1);
	for (i = 0; i < err->err_info_num; i++) {
		struct cper_arm_err_info *err_info = (struct cper_arm_err_info *)p;
		bool is_cache = (err_info->type == CPER_ARM_CACHE_ERROR);
		bool has_pa = (err_info->validation_bits & CPER_ARM_INFO_VALID_PHYSICAL_ADDR);
		const char *error_type = "unknown error";

		/*
		 * The field (err_info->error_info & BIT(26)) is fixed to set to
		 * 1 in some old firmware of HiSilicon Kunpeng920. We assume that
		 * firmware won't mix corrected errors in an uncorrected section,
		 * and don't filter out 'corrected' error here.
		 */
		if (is_cache && has_pa) {
			queued = ghes_do_memory_failure(err_info->physical_fault_addr, 0);
			p += err_info->length;
			continue;
		}

		if (err_info->type < ARRAY_SIZE(cper_proc_error_type_strs))
			error_type = cper_proc_error_type_strs[err_info->type];

		pr_warn_ratelimited(FW_WARN GHES_PFX
				    "Unhandled processor error type: %s\n",
				    error_type);
		p += err_info->length;
	}

	return queued;
}

530 531 532 533 534 535 536 537 538 539 540 541 542 543 544
/*
 * PCIe AER errors need to be sent to the AER driver for reporting and
 * recovery. The GHES severities map to the following AER severities and
 * require the following handling:
 *
 * GHES_SEV_CORRECTABLE -> AER_CORRECTABLE
 *     These need to be reported by the AER driver but no recovery is
 *     necessary.
 * GHES_SEV_RECOVERABLE -> AER_NONFATAL
 * GHES_SEV_RECOVERABLE && CPER_SEC_RESET -> AER_FATAL
 *     These both need to be reported and recovered from by the AER driver.
 * GHES_SEV_PANIC does not make it to this handling since the kernel must
 *     panic.
 */
static void ghes_handle_aer(struct acpi_hest_generic_data *gdata)
545 546 547 548
{
#ifdef CONFIG_ACPI_APEI_PCIEAER
	struct cper_sec_pcie *pcie_err = acpi_hest_get_payload(gdata);

549
	if (pcie_err->validation_bits & CPER_PCIE_VALID_DEVICE_ID &&
550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574
	    pcie_err->validation_bits & CPER_PCIE_VALID_AER_INFO) {
		unsigned int devfn;
		int aer_severity;

		devfn = PCI_DEVFN(pcie_err->device_id.device,
				  pcie_err->device_id.function);
		aer_severity = cper_severity_to_aer(gdata->error_severity);

		/*
		 * If firmware reset the component to contain
		 * the error, we must reinitialize it before
		 * use, so treat it as a fatal AER error.
		 */
		if (gdata->flags & CPER_SEC_RESET)
			aer_severity = AER_FATAL;

		aer_recover_queue(pcie_err->device_id.segment,
				  pcie_err->device_id.bus,
				  devfn, aer_severity,
				  (struct aer_capability_regs *)
				  pcie_err->aer_info);
	}
#endif
}

575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624
static BLOCKING_NOTIFIER_HEAD(vendor_record_notify_list);

int ghes_register_vendor_record_notifier(struct notifier_block *nb)
{
	return blocking_notifier_chain_register(&vendor_record_notify_list, nb);
}
EXPORT_SYMBOL_GPL(ghes_register_vendor_record_notifier);

void ghes_unregister_vendor_record_notifier(struct notifier_block *nb)
{
	blocking_notifier_chain_unregister(&vendor_record_notify_list, nb);
}
EXPORT_SYMBOL_GPL(ghes_unregister_vendor_record_notifier);

static void ghes_vendor_record_work_func(struct work_struct *work)
{
	struct ghes_vendor_record_entry *entry;
	struct acpi_hest_generic_data *gdata;
	u32 len;

	entry = container_of(work, struct ghes_vendor_record_entry, work);
	gdata = GHES_GDATA_FROM_VENDOR_ENTRY(entry);

	blocking_notifier_call_chain(&vendor_record_notify_list,
				     entry->error_severity, gdata);

	len = GHES_VENDOR_ENTRY_LEN(acpi_hest_get_record_size(gdata));
	gen_pool_free(ghes_estatus_pool, (unsigned long)entry, len);
}

static void ghes_defer_non_standard_event(struct acpi_hest_generic_data *gdata,
					  int sev)
{
	struct acpi_hest_generic_data *copied_gdata;
	struct ghes_vendor_record_entry *entry;
	u32 len;

	len = GHES_VENDOR_ENTRY_LEN(acpi_hest_get_record_size(gdata));
	entry = (void *)gen_pool_alloc(ghes_estatus_pool, len);
	if (!entry)
		return;

	copied_gdata = GHES_GDATA_FROM_VENDOR_ENTRY(entry);
	memcpy(copied_gdata, gdata, acpi_hest_get_record_size(gdata));
	entry->error_severity = sev;

	INIT_WORK(&entry->work, ghes_vendor_record_work_func);
	schedule_work(&entry->work);
}

625
static bool ghes_do_proc(struct ghes *ghes,
626
			 const struct acpi_hest_generic_status *estatus)
627
{
628
	int sev, sec_sev;
629
	struct acpi_hest_generic_data *gdata;
630
	guid_t *sec_type;
631
	const guid_t *fru_id = &guid_null;
632
	char *fru_text = "";
633
	bool queued = false;
634

635 636
	sev = ghes_severity(estatus->error_severity);
	apei_estatus_for_each_section(estatus, gdata) {
637
		sec_type = (guid_t *)gdata->section_type;
638
		sec_sev = ghes_severity(gdata->error_severity);
639 640 641 642 643 644
		if (gdata->validation_bits & CPER_SEC_VALID_FRU_ID)
			fru_id = (guid_t *)gdata->fru_id;

		if (gdata->validation_bits & CPER_SEC_VALID_FRU_TEXT)
			fru_text = gdata->fru_text;

645
		if (guid_equal(sec_type, &CPER_SEC_PLATFORM_MEM)) {
646 647
			struct cper_sec_mem_err *mem_err = acpi_hest_get_payload(gdata);

648
			ghes_edac_report_mem_error(sev, mem_err);
649

650
			arch_apei_report_mem_error(sev, mem_err);
651
			queued = ghes_handle_memory_failure(gdata, sev);
652
		}
653
		else if (guid_equal(sec_type, &CPER_SEC_PCIE)) {
654
			ghes_handle_aer(gdata);
655
		}
656
		else if (guid_equal(sec_type, &CPER_SEC_PROC_ARM)) {
657
			queued = ghes_handle_arm_hw_error(gdata, sev);
658
		} else {
659 660
			void *err = acpi_hest_get_payload(gdata);

661
			ghes_defer_non_standard_event(gdata, sev);
662 663 664 665
			log_non_standard_event(sec_type, fru_id, fru_text,
					       sec_sev, err,
					       gdata->error_data_length);
		}
666
	}
667 668

	return queued;
669
}
670

671 672
static void __ghes_print_estatus(const char *pfx,
				 const struct acpi_hest_generic *generic,
673
				 const struct acpi_hest_generic_status *estatus)
674
{
675 676 677 678
	static atomic_t seqno;
	unsigned int curr_seqno;
	char pfx_seq[64];

679
	if (pfx == NULL) {
680
		if (ghes_severity(estatus->error_severity) <=
681
		    GHES_SEV_CORRECTED)
682
			pfx = KERN_WARNING;
683
		else
684
			pfx = KERN_ERR;
685
	}
686 687
	curr_seqno = atomic_inc_return(&seqno);
	snprintf(pfx_seq, sizeof(pfx_seq), "%s{%u}" HW_ERR, pfx, curr_seqno);
688
	printk("%s""Hardware error from APEI Generic Hardware Error Source: %d\n",
689
	       pfx_seq, generic->header.source_id);
C
Chen, Gong 已提交
690
	cper_estatus_print(pfx_seq, estatus);
691 692
}

693 694
static int ghes_print_estatus(const char *pfx,
			      const struct acpi_hest_generic *generic,
695
			      const struct acpi_hest_generic_status *estatus)
696 697
{
	/* Not more than 2 messages every 5 seconds */
698 699 700
	static DEFINE_RATELIMIT_STATE(ratelimit_corrected, 5*HZ, 2);
	static DEFINE_RATELIMIT_STATE(ratelimit_uncorrected, 5*HZ, 2);
	struct ratelimit_state *ratelimit;
701

702 703 704 705
	if (ghes_severity(estatus->error_severity) <= GHES_SEV_CORRECTED)
		ratelimit = &ratelimit_corrected;
	else
		ratelimit = &ratelimit_uncorrected;
706
	if (__ratelimit(ratelimit)) {
707
		__ghes_print_estatus(pfx, generic, estatus);
708 709 710 711 712 713 714 715 716
		return 1;
	}
	return 0;
}

/*
 * GHES error status reporting throttle, to report more kinds of
 * errors, instead of just most frequently occurred errors.
 */
717
static int ghes_estatus_cached(struct acpi_hest_generic_status *estatus)
718 719 720 721 722
{
	u32 len;
	int i, cached = 0;
	unsigned long long now;
	struct ghes_estatus_cache *cache;
723
	struct acpi_hest_generic_status *cache_estatus;
724

C
Chen, Gong 已提交
725
	len = cper_estatus_len(estatus);
726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747
	rcu_read_lock();
	for (i = 0; i < GHES_ESTATUS_CACHES_SIZE; i++) {
		cache = rcu_dereference(ghes_estatus_caches[i]);
		if (cache == NULL)
			continue;
		if (len != cache->estatus_len)
			continue;
		cache_estatus = GHES_ESTATUS_FROM_CACHE(cache);
		if (memcmp(estatus, cache_estatus, len))
			continue;
		atomic_inc(&cache->count);
		now = sched_clock();
		if (now - cache->time_in < GHES_ESTATUS_IN_CACHE_MAX_NSEC)
			cached = 1;
		break;
	}
	rcu_read_unlock();
	return cached;
}

static struct ghes_estatus_cache *ghes_estatus_cache_alloc(
	struct acpi_hest_generic *generic,
748
	struct acpi_hest_generic_status *estatus)
749 750 751 752
{
	int alloced;
	u32 len, cache_len;
	struct ghes_estatus_cache *cache;
753
	struct acpi_hest_generic_status *cache_estatus;
754 755 756 757 758 759

	alloced = atomic_add_return(1, &ghes_estatus_cache_alloced);
	if (alloced > GHES_ESTATUS_CACHE_ALLOCED_MAX) {
		atomic_dec(&ghes_estatus_cache_alloced);
		return NULL;
	}
C
Chen, Gong 已提交
760
	len = cper_estatus_len(estatus);
761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779
	cache_len = GHES_ESTATUS_CACHE_LEN(len);
	cache = (void *)gen_pool_alloc(ghes_estatus_pool, cache_len);
	if (!cache) {
		atomic_dec(&ghes_estatus_cache_alloced);
		return NULL;
	}
	cache_estatus = GHES_ESTATUS_FROM_CACHE(cache);
	memcpy(cache_estatus, estatus, len);
	cache->estatus_len = len;
	atomic_set(&cache->count, 0);
	cache->generic = generic;
	cache->time_in = sched_clock();
	return cache;
}

static void ghes_estatus_cache_free(struct ghes_estatus_cache *cache)
{
	u32 len;

C
Chen, Gong 已提交
780
	len = cper_estatus_len(GHES_ESTATUS_FROM_CACHE(cache));
781 782 783 784 785 786 787 788 789 790 791 792 793 794 795
	len = GHES_ESTATUS_CACHE_LEN(len);
	gen_pool_free(ghes_estatus_pool, (unsigned long)cache, len);
	atomic_dec(&ghes_estatus_cache_alloced);
}

static void ghes_estatus_cache_rcu_free(struct rcu_head *head)
{
	struct ghes_estatus_cache *cache;

	cache = container_of(head, struct ghes_estatus_cache, rcu);
	ghes_estatus_cache_free(cache);
}

static void ghes_estatus_cache_add(
	struct acpi_hest_generic *generic,
796
	struct acpi_hest_generic_status *estatus)
797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820
{
	int i, slot = -1, count;
	unsigned long long now, duration, period, max_period = 0;
	struct ghes_estatus_cache *cache, *slot_cache = NULL, *new_cache;

	new_cache = ghes_estatus_cache_alloc(generic, estatus);
	if (new_cache == NULL)
		return;
	rcu_read_lock();
	now = sched_clock();
	for (i = 0; i < GHES_ESTATUS_CACHES_SIZE; i++) {
		cache = rcu_dereference(ghes_estatus_caches[i]);
		if (cache == NULL) {
			slot = i;
			slot_cache = NULL;
			break;
		}
		duration = now - cache->time_in;
		if (duration >= GHES_ESTATUS_IN_CACHE_MAX_NSEC) {
			slot = i;
			slot_cache = cache;
			break;
		}
		count = atomic_read(&cache->count);
L
Len Brown 已提交
821 822
		period = duration;
		do_div(period, (count + 1));
823 824 825 826 827 828 829 830 831 832 833 834 835 836 837
		if (period > max_period) {
			max_period = period;
			slot = i;
			slot_cache = cache;
		}
	}
	/* new_cache must be put into array after its contents are written */
	smp_wmb();
	if (slot != -1 && cmpxchg(ghes_estatus_caches + slot,
				  slot_cache, new_cache) == slot_cache) {
		if (slot_cache)
			call_rcu(&slot_cache->rcu, ghes_estatus_cache_rcu_free);
	} else
		ghes_estatus_cache_free(new_cache);
	rcu_read_unlock();
838 839
}

840 841 842
static void __ghes_panic(struct ghes *ghes,
			 struct acpi_hest_generic_status *estatus,
			 u64 buf_paddr, enum fixed_addresses fixmap_idx)
843
{
844
	__ghes_print_estatus(KERN_EMERG, ghes->generic, estatus);
845

846
	ghes_clear_estatus(ghes, estatus, buf_paddr, fixmap_idx);
847

848 849 850 851 852 853
	/* reboot to log the error! */
	if (!panic_timeout)
		panic_timeout = ghes_panic_timeout;
	panic("Fatal hardware error!");
}

854 855
static int ghes_proc(struct ghes *ghes)
{
856
	struct acpi_hest_generic_status *estatus = ghes->estatus;
857
	u64 buf_paddr;
858 859
	int rc;

860
	rc = ghes_read_estatus(ghes, estatus, &buf_paddr, FIX_APEI_GHES_IRQ);
861 862
	if (rc)
		goto out;
863

864 865
	if (ghes_severity(estatus->error_severity) >= GHES_SEV_PANIC)
		__ghes_panic(ghes, estatus, buf_paddr, FIX_APEI_GHES_IRQ);
866

867 868 869
	if (!ghes_estatus_cached(estatus)) {
		if (ghes_print_estatus(NULL, ghes->generic, estatus))
			ghes_estatus_cache_add(ghes->generic, estatus);
870
	}
871
	ghes_do_proc(ghes, estatus);
872

873
out:
874
	ghes_clear_estatus(ghes, estatus, buf_paddr, FIX_APEI_GHES_IRQ);
875

876
	return rc;
877 878
}

879 880 881 882 883 884
static void ghes_add_timer(struct ghes *ghes)
{
	struct acpi_hest_generic *g = ghes->generic;
	unsigned long expire;

	if (!g->notify.poll_interval) {
885 886
		pr_warn(FW_WARN GHES_PFX "Poll interval is 0 for generic hardware error source: %d, disabled.\n",
			g->header.source_id);
887 888 889 890 891 892 893
		return;
	}
	expire = jiffies + msecs_to_jiffies(g->notify.poll_interval);
	ghes->timer.expires = round_jiffies_relative(expire);
	add_timer(&ghes->timer);
}

894
static void ghes_poll_func(struct timer_list *t)
895
{
896
	struct ghes *ghes = from_timer(ghes, t, timer);
897
	unsigned long flags;
898

899
	spin_lock_irqsave(&ghes_notify_lock_irq, flags);
900
	ghes_proc(ghes);
901
	spin_unlock_irqrestore(&ghes_notify_lock_irq, flags);
902 903 904 905 906 907 908
	if (!(ghes->flags & GHES_EXITING))
		ghes_add_timer(ghes);
}

static irqreturn_t ghes_irq_func(int irq, void *data)
{
	struct ghes *ghes = data;
909
	unsigned long flags;
910 911
	int rc;

912
	spin_lock_irqsave(&ghes_notify_lock_irq, flags);
913
	rc = ghes_proc(ghes);
914
	spin_unlock_irqrestore(&ghes_notify_lock_irq, flags);
915 916 917 918 919 920
	if (rc)
		return IRQ_NONE;

	return IRQ_HANDLED;
}

921 922
static int ghes_notify_hed(struct notifier_block *this, unsigned long event,
			   void *data)
923 924
{
	struct ghes *ghes;
925
	unsigned long flags;
926 927
	int ret = NOTIFY_DONE;

928
	spin_lock_irqsave(&ghes_notify_lock_irq, flags);
929
	rcu_read_lock();
930
	list_for_each_entry_rcu(ghes, &ghes_hed, list) {
931 932 933 934
		if (!ghes_proc(ghes))
			ret = NOTIFY_OK;
	}
	rcu_read_unlock();
935
	spin_unlock_irqrestore(&ghes_notify_lock_irq, flags);
936 937 938 939

	return ret;
}

940 941
static struct notifier_block ghes_notifier_hed = {
	.notifier_call = ghes_notify_hed,
942 943 944
};

/*
945 946 947 948 949 950 951 952 953
 * Handlers for CPER records may not be NMI safe. For example,
 * memory_failure_queue() takes spinlocks and calls schedule_work_on().
 * In any NMI-like handler, memory from ghes_estatus_pool is used to save
 * estatus, and added to the ghes_estatus_llist. irq_work_queue() causes
 * ghes_proc_in_irq() to run in IRQ context where each estatus in
 * ghes_estatus_llist is processed.
 *
 * Memory from the ghes_estatus_pool is also used with the ghes_estatus_cache
 * to suppress frequent messages.
954 955 956 957
 */
static struct llist_head ghes_estatus_llist;
static struct irq_work ghes_proc_irq_work;

958 959
static void ghes_proc_in_irq(struct irq_work *irq_work)
{
960
	struct llist_node *llnode, *next;
961
	struct ghes_estatus_node *estatus_node;
962
	struct acpi_hest_generic *generic;
963
	struct acpi_hest_generic_status *estatus;
964
	bool task_work_pending;
965
	u32 len, node_len;
966
	int ret;
967

968
	llnode = llist_del_all(&ghes_estatus_llist);
969 970 971 972
	/*
	 * Because the time order of estatus in list is reversed,
	 * revert it back to proper order.
	 */
973
	llnode = llist_reverse_order(llnode);
974 975 976 977 978
	while (llnode) {
		next = llnode->next;
		estatus_node = llist_entry(llnode, struct ghes_estatus_node,
					   llnode);
		estatus = GHES_ESTATUS_FROM_NODE(estatus_node);
C
Chen, Gong 已提交
979
		len = cper_estatus_len(estatus);
980
		node_len = GHES_ESTATUS_NODE_LEN(len);
981
		task_work_pending = ghes_do_proc(estatus_node->ghes, estatus);
982 983 984 985 986
		if (!ghes_estatus_cached(estatus)) {
			generic = estatus_node->generic;
			if (ghes_print_estatus(NULL, generic, estatus))
				ghes_estatus_cache_add(generic, estatus);
		}
987 988 989 990 991

		if (task_work_pending && current->mm != &init_mm) {
			estatus_node->task_work.func = ghes_kick_task_work;
			estatus_node->task_work_cpu = smp_processor_id();
			ret = task_work_add(current, &estatus_node->task_work,
J
Jens Axboe 已提交
992
					    TWA_RESUME);
993 994 995 996 997 998 999 1000
			if (ret)
				estatus_node->task_work.func = NULL;
		}

		if (!estatus_node->task_work.func)
			gen_pool_free(ghes_estatus_pool,
				      (unsigned long)estatus_node, node_len);

1001 1002 1003 1004
		llnode = next;
	}
}

1005 1006 1007 1008 1009
static void ghes_print_queued_estatus(void)
{
	struct llist_node *llnode;
	struct ghes_estatus_node *estatus_node;
	struct acpi_hest_generic *generic;
1010
	struct acpi_hest_generic_status *estatus;
1011 1012 1013 1014 1015 1016

	llnode = llist_del_all(&ghes_estatus_llist);
	/*
	 * Because the time order of estatus in list is reversed,
	 * revert it back to proper order.
	 */
1017
	llnode = llist_reverse_order(llnode);
1018 1019 1020 1021 1022 1023 1024 1025 1026 1027
	while (llnode) {
		estatus_node = llist_entry(llnode, struct ghes_estatus_node,
					   llnode);
		estatus = GHES_ESTATUS_FROM_NODE(estatus_node);
		generic = estatus_node->generic;
		ghes_print_estatus(NULL, generic, estatus);
		llnode = llnode->next;
	}
}

1028 1029
static int ghes_in_nmi_queue_one_entry(struct ghes *ghes,
				       enum fixed_addresses fixmap_idx)
1030
{
1031
	struct acpi_hest_generic_status *estatus, tmp_header;
1032
	struct ghes_estatus_node *estatus_node;
1033 1034 1035
	u32 len, node_len;
	u64 buf_paddr;
	int sev, rc;
1036

1037
	if (!IS_ENABLED(CONFIG_ARCH_HAVE_NMI_SAFE_CMPXCHG))
1038
		return -EOPNOTSUPP;
1039

1040 1041 1042 1043 1044
	rc = __ghes_peek_estatus(ghes, &tmp_header, &buf_paddr, fixmap_idx);
	if (rc) {
		ghes_clear_estatus(ghes, &tmp_header, buf_paddr, fixmap_idx);
		return rc;
	}
1045

1046 1047 1048 1049 1050
	rc = __ghes_check_estatus(ghes, &tmp_header);
	if (rc) {
		ghes_clear_estatus(ghes, &tmp_header, buf_paddr, fixmap_idx);
		return rc;
	}
1051

1052 1053
	len = cper_estatus_len(&tmp_header);
	node_len = GHES_ESTATUS_NODE_LEN(len);
1054 1055
	estatus_node = (void *)gen_pool_alloc(ghes_estatus_pool, node_len);
	if (!estatus_node)
1056
		return -ENOMEM;
1057 1058 1059

	estatus_node->ghes = ghes;
	estatus_node->generic = ghes->generic;
1060
	estatus_node->task_work.func = NULL;
1061 1062
	estatus = GHES_ESTATUS_FROM_NODE(estatus_node);

1063
	if (__ghes_read_estatus(estatus, buf_paddr, fixmap_idx, len)) {
1064
		ghes_clear_estatus(ghes, estatus, buf_paddr, fixmap_idx);
1065 1066
		rc = -ENOENT;
		goto no_work;
1067
	}
1068

1069
	sev = ghes_severity(estatus->error_severity);
1070 1071
	if (sev >= GHES_SEV_PANIC) {
		ghes_print_queued_estatus();
1072
		__ghes_panic(ghes, estatus, buf_paddr, fixmap_idx);
1073
	}
1074

1075
	ghes_clear_estatus(ghes, &tmp_header, buf_paddr, fixmap_idx);
1076

1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089
	/* This error has been reported before, don't process it again. */
	if (ghes_estatus_cached(estatus))
		goto no_work;

	llist_add(&estatus_node->llnode, &ghes_estatus_llist);

	return rc;

no_work:
	gen_pool_free(ghes_estatus_pool, (unsigned long)estatus_node,
		      node_len);

	return rc;
1090 1091
}

1092 1093
static int ghes_in_nmi_spool_from_list(struct list_head *rcu_list,
				       enum fixed_addresses fixmap_idx)
1094 1095 1096 1097 1098 1099
{
	int ret = -ENOENT;
	struct ghes *ghes;

	rcu_read_lock();
	list_for_each_entry_rcu(ghes, rcu_list, list) {
1100
		if (!ghes_in_nmi_queue_one_entry(ghes, fixmap_idx))
1101
			ret = 0;
1102
	}
1103
	rcu_read_unlock();
1104

1105
	if (IS_ENABLED(CONFIG_ARCH_HAVE_NMI_SAFE_CMPXCHG) && !ret)
1106
		irq_work_queue(&ghes_proc_irq_work);
1107 1108 1109

	return ret;
}
1110 1111 1112 1113 1114 1115 1116 1117 1118 1119

#ifdef CONFIG_ACPI_APEI_SEA
static LIST_HEAD(ghes_sea);

/*
 * Return 0 only if one of the SEA error sources successfully reported an error
 * record sent from the firmware.
 */
int ghes_notify_sea(void)
{
1120 1121 1122 1123
	static DEFINE_RAW_SPINLOCK(ghes_notify_lock_sea);
	int rv;

	raw_spin_lock(&ghes_notify_lock_sea);
1124
	rv = ghes_in_nmi_spool_from_list(&ghes_sea, FIX_APEI_GHES_SEA);
1125 1126 1127
	raw_spin_unlock(&ghes_notify_lock_sea);

	return rv;
1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156
}

static void ghes_sea_add(struct ghes *ghes)
{
	mutex_lock(&ghes_list_mutex);
	list_add_rcu(&ghes->list, &ghes_sea);
	mutex_unlock(&ghes_list_mutex);
}

static void ghes_sea_remove(struct ghes *ghes)
{
	mutex_lock(&ghes_list_mutex);
	list_del_rcu(&ghes->list);
	mutex_unlock(&ghes_list_mutex);
	synchronize_rcu();
}
#else /* CONFIG_ACPI_APEI_SEA */
static inline void ghes_sea_add(struct ghes *ghes) { }
static inline void ghes_sea_remove(struct ghes *ghes) { }
#endif /* CONFIG_ACPI_APEI_SEA */

#ifdef CONFIG_HAVE_ACPI_APEI_NMI
/*
 * NMI may be triggered on any CPU, so ghes_in_nmi is used for
 * having only one concurrent reader.
 */
static atomic_t ghes_in_nmi = ATOMIC_INIT(0);

static LIST_HEAD(ghes_nmi);
1157 1158 1159

static int ghes_notify_nmi(unsigned int cmd, struct pt_regs *regs)
{
1160
	static DEFINE_RAW_SPINLOCK(ghes_notify_lock_nmi);
1161 1162 1163 1164 1165
	int ret = NMI_DONE;

	if (!atomic_add_unless(&ghes_in_nmi, 1, 1))
		return ret;

1166
	raw_spin_lock(&ghes_notify_lock_nmi);
1167
	if (!ghes_in_nmi_spool_from_list(&ghes_nmi, FIX_APEI_GHES_NMI))
1168
		ret = NMI_HANDLED;
1169
	raw_spin_unlock(&ghes_notify_lock_nmi);
1170

1171
	atomic_dec(&ghes_in_nmi);
1172 1173 1174
	return ret;
}

1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196
static void ghes_nmi_add(struct ghes *ghes)
{
	mutex_lock(&ghes_list_mutex);
	if (list_empty(&ghes_nmi))
		register_nmi_handler(NMI_LOCAL, ghes_notify_nmi, 0, "ghes");
	list_add_rcu(&ghes->list, &ghes_nmi);
	mutex_unlock(&ghes_list_mutex);
}

static void ghes_nmi_remove(struct ghes *ghes)
{
	mutex_lock(&ghes_list_mutex);
	list_del_rcu(&ghes->list);
	if (list_empty(&ghes_nmi))
		unregister_nmi_handler(NMI_LOCAL, "ghes");
	mutex_unlock(&ghes_list_mutex);
	/*
	 * To synchronize with NMI handler, ghes can only be
	 * freed after NMI handler finishes.
	 */
	synchronize_rcu();
}
1197 1198 1199 1200
#else /* CONFIG_HAVE_ACPI_APEI_NMI */
static inline void ghes_nmi_add(struct ghes *ghes) { }
static inline void ghes_nmi_remove(struct ghes *ghes) { }
#endif /* CONFIG_HAVE_ACPI_APEI_NMI */
1201 1202 1203 1204 1205 1206

static void ghes_nmi_init_cxt(void)
{
	init_irq_work(&ghes_proc_irq_work, ghes_proc_in_irq);
}

1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263
static int __ghes_sdei_callback(struct ghes *ghes,
				enum fixed_addresses fixmap_idx)
{
	if (!ghes_in_nmi_queue_one_entry(ghes, fixmap_idx)) {
		irq_work_queue(&ghes_proc_irq_work);

		return 0;
	}

	return -ENOENT;
}

static int ghes_sdei_normal_callback(u32 event_num, struct pt_regs *regs,
				      void *arg)
{
	static DEFINE_RAW_SPINLOCK(ghes_notify_lock_sdei_normal);
	struct ghes *ghes = arg;
	int err;

	raw_spin_lock(&ghes_notify_lock_sdei_normal);
	err = __ghes_sdei_callback(ghes, FIX_APEI_GHES_SDEI_NORMAL);
	raw_spin_unlock(&ghes_notify_lock_sdei_normal);

	return err;
}

static int ghes_sdei_critical_callback(u32 event_num, struct pt_regs *regs,
				       void *arg)
{
	static DEFINE_RAW_SPINLOCK(ghes_notify_lock_sdei_critical);
	struct ghes *ghes = arg;
	int err;

	raw_spin_lock(&ghes_notify_lock_sdei_critical);
	err = __ghes_sdei_callback(ghes, FIX_APEI_GHES_SDEI_CRITICAL);
	raw_spin_unlock(&ghes_notify_lock_sdei_critical);

	return err;
}

static int apei_sdei_register_ghes(struct ghes *ghes)
{
	if (!IS_ENABLED(CONFIG_ARM_SDE_INTERFACE))
		return -EOPNOTSUPP;

	return sdei_register_ghes(ghes, ghes_sdei_normal_callback,
				 ghes_sdei_critical_callback);
}

static int apei_sdei_unregister_ghes(struct ghes *ghes)
{
	if (!IS_ENABLED(CONFIG_ARM_SDE_INTERFACE))
		return -EOPNOTSUPP;

	return sdei_unregister_ghes(ghes);
}

B
Bill Pemberton 已提交
1264
static int ghes_probe(struct platform_device *ghes_dev)
1265 1266 1267
{
	struct acpi_hest_generic *generic;
	struct ghes *ghes = NULL;
1268
	unsigned long flags;
1269

1270
	int rc = -EINVAL;
1271

1272
	generic = *(struct acpi_hest_generic **)ghes_dev->dev.platform_data;
1273
	if (!generic->enabled)
1274
		return -ENODEV;
1275

1276 1277 1278 1279
	switch (generic->notify.type) {
	case ACPI_HEST_NOTIFY_POLLED:
	case ACPI_HEST_NOTIFY_EXTERNAL:
	case ACPI_HEST_NOTIFY_SCI:
1280 1281
	case ACPI_HEST_NOTIFY_GSIV:
	case ACPI_HEST_NOTIFY_GPIO:
1282
		break;
1283

1284 1285 1286 1287 1288 1289 1290 1291
	case ACPI_HEST_NOTIFY_SEA:
		if (!IS_ENABLED(CONFIG_ACPI_APEI_SEA)) {
			pr_warn(GHES_PFX "Generic hardware error source: %d notified via SEA is not supported\n",
				generic->header.source_id);
			rc = -ENOTSUPP;
			goto err;
		}
		break;
1292
	case ACPI_HEST_NOTIFY_NMI:
1293 1294 1295 1296 1297
		if (!IS_ENABLED(CONFIG_HAVE_ACPI_APEI_NMI)) {
			pr_warn(GHES_PFX "Generic hardware error source: %d notified via NMI interrupt is not supported!\n",
				generic->header.source_id);
			goto err;
		}
1298
		break;
1299 1300 1301 1302 1303 1304 1305
	case ACPI_HEST_NOTIFY_SOFTWARE_DELEGATED:
		if (!IS_ENABLED(CONFIG_ARM_SDE_INTERFACE)) {
			pr_warn(GHES_PFX "Generic hardware error source: %d notified via SDE Interface is not supported!\n",
				generic->header.source_id);
			goto err;
		}
		break;
1306
	case ACPI_HEST_NOTIFY_LOCAL:
1307 1308
		pr_warn(GHES_PFX "Generic hardware error source: %d notified via local interrupt is not supported!\n",
			generic->header.source_id);
1309
		goto err;
1310
	default:
1311 1312
		pr_warn(FW_WARN GHES_PFX "Unknown notification type: %u for generic hardware error source: %d\n",
			generic->notify.type, generic->header.source_id);
1313
		goto err;
1314
	}
1315 1316 1317

	rc = -EIO;
	if (generic->error_block_length <
1318
	    sizeof(struct acpi_hest_generic_status)) {
1319 1320
		pr_warn(FW_BUG GHES_PFX "Invalid error block length: %u for generic hardware error source: %d\n",
			generic->error_block_length, generic->header.source_id);
1321 1322 1323 1324 1325 1326 1327 1328
		goto err;
	}
	ghes = ghes_new(generic);
	if (IS_ERR(ghes)) {
		rc = PTR_ERR(ghes);
		ghes = NULL;
		goto err;
	}
1329

1330 1331
	switch (generic->notify.type) {
	case ACPI_HEST_NOTIFY_POLLED:
1332
		timer_setup(&ghes->timer, ghes_poll_func, 0);
1333 1334 1335 1336
		ghes_add_timer(ghes);
		break;
	case ACPI_HEST_NOTIFY_EXTERNAL:
		/* External interrupt vector is GSI */
1337 1338
		rc = acpi_gsi_to_irq(generic->notify.vector, &ghes->irq);
		if (rc) {
1339 1340
			pr_err(GHES_PFX "Failed to map GSI to IRQ for generic hardware error source: %d\n",
			       generic->header.source_id);
1341
			goto err;
1342
		}
1343 1344
		rc = request_irq(ghes->irq, ghes_irq_func, IRQF_SHARED,
				 "GHES IRQ", ghes);
1345
		if (rc) {
1346 1347
			pr_err(GHES_PFX "Failed to register IRQ for generic hardware error source: %d\n",
			       generic->header.source_id);
1348
			goto err;
1349 1350
		}
		break;
1351

1352
	case ACPI_HEST_NOTIFY_SCI:
1353 1354
	case ACPI_HEST_NOTIFY_GSIV:
	case ACPI_HEST_NOTIFY_GPIO:
1355
		mutex_lock(&ghes_list_mutex);
1356 1357 1358
		if (list_empty(&ghes_hed))
			register_acpi_hed_notifier(&ghes_notifier_hed);
		list_add_rcu(&ghes->list, &ghes_hed);
1359
		mutex_unlock(&ghes_list_mutex);
1360
		break;
1361

1362 1363 1364
	case ACPI_HEST_NOTIFY_SEA:
		ghes_sea_add(ghes);
		break;
1365
	case ACPI_HEST_NOTIFY_NMI:
1366
		ghes_nmi_add(ghes);
1367
		break;
1368 1369 1370 1371 1372
	case ACPI_HEST_NOTIFY_SOFTWARE_DELEGATED:
		rc = apei_sdei_register_ghes(ghes);
		if (rc)
			goto err;
		break;
1373 1374
	default:
		BUG();
1375
	}
1376

1377
	platform_set_drvdata(ghes_dev, ghes);
1378

1379 1380
	ghes_edac_register(ghes, &ghes_dev->dev);

1381
	/* Handle any pending errors right away */
1382
	spin_lock_irqsave(&ghes_notify_lock_irq, flags);
1383
	ghes_proc(ghes);
1384
	spin_unlock_irqrestore(&ghes_notify_lock_irq, flags);
1385

1386
	return 0;
1387

1388
err:
1389
	if (ghes) {
1390
		ghes_fini(ghes);
1391 1392
		kfree(ghes);
	}
1393 1394 1395
	return rc;
}

B
Bill Pemberton 已提交
1396
static int ghes_remove(struct platform_device *ghes_dev)
1397
{
1398
	int rc;
1399 1400
	struct ghes *ghes;
	struct acpi_hest_generic *generic;
1401

1402 1403 1404
	ghes = platform_get_drvdata(ghes_dev);
	generic = ghes->generic;

1405
	ghes->flags |= GHES_EXITING;
1406
	switch (generic->notify.type) {
1407 1408 1409 1410 1411 1412
	case ACPI_HEST_NOTIFY_POLLED:
		del_timer_sync(&ghes->timer);
		break;
	case ACPI_HEST_NOTIFY_EXTERNAL:
		free_irq(ghes->irq, ghes);
		break;
1413

1414
	case ACPI_HEST_NOTIFY_SCI:
1415 1416
	case ACPI_HEST_NOTIFY_GSIV:
	case ACPI_HEST_NOTIFY_GPIO:
1417 1418
		mutex_lock(&ghes_list_mutex);
		list_del_rcu(&ghes->list);
1419 1420
		if (list_empty(&ghes_hed))
			unregister_acpi_hed_notifier(&ghes_notifier_hed);
1421
		mutex_unlock(&ghes_list_mutex);
1422
		synchronize_rcu();
1423
		break;
1424

1425 1426 1427
	case ACPI_HEST_NOTIFY_SEA:
		ghes_sea_remove(ghes);
		break;
1428
	case ACPI_HEST_NOTIFY_NMI:
1429
		ghes_nmi_remove(ghes);
1430
		break;
1431 1432 1433 1434 1435
	case ACPI_HEST_NOTIFY_SOFTWARE_DELEGATED:
		rc = apei_sdei_unregister_ghes(ghes);
		if (rc)
			return rc;
		break;
1436 1437 1438 1439
	default:
		BUG();
		break;
	}
1440

1441
	ghes_fini(ghes);
1442 1443 1444

	ghes_edac_unregister(ghes);

1445
	kfree(ghes);
1446

1447 1448 1449
	platform_set_drvdata(ghes_dev, NULL);

	return 0;
1450 1451
}

1452 1453 1454 1455 1456 1457 1458 1459
static struct platform_driver ghes_platform_driver = {
	.driver		= {
		.name	= "GHES",
	},
	.probe		= ghes_probe,
	.remove		= ghes_remove,
};

1460 1461
static int __init ghes_init(void)
{
1462 1463
	int rc;

1464 1465 1466
	if (acpi_disabled)
		return -ENODEV;

1467 1468 1469 1470
	switch (hest_disable) {
	case HEST_NOT_FOUND:
		return -ENODEV;
	case HEST_DISABLED:
1471 1472
		pr_info(GHES_PFX "HEST is not enabled!\n");
		return -EINVAL;
1473 1474
	default:
		break;
1475 1476
	}

1477 1478 1479 1480 1481
	if (ghes_disable) {
		pr_info(GHES_PFX "GHES is not enabled!\n");
		return -EINVAL;
	}

1482
	ghes_nmi_init_cxt();
1483 1484 1485

	rc = platform_driver_register(&ghes_platform_driver);
	if (rc)
1486
		goto err;
1487

H
Huang Ying 已提交
1488 1489 1490 1491 1492 1493 1494 1495 1496 1497
	rc = apei_osc_setup();
	if (rc == 0 && osc_sb_apei_support_acked)
		pr_info(GHES_PFX "APEI firmware first mode is enabled by APEI bit and WHEA _OSC.\n");
	else if (rc == 0 && !osc_sb_apei_support_acked)
		pr_info(GHES_PFX "APEI firmware first mode is enabled by WHEA _OSC.\n");
	else if (rc && osc_sb_apei_support_acked)
		pr_info(GHES_PFX "APEI firmware first mode is enabled by APEI bit.\n");
	else
		pr_info(GHES_PFX "Failed to enable APEI firmware first mode.\n");

1498 1499 1500
	return 0;
err:
	return rc;
1501
}
1502
device_initcall(ghes_init);