]>
Commit | Line | Data |
---|---|---|
d334a491 HY |
1 | /* |
2 | * APEI Generic Hardware Error Source support | |
3 | * | |
4 | * Generic Hardware Error Source provides a way to report platform | |
5 | * hardware errors (such as that from chipset). It works in so called | |
6 | * "Firmware First" mode, that is, hardware errors are reported to | |
7 | * firmware firstly, then reported to Linux by firmware. This way, | |
8 | * some non-standard hardware error registers or non-standard hardware | |
9 | * link can be checked by firmware to produce more hardware error | |
10 | * information for Linux. | |
11 | * | |
12 | * For more information about Generic Hardware Error Source, please | |
13 | * refer to ACPI Specification version 4.0, section 17.3.2.6 | |
14 | * | |
67eb2e99 | 15 | * Copyright 2010,2011 Intel Corp. |
d334a491 HY |
16 | * Author: Huang Ying <ying.huang@intel.com> |
17 | * | |
18 | * This program is free software; you can redistribute it and/or | |
19 | * modify it under the terms of the GNU General Public License version | |
20 | * 2 as published by the Free Software Foundation; | |
21 | * | |
22 | * This program is distributed in the hope that it will be useful, | |
23 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
24 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
25 | * GNU General Public License for more details. | |
d334a491 HY |
26 | */ |
27 | ||
28 | #include <linux/kernel.h> | |
020bf066 | 29 | #include <linux/moduleparam.h> |
d334a491 HY |
30 | #include <linux/init.h> |
31 | #include <linux/acpi.h> | |
32 | #include <linux/io.h> | |
33 | #include <linux/interrupt.h> | |
81e88fdc | 34 | #include <linux/timer.h> |
d334a491 HY |
35 | #include <linux/cper.h> |
36 | #include <linux/kdebug.h> | |
7ad6e943 HY |
37 | #include <linux/platform_device.h> |
38 | #include <linux/mutex.h> | |
32c361f5 | 39 | #include <linux/ratelimit.h> |
81e88fdc | 40 | #include <linux/vmalloc.h> |
67eb2e99 HY |
41 | #include <linux/irq_work.h> |
42 | #include <linux/llist.h> | |
43 | #include <linux/genalloc.h> | |
a654e5ee HY |
44 | #include <linux/pci.h> |
45 | #include <linux/aer.h> | |
44a69f61 | 46 | #include <linux/nmi.h> |
40e06415 MCC |
47 | |
48 | #include <acpi/ghes.h> | |
9dae3d0d | 49 | #include <acpi/apei.h> |
81e88fdc | 50 | #include <asm/tlbflush.h> |
d334a491 HY |
51 | |
52 | #include "apei-internal.h" | |
53 | ||
54 | #define GHES_PFX "GHES: " | |
55 | ||
56 | #define GHES_ESTATUS_MAX_SIZE 65536 | |
67eb2e99 HY |
57 | #define GHES_ESOURCE_PREALLOC_MAX_SIZE 65536 |
58 | ||
59 | #define GHES_ESTATUS_POOL_MIN_ALLOC_ORDER 3 | |
60 | ||
152cef40 HY |
61 | /* This is just an estimation for memory pool allocation */ |
62 | #define GHES_ESTATUS_CACHE_AVG_SIZE 512 | |
63 | ||
64 | #define GHES_ESTATUS_CACHES_SIZE 4 | |
65 | ||
70cb6e1d | 66 | #define GHES_ESTATUS_IN_CACHE_MAX_NSEC 10000000000ULL |
152cef40 HY |
67 | /* Prevent too many caches are allocated because of RCU */ |
68 | #define GHES_ESTATUS_CACHE_ALLOCED_MAX (GHES_ESTATUS_CACHES_SIZE * 3 / 2) | |
69 | ||
70 | #define GHES_ESTATUS_CACHE_LEN(estatus_len) \ | |
71 | (sizeof(struct ghes_estatus_cache) + (estatus_len)) | |
72 | #define GHES_ESTATUS_FROM_CACHE(estatus_cache) \ | |
0a00fd5e | 73 | ((struct acpi_hest_generic_status *) \ |
152cef40 HY |
74 | ((struct ghes_estatus_cache *)(estatus_cache) + 1)) |
75 | ||
67eb2e99 HY |
76 | #define GHES_ESTATUS_NODE_LEN(estatus_len) \ |
77 | (sizeof(struct ghes_estatus_node) + (estatus_len)) | |
88f074f4 | 78 | #define GHES_ESTATUS_FROM_NODE(estatus_node) \ |
0a00fd5e | 79 | ((struct acpi_hest_generic_status *) \ |
67eb2e99 | 80 | ((struct ghes_estatus_node *)(estatus_node) + 1)) |
d334a491 | 81 | |
020bf066 PG |
82 | /* |
83 | * This driver isn't really modular, however for the time being, | |
84 | * continuing to use module_param is the easiest way to remain | |
85 | * compatible with existing boot arg use cases. | |
86 | */ | |
90ab5ee9 | 87 | bool ghes_disable; |
b6a95016 HY |
88 | module_param_named(disable, ghes_disable, bool, 0); |
89 | ||
d334a491 | 90 | /* |
81e88fdc HY |
91 | * All error sources notified with SCI shares one notifier function, |
92 | * so they need to be linked and checked one by one. This is applied | |
93 | * to NMI too. | |
d334a491 | 94 | * |
81e88fdc HY |
95 | * RCU is used for these lists, so ghes_list_mutex is only used for |
96 | * list changing, not for traversing. | |
d334a491 HY |
97 | */ |
98 | static LIST_HEAD(ghes_sci); | |
7ad6e943 | 99 | static DEFINE_MUTEX(ghes_list_mutex); |
d334a491 | 100 | |
81e88fdc HY |
101 | /* |
102 | * Because the memory area used to transfer hardware error information | |
103 | * from BIOS to Linux can be determined only in NMI, IRQ or timer | |
104 | * handler, but general ioremap can not be used in atomic context, so | |
105 | * a special version of atomic ioremap is implemented for that. | |
106 | */ | |
107 | ||
108 | /* | |
594c7255 TN |
109 | * Two virtual pages are used, one for IRQ/PROCESS context, the other for |
110 | * NMI context (optionally). | |
81e88fdc | 111 | */ |
594c7255 TN |
112 | #ifdef CONFIG_HAVE_ACPI_APEI_NMI |
113 | #define GHES_IOREMAP_PAGES 2 | |
114 | #else | |
115 | #define GHES_IOREMAP_PAGES 1 | |
116 | #endif | |
117 | #define GHES_IOREMAP_IRQ_PAGE(base) (base) | |
118 | #define GHES_IOREMAP_NMI_PAGE(base) ((base) + PAGE_SIZE) | |
81e88fdc HY |
119 | |
120 | /* virtual memory area for atomic ioremap */ | |
121 | static struct vm_struct *ghes_ioremap_area; | |
122 | /* | |
123 | * These 2 spinlock is used to prevent atomic ioremap virtual memory | |
124 | * area from being mapped simultaneously. | |
125 | */ | |
126 | static DEFINE_RAW_SPINLOCK(ghes_ioremap_lock_nmi); | |
127 | static DEFINE_SPINLOCK(ghes_ioremap_lock_irq); | |
128 | ||
67eb2e99 HY |
129 | static struct gen_pool *ghes_estatus_pool; |
130 | static unsigned long ghes_estatus_pool_size_request; | |
67eb2e99 | 131 | |
8f7c31f6 | 132 | static struct ghes_estatus_cache *ghes_estatus_caches[GHES_ESTATUS_CACHES_SIZE]; |
152cef40 HY |
133 | static atomic_t ghes_estatus_cache_alloced; |
134 | ||
81e88fdc HY |
135 | static int ghes_ioremap_init(void) |
136 | { | |
137 | ghes_ioremap_area = __get_vm_area(PAGE_SIZE * GHES_IOREMAP_PAGES, | |
138 | VM_IOREMAP, VMALLOC_START, VMALLOC_END); | |
139 | if (!ghes_ioremap_area) { | |
140 | pr_err(GHES_PFX "Failed to allocate virtual memory area for atomic ioremap.\n"); | |
141 | return -ENOMEM; | |
142 | } | |
143 | ||
144 | return 0; | |
145 | } | |
146 | ||
147 | static void ghes_ioremap_exit(void) | |
148 | { | |
149 | free_vm_area(ghes_ioremap_area); | |
150 | } | |
151 | ||
152 | static void __iomem *ghes_ioremap_pfn_nmi(u64 pfn) | |
153 | { | |
154 | unsigned long vaddr; | |
155 | ||
156 | vaddr = (unsigned long)GHES_IOREMAP_NMI_PAGE(ghes_ioremap_area->addr); | |
157 | ioremap_page_range(vaddr, vaddr + PAGE_SIZE, | |
158 | pfn << PAGE_SHIFT, PAGE_KERNEL); | |
159 | ||
160 | return (void __iomem *)vaddr; | |
161 | } | |
162 | ||
163 | static void __iomem *ghes_ioremap_pfn_irq(u64 pfn) | |
164 | { | |
8ece249a JZZ |
165 | unsigned long vaddr, paddr; |
166 | pgprot_t prot; | |
81e88fdc HY |
167 | |
168 | vaddr = (unsigned long)GHES_IOREMAP_IRQ_PAGE(ghes_ioremap_area->addr); | |
8ece249a JZZ |
169 | |
170 | paddr = pfn << PAGE_SHIFT; | |
171 | prot = arch_apei_get_mem_attribute(paddr); | |
172 | ||
173 | ioremap_page_range(vaddr, vaddr + PAGE_SIZE, paddr, prot); | |
81e88fdc HY |
174 | |
175 | return (void __iomem *)vaddr; | |
176 | } | |
177 | ||
178 | static void ghes_iounmap_nmi(void __iomem *vaddr_ptr) | |
179 | { | |
180 | unsigned long vaddr = (unsigned long __force)vaddr_ptr; | |
181 | void *base = ghes_ioremap_area->addr; | |
182 | ||
183 | BUG_ON(vaddr != (unsigned long)GHES_IOREMAP_NMI_PAGE(base)); | |
184 | unmap_kernel_range_noflush(vaddr, PAGE_SIZE); | |
594c7255 | 185 | arch_apei_flush_tlb_one(vaddr); |
81e88fdc HY |
186 | } |
187 | ||
188 | static void ghes_iounmap_irq(void __iomem *vaddr_ptr) | |
189 | { | |
190 | unsigned long vaddr = (unsigned long __force)vaddr_ptr; | |
191 | void *base = ghes_ioremap_area->addr; | |
192 | ||
193 | BUG_ON(vaddr != (unsigned long)GHES_IOREMAP_IRQ_PAGE(base)); | |
194 | unmap_kernel_range_noflush(vaddr, PAGE_SIZE); | |
594c7255 | 195 | arch_apei_flush_tlb_one(vaddr); |
81e88fdc HY |
196 | } |
197 | ||
67eb2e99 HY |
198 | static int ghes_estatus_pool_init(void) |
199 | { | |
200 | ghes_estatus_pool = gen_pool_create(GHES_ESTATUS_POOL_MIN_ALLOC_ORDER, -1); | |
201 | if (!ghes_estatus_pool) | |
202 | return -ENOMEM; | |
203 | return 0; | |
204 | } | |
205 | ||
206 | static void ghes_estatus_pool_free_chunk_page(struct gen_pool *pool, | |
207 | struct gen_pool_chunk *chunk, | |
208 | void *data) | |
209 | { | |
210 | free_page(chunk->start_addr); | |
211 | } | |
212 | ||
213 | static void ghes_estatus_pool_exit(void) | |
214 | { | |
215 | gen_pool_for_each_chunk(ghes_estatus_pool, | |
216 | ghes_estatus_pool_free_chunk_page, NULL); | |
217 | gen_pool_destroy(ghes_estatus_pool); | |
218 | } | |
219 | ||
220 | static int ghes_estatus_pool_expand(unsigned long len) | |
221 | { | |
222 | unsigned long i, pages, size, addr; | |
223 | int ret; | |
224 | ||
225 | ghes_estatus_pool_size_request += PAGE_ALIGN(len); | |
226 | size = gen_pool_size(ghes_estatus_pool); | |
227 | if (size >= ghes_estatus_pool_size_request) | |
228 | return 0; | |
229 | pages = (ghes_estatus_pool_size_request - size) / PAGE_SIZE; | |
230 | for (i = 0; i < pages; i++) { | |
231 | addr = __get_free_page(GFP_KERNEL); | |
232 | if (!addr) | |
233 | return -ENOMEM; | |
234 | ret = gen_pool_add(ghes_estatus_pool, addr, PAGE_SIZE, -1); | |
235 | if (ret) | |
236 | return ret; | |
237 | } | |
238 | ||
239 | return 0; | |
240 | } | |
241 | ||
d334a491 HY |
242 | static struct ghes *ghes_new(struct acpi_hest_generic *generic) |
243 | { | |
244 | struct ghes *ghes; | |
245 | unsigned int error_block_length; | |
246 | int rc; | |
247 | ||
248 | ghes = kzalloc(sizeof(*ghes), GFP_KERNEL); | |
249 | if (!ghes) | |
250 | return ERR_PTR(-ENOMEM); | |
251 | ghes->generic = generic; | |
34ddeb03 | 252 | rc = apei_map_generic_address(&generic->error_status_address); |
d334a491 HY |
253 | if (rc) |
254 | goto err_free; | |
255 | error_block_length = generic->error_block_length; | |
256 | if (error_block_length > GHES_ESTATUS_MAX_SIZE) { | |
257 | pr_warning(FW_WARN GHES_PFX | |
258 | "Error status block length is too long: %u for " | |
259 | "generic hardware error source: %d.\n", | |
260 | error_block_length, generic->header.source_id); | |
261 | error_block_length = GHES_ESTATUS_MAX_SIZE; | |
262 | } | |
263 | ghes->estatus = kmalloc(error_block_length, GFP_KERNEL); | |
264 | if (!ghes->estatus) { | |
265 | rc = -ENOMEM; | |
266 | goto err_unmap; | |
267 | } | |
268 | ||
269 | return ghes; | |
270 | ||
271 | err_unmap: | |
34ddeb03 | 272 | apei_unmap_generic_address(&generic->error_status_address); |
d334a491 HY |
273 | err_free: |
274 | kfree(ghes); | |
275 | return ERR_PTR(rc); | |
276 | } | |
277 | ||
278 | static void ghes_fini(struct ghes *ghes) | |
279 | { | |
280 | kfree(ghes->estatus); | |
34ddeb03 | 281 | apei_unmap_generic_address(&ghes->generic->error_status_address); |
d334a491 HY |
282 | } |
283 | ||
d334a491 HY |
284 | static inline int ghes_severity(int severity) |
285 | { | |
286 | switch (severity) { | |
ad4ecef2 HY |
287 | case CPER_SEV_INFORMATIONAL: |
288 | return GHES_SEV_NO; | |
289 | case CPER_SEV_CORRECTED: | |
290 | return GHES_SEV_CORRECTED; | |
291 | case CPER_SEV_RECOVERABLE: | |
292 | return GHES_SEV_RECOVERABLE; | |
293 | case CPER_SEV_FATAL: | |
294 | return GHES_SEV_PANIC; | |
d334a491 | 295 | default: |
25985edc | 296 | /* Unknown, go panic */ |
ad4ecef2 | 297 | return GHES_SEV_PANIC; |
d334a491 HY |
298 | } |
299 | } | |
300 | ||
81e88fdc HY |
301 | static void ghes_copy_tofrom_phys(void *buffer, u64 paddr, u32 len, |
302 | int from_phys) | |
d334a491 | 303 | { |
81e88fdc HY |
304 | void __iomem *vaddr; |
305 | unsigned long flags = 0; | |
306 | int in_nmi = in_nmi(); | |
307 | u64 offset; | |
308 | u32 trunk; | |
309 | ||
310 | while (len > 0) { | |
311 | offset = paddr - (paddr & PAGE_MASK); | |
312 | if (in_nmi) { | |
313 | raw_spin_lock(&ghes_ioremap_lock_nmi); | |
314 | vaddr = ghes_ioremap_pfn_nmi(paddr >> PAGE_SHIFT); | |
315 | } else { | |
316 | spin_lock_irqsave(&ghes_ioremap_lock_irq, flags); | |
317 | vaddr = ghes_ioremap_pfn_irq(paddr >> PAGE_SHIFT); | |
318 | } | |
319 | trunk = PAGE_SIZE - offset; | |
320 | trunk = min(trunk, len); | |
321 | if (from_phys) | |
322 | memcpy_fromio(buffer, vaddr + offset, trunk); | |
323 | else | |
324 | memcpy_toio(vaddr + offset, buffer, trunk); | |
325 | len -= trunk; | |
326 | paddr += trunk; | |
327 | buffer += trunk; | |
328 | if (in_nmi) { | |
329 | ghes_iounmap_nmi(vaddr); | |
330 | raw_spin_unlock(&ghes_ioremap_lock_nmi); | |
331 | } else { | |
332 | ghes_iounmap_irq(vaddr); | |
333 | spin_unlock_irqrestore(&ghes_ioremap_lock_irq, flags); | |
334 | } | |
335 | } | |
d334a491 HY |
336 | } |
337 | ||
338 | static int ghes_read_estatus(struct ghes *ghes, int silent) | |
339 | { | |
340 | struct acpi_hest_generic *g = ghes->generic; | |
341 | u64 buf_paddr; | |
342 | u32 len; | |
343 | int rc; | |
344 | ||
700130b4 | 345 | rc = apei_read(&buf_paddr, &g->error_status_address); |
d334a491 HY |
346 | if (rc) { |
347 | if (!silent && printk_ratelimit()) | |
348 | pr_warning(FW_WARN GHES_PFX | |
349 | "Failed to read error status block address for hardware error source: %d.\n", | |
350 | g->header.source_id); | |
351 | return -EIO; | |
352 | } | |
353 | if (!buf_paddr) | |
354 | return -ENOENT; | |
355 | ||
81e88fdc HY |
356 | ghes_copy_tofrom_phys(ghes->estatus, buf_paddr, |
357 | sizeof(*ghes->estatus), 1); | |
d334a491 HY |
358 | if (!ghes->estatus->block_status) |
359 | return -ENOENT; | |
360 | ||
361 | ghes->buffer_paddr = buf_paddr; | |
362 | ghes->flags |= GHES_TO_CLEAR; | |
363 | ||
364 | rc = -EIO; | |
88f074f4 | 365 | len = cper_estatus_len(ghes->estatus); |
d334a491 HY |
366 | if (len < sizeof(*ghes->estatus)) |
367 | goto err_read_block; | |
368 | if (len > ghes->generic->error_block_length) | |
369 | goto err_read_block; | |
88f074f4 | 370 | if (cper_estatus_check_header(ghes->estatus)) |
d334a491 | 371 | goto err_read_block; |
81e88fdc HY |
372 | ghes_copy_tofrom_phys(ghes->estatus + 1, |
373 | buf_paddr + sizeof(*ghes->estatus), | |
374 | len - sizeof(*ghes->estatus), 1); | |
88f074f4 | 375 | if (cper_estatus_check(ghes->estatus)) |
d334a491 HY |
376 | goto err_read_block; |
377 | rc = 0; | |
378 | ||
379 | err_read_block: | |
81e88fdc | 380 | if (rc && !silent && printk_ratelimit()) |
d334a491 HY |
381 | pr_warning(FW_WARN GHES_PFX |
382 | "Failed to read error status block!\n"); | |
383 | return rc; | |
384 | } | |
385 | ||
386 | static void ghes_clear_estatus(struct ghes *ghes) | |
387 | { | |
388 | ghes->estatus->block_status = 0; | |
389 | if (!(ghes->flags & GHES_TO_CLEAR)) | |
390 | return; | |
391 | ghes_copy_tofrom_phys(ghes->estatus, ghes->buffer_paddr, | |
392 | sizeof(ghes->estatus->block_status), 0); | |
393 | ghes->flags &= ~GHES_TO_CLEAR; | |
394 | } | |
395 | ||
0a00fd5e | 396 | static void ghes_handle_memory_failure(struct acpi_hest_generic_data *gdata, int sev) |
cf870c70 NR |
397 | { |
398 | #ifdef CONFIG_ACPI_APEI_MEMORY_FAILURE | |
399 | unsigned long pfn; | |
ca104edc | 400 | int flags = -1; |
cf870c70 NR |
401 | int sec_sev = ghes_severity(gdata->error_severity); |
402 | struct cper_sec_mem_err *mem_err; | |
403 | mem_err = (struct cper_sec_mem_err *)(gdata + 1); | |
404 | ||
ca104edc CG |
405 | if (!(mem_err->validation_bits & CPER_MEM_VALID_PA)) |
406 | return; | |
407 | ||
408 | pfn = mem_err->physical_addr >> PAGE_SHIFT; | |
409 | if (!pfn_valid(pfn)) { | |
410 | pr_warn_ratelimited(FW_WARN GHES_PFX | |
411 | "Invalid address in generic error data: %#llx\n", | |
412 | mem_err->physical_addr); | |
413 | return; | |
cf870c70 | 414 | } |
ca104edc CG |
415 | |
416 | /* iff following two events can be handled properly by now */ | |
417 | if (sec_sev == GHES_SEV_CORRECTED && | |
418 | (gdata->flags & CPER_SEC_ERROR_THRESHOLD_EXCEEDED)) | |
419 | flags = MF_SOFT_OFFLINE; | |
420 | if (sev == GHES_SEV_RECOVERABLE && sec_sev == GHES_SEV_RECOVERABLE) | |
421 | flags = 0; | |
422 | ||
423 | if (flags != -1) | |
424 | memory_failure_queue(pfn, 0, flags); | |
cf870c70 NR |
425 | #endif |
426 | } | |
427 | ||
21480547 | 428 | static void ghes_do_proc(struct ghes *ghes, |
0a00fd5e | 429 | const struct acpi_hest_generic_status *estatus) |
d334a491 | 430 | { |
ba61ca4a | 431 | int sev, sec_sev; |
0a00fd5e | 432 | struct acpi_hest_generic_data *gdata; |
d334a491 | 433 | |
67eb2e99 HY |
434 | sev = ghes_severity(estatus->error_severity); |
435 | apei_estatus_for_each_section(estatus, gdata) { | |
ba61ca4a | 436 | sec_sev = ghes_severity(gdata->error_severity); |
d334a491 HY |
437 | if (!uuid_le_cmp(*(uuid_le *)gdata->section_type, |
438 | CPER_SEC_PLATFORM_MEM)) { | |
ba61ca4a HY |
439 | struct cper_sec_mem_err *mem_err; |
440 | mem_err = (struct cper_sec_mem_err *)(gdata+1); | |
21480547 MCC |
441 | ghes_edac_report_mem_error(ghes, sev, mem_err); |
442 | ||
9dae3d0d | 443 | arch_apei_report_mem_error(sev, mem_err); |
cf870c70 | 444 | ghes_handle_memory_failure(gdata, sev); |
ba61ca4a | 445 | } |
a654e5ee HY |
446 | #ifdef CONFIG_ACPI_APEI_PCIEAER |
447 | else if (!uuid_le_cmp(*(uuid_le *)gdata->section_type, | |
448 | CPER_SEC_PCIE)) { | |
449 | struct cper_sec_pcie *pcie_err; | |
450 | pcie_err = (struct cper_sec_pcie *)(gdata+1); | |
451 | if (sev == GHES_SEV_RECOVERABLE && | |
452 | sec_sev == GHES_SEV_RECOVERABLE && | |
453 | pcie_err->validation_bits & CPER_PCIE_VALID_DEVICE_ID && | |
454 | pcie_err->validation_bits & CPER_PCIE_VALID_AER_INFO) { | |
455 | unsigned int devfn; | |
456 | int aer_severity; | |
0ba98ec9 | 457 | |
a654e5ee HY |
458 | devfn = PCI_DEVFN(pcie_err->device_id.device, |
459 | pcie_err->device_id.function); | |
460 | aer_severity = cper_severity_to_aer(sev); | |
0ba98ec9 BD |
461 | |
462 | /* | |
463 | * If firmware reset the component to contain | |
464 | * the error, we must reinitialize it before | |
465 | * use, so treat it as a fatal AER error. | |
466 | */ | |
467 | if (gdata->flags & CPER_SEC_RESET) | |
468 | aer_severity = AER_FATAL; | |
469 | ||
a654e5ee HY |
470 | aer_recover_queue(pcie_err->device_id.segment, |
471 | pcie_err->device_id.bus, | |
37448adf LO |
472 | devfn, aer_severity, |
473 | (struct aer_capability_regs *) | |
474 | pcie_err->aer_info); | |
a654e5ee HY |
475 | } |
476 | ||
477 | } | |
478 | #endif | |
d334a491 | 479 | } |
32c361f5 | 480 | } |
d334a491 | 481 | |
67eb2e99 HY |
482 | static void __ghes_print_estatus(const char *pfx, |
483 | const struct acpi_hest_generic *generic, | |
0a00fd5e | 484 | const struct acpi_hest_generic_status *estatus) |
32c361f5 | 485 | { |
5ba82ab5 HY |
486 | static atomic_t seqno; |
487 | unsigned int curr_seqno; | |
488 | char pfx_seq[64]; | |
489 | ||
32c361f5 | 490 | if (pfx == NULL) { |
67eb2e99 | 491 | if (ghes_severity(estatus->error_severity) <= |
32c361f5 | 492 | GHES_SEV_CORRECTED) |
5ba82ab5 | 493 | pfx = KERN_WARNING; |
32c361f5 | 494 | else |
5ba82ab5 | 495 | pfx = KERN_ERR; |
32c361f5 | 496 | } |
5ba82ab5 HY |
497 | curr_seqno = atomic_inc_return(&seqno); |
498 | snprintf(pfx_seq, sizeof(pfx_seq), "%s{%u}" HW_ERR, pfx, curr_seqno); | |
5588340d | 499 | printk("%s""Hardware error from APEI Generic Hardware Error Source: %d\n", |
5ba82ab5 | 500 | pfx_seq, generic->header.source_id); |
88f074f4 | 501 | cper_estatus_print(pfx_seq, estatus); |
5588340d HY |
502 | } |
503 | ||
152cef40 HY |
504 | static int ghes_print_estatus(const char *pfx, |
505 | const struct acpi_hest_generic *generic, | |
0a00fd5e | 506 | const struct acpi_hest_generic_status *estatus) |
5588340d HY |
507 | { |
508 | /* Not more than 2 messages every 5 seconds */ | |
67eb2e99 HY |
509 | static DEFINE_RATELIMIT_STATE(ratelimit_corrected, 5*HZ, 2); |
510 | static DEFINE_RATELIMIT_STATE(ratelimit_uncorrected, 5*HZ, 2); | |
511 | struct ratelimit_state *ratelimit; | |
5588340d | 512 | |
67eb2e99 HY |
513 | if (ghes_severity(estatus->error_severity) <= GHES_SEV_CORRECTED) |
514 | ratelimit = &ratelimit_corrected; | |
515 | else | |
516 | ratelimit = &ratelimit_uncorrected; | |
152cef40 | 517 | if (__ratelimit(ratelimit)) { |
67eb2e99 | 518 | __ghes_print_estatus(pfx, generic, estatus); |
152cef40 HY |
519 | return 1; |
520 | } | |
521 | return 0; | |
522 | } | |
523 | ||
524 | /* | |
525 | * GHES error status reporting throttle, to report more kinds of | |
526 | * errors, instead of just most frequently occurred errors. | |
527 | */ | |
0a00fd5e | 528 | static int ghes_estatus_cached(struct acpi_hest_generic_status *estatus) |
152cef40 HY |
529 | { |
530 | u32 len; | |
531 | int i, cached = 0; | |
532 | unsigned long long now; | |
533 | struct ghes_estatus_cache *cache; | |
0a00fd5e | 534 | struct acpi_hest_generic_status *cache_estatus; |
152cef40 | 535 | |
88f074f4 | 536 | len = cper_estatus_len(estatus); |
152cef40 HY |
537 | rcu_read_lock(); |
538 | for (i = 0; i < GHES_ESTATUS_CACHES_SIZE; i++) { | |
539 | cache = rcu_dereference(ghes_estatus_caches[i]); | |
540 | if (cache == NULL) | |
541 | continue; | |
542 | if (len != cache->estatus_len) | |
543 | continue; | |
544 | cache_estatus = GHES_ESTATUS_FROM_CACHE(cache); | |
545 | if (memcmp(estatus, cache_estatus, len)) | |
546 | continue; | |
547 | atomic_inc(&cache->count); | |
548 | now = sched_clock(); | |
549 | if (now - cache->time_in < GHES_ESTATUS_IN_CACHE_MAX_NSEC) | |
550 | cached = 1; | |
551 | break; | |
552 | } | |
553 | rcu_read_unlock(); | |
554 | return cached; | |
555 | } | |
556 | ||
557 | static struct ghes_estatus_cache *ghes_estatus_cache_alloc( | |
558 | struct acpi_hest_generic *generic, | |
0a00fd5e | 559 | struct acpi_hest_generic_status *estatus) |
152cef40 HY |
560 | { |
561 | int alloced; | |
562 | u32 len, cache_len; | |
563 | struct ghes_estatus_cache *cache; | |
0a00fd5e | 564 | struct acpi_hest_generic_status *cache_estatus; |
152cef40 HY |
565 | |
566 | alloced = atomic_add_return(1, &ghes_estatus_cache_alloced); | |
567 | if (alloced > GHES_ESTATUS_CACHE_ALLOCED_MAX) { | |
568 | atomic_dec(&ghes_estatus_cache_alloced); | |
569 | return NULL; | |
570 | } | |
88f074f4 | 571 | len = cper_estatus_len(estatus); |
152cef40 HY |
572 | cache_len = GHES_ESTATUS_CACHE_LEN(len); |
573 | cache = (void *)gen_pool_alloc(ghes_estatus_pool, cache_len); | |
574 | if (!cache) { | |
575 | atomic_dec(&ghes_estatus_cache_alloced); | |
576 | return NULL; | |
577 | } | |
578 | cache_estatus = GHES_ESTATUS_FROM_CACHE(cache); | |
579 | memcpy(cache_estatus, estatus, len); | |
580 | cache->estatus_len = len; | |
581 | atomic_set(&cache->count, 0); | |
582 | cache->generic = generic; | |
583 | cache->time_in = sched_clock(); | |
584 | return cache; | |
585 | } | |
586 | ||
587 | static void ghes_estatus_cache_free(struct ghes_estatus_cache *cache) | |
588 | { | |
589 | u32 len; | |
590 | ||
88f074f4 | 591 | len = cper_estatus_len(GHES_ESTATUS_FROM_CACHE(cache)); |
152cef40 HY |
592 | len = GHES_ESTATUS_CACHE_LEN(len); |
593 | gen_pool_free(ghes_estatus_pool, (unsigned long)cache, len); | |
594 | atomic_dec(&ghes_estatus_cache_alloced); | |
595 | } | |
596 | ||
597 | static void ghes_estatus_cache_rcu_free(struct rcu_head *head) | |
598 | { | |
599 | struct ghes_estatus_cache *cache; | |
600 | ||
601 | cache = container_of(head, struct ghes_estatus_cache, rcu); | |
602 | ghes_estatus_cache_free(cache); | |
603 | } | |
604 | ||
605 | static void ghes_estatus_cache_add( | |
606 | struct acpi_hest_generic *generic, | |
0a00fd5e | 607 | struct acpi_hest_generic_status *estatus) |
152cef40 HY |
608 | { |
609 | int i, slot = -1, count; | |
610 | unsigned long long now, duration, period, max_period = 0; | |
611 | struct ghes_estatus_cache *cache, *slot_cache = NULL, *new_cache; | |
612 | ||
613 | new_cache = ghes_estatus_cache_alloc(generic, estatus); | |
614 | if (new_cache == NULL) | |
615 | return; | |
616 | rcu_read_lock(); | |
617 | now = sched_clock(); | |
618 | for (i = 0; i < GHES_ESTATUS_CACHES_SIZE; i++) { | |
619 | cache = rcu_dereference(ghes_estatus_caches[i]); | |
620 | if (cache == NULL) { | |
621 | slot = i; | |
622 | slot_cache = NULL; | |
623 | break; | |
624 | } | |
625 | duration = now - cache->time_in; | |
626 | if (duration >= GHES_ESTATUS_IN_CACHE_MAX_NSEC) { | |
627 | slot = i; | |
628 | slot_cache = cache; | |
629 | break; | |
630 | } | |
631 | count = atomic_read(&cache->count); | |
70cb6e1d LB |
632 | period = duration; |
633 | do_div(period, (count + 1)); | |
152cef40 HY |
634 | if (period > max_period) { |
635 | max_period = period; | |
636 | slot = i; | |
637 | slot_cache = cache; | |
638 | } | |
639 | } | |
640 | /* new_cache must be put into array after its contents are written */ | |
641 | smp_wmb(); | |
642 | if (slot != -1 && cmpxchg(ghes_estatus_caches + slot, | |
643 | slot_cache, new_cache) == slot_cache) { | |
644 | if (slot_cache) | |
645 | call_rcu(&slot_cache->rcu, ghes_estatus_cache_rcu_free); | |
646 | } else | |
647 | ghes_estatus_cache_free(new_cache); | |
648 | rcu_read_unlock(); | |
d334a491 HY |
649 | } |
650 | ||
651 | static int ghes_proc(struct ghes *ghes) | |
652 | { | |
653 | int rc; | |
654 | ||
655 | rc = ghes_read_estatus(ghes, 0); | |
656 | if (rc) | |
657 | goto out; | |
152cef40 HY |
658 | if (!ghes_estatus_cached(ghes->estatus)) { |
659 | if (ghes_print_estatus(NULL, ghes->generic, ghes->estatus)) | |
660 | ghes_estatus_cache_add(ghes->generic, ghes->estatus); | |
661 | } | |
21480547 | 662 | ghes_do_proc(ghes, ghes->estatus); |
d334a491 HY |
663 | out: |
664 | ghes_clear_estatus(ghes); | |
665 | return 0; | |
666 | } | |
667 | ||
81e88fdc HY |
668 | static void ghes_add_timer(struct ghes *ghes) |
669 | { | |
670 | struct acpi_hest_generic *g = ghes->generic; | |
671 | unsigned long expire; | |
672 | ||
673 | if (!g->notify.poll_interval) { | |
674 | pr_warning(FW_WARN GHES_PFX "Poll interval is 0 for generic hardware error source: %d, disabled.\n", | |
675 | g->header.source_id); | |
676 | return; | |
677 | } | |
678 | expire = jiffies + msecs_to_jiffies(g->notify.poll_interval); | |
679 | ghes->timer.expires = round_jiffies_relative(expire); | |
680 | add_timer(&ghes->timer); | |
681 | } | |
682 | ||
683 | static void ghes_poll_func(unsigned long data) | |
684 | { | |
685 | struct ghes *ghes = (void *)data; | |
686 | ||
687 | ghes_proc(ghes); | |
688 | if (!(ghes->flags & GHES_EXITING)) | |
689 | ghes_add_timer(ghes); | |
690 | } | |
691 | ||
692 | static irqreturn_t ghes_irq_func(int irq, void *data) | |
693 | { | |
694 | struct ghes *ghes = data; | |
695 | int rc; | |
696 | ||
697 | rc = ghes_proc(ghes); | |
698 | if (rc) | |
699 | return IRQ_NONE; | |
700 | ||
701 | return IRQ_HANDLED; | |
702 | } | |
703 | ||
d334a491 HY |
704 | static int ghes_notify_sci(struct notifier_block *this, |
705 | unsigned long event, void *data) | |
706 | { | |
707 | struct ghes *ghes; | |
708 | int ret = NOTIFY_DONE; | |
709 | ||
710 | rcu_read_lock(); | |
711 | list_for_each_entry_rcu(ghes, &ghes_sci, list) { | |
712 | if (!ghes_proc(ghes)) | |
713 | ret = NOTIFY_OK; | |
714 | } | |
715 | rcu_read_unlock(); | |
716 | ||
717 | return ret; | |
718 | } | |
719 | ||
44a69f61 TN |
720 | static struct notifier_block ghes_notifier_sci = { |
721 | .notifier_call = ghes_notify_sci, | |
722 | }; | |
723 | ||
724 | #ifdef CONFIG_HAVE_ACPI_APEI_NMI | |
725 | /* | |
726 | * printk is not safe in NMI context. So in NMI handler, we allocate | |
727 | * required memory from lock-less memory allocator | |
728 | * (ghes_estatus_pool), save estatus into it, put them into lock-less | |
729 | * list (ghes_estatus_llist), then delay printk into IRQ context via | |
730 | * irq_work (ghes_proc_irq_work). ghes_estatus_size_request record | |
731 | * required pool size by all NMI error source. | |
732 | */ | |
733 | static struct llist_head ghes_estatus_llist; | |
734 | static struct irq_work ghes_proc_irq_work; | |
735 | ||
736 | /* | |
6fe9e7c2 JK |
737 | * NMI may be triggered on any CPU, so ghes_in_nmi is used for |
738 | * having only one concurrent reader. | |
44a69f61 | 739 | */ |
6fe9e7c2 | 740 | static atomic_t ghes_in_nmi = ATOMIC_INIT(0); |
44a69f61 TN |
741 | |
742 | static LIST_HEAD(ghes_nmi); | |
743 | ||
744 | static int ghes_panic_timeout __read_mostly = 30; | |
745 | ||
67eb2e99 HY |
746 | static void ghes_proc_in_irq(struct irq_work *irq_work) |
747 | { | |
46d12f0b | 748 | struct llist_node *llnode, *next; |
67eb2e99 | 749 | struct ghes_estatus_node *estatus_node; |
152cef40 | 750 | struct acpi_hest_generic *generic; |
0a00fd5e | 751 | struct acpi_hest_generic_status *estatus; |
67eb2e99 HY |
752 | u32 len, node_len; |
753 | ||
46d12f0b | 754 | llnode = llist_del_all(&ghes_estatus_llist); |
67eb2e99 HY |
755 | /* |
756 | * Because the time order of estatus in list is reversed, | |
757 | * revert it back to proper order. | |
758 | */ | |
8d21d4c9 | 759 | llnode = llist_reverse_order(llnode); |
67eb2e99 HY |
760 | while (llnode) { |
761 | next = llnode->next; | |
762 | estatus_node = llist_entry(llnode, struct ghes_estatus_node, | |
763 | llnode); | |
764 | estatus = GHES_ESTATUS_FROM_NODE(estatus_node); | |
88f074f4 | 765 | len = cper_estatus_len(estatus); |
67eb2e99 | 766 | node_len = GHES_ESTATUS_NODE_LEN(len); |
21480547 | 767 | ghes_do_proc(estatus_node->ghes, estatus); |
152cef40 HY |
768 | if (!ghes_estatus_cached(estatus)) { |
769 | generic = estatus_node->generic; | |
770 | if (ghes_print_estatus(NULL, generic, estatus)) | |
771 | ghes_estatus_cache_add(generic, estatus); | |
772 | } | |
67eb2e99 HY |
773 | gen_pool_free(ghes_estatus_pool, (unsigned long)estatus_node, |
774 | node_len); | |
775 | llnode = next; | |
776 | } | |
777 | } | |
778 | ||
46d12f0b HY |
779 | static void ghes_print_queued_estatus(void) |
780 | { | |
781 | struct llist_node *llnode; | |
782 | struct ghes_estatus_node *estatus_node; | |
783 | struct acpi_hest_generic *generic; | |
0a00fd5e | 784 | struct acpi_hest_generic_status *estatus; |
46d12f0b HY |
785 | u32 len, node_len; |
786 | ||
787 | llnode = llist_del_all(&ghes_estatus_llist); | |
788 | /* | |
789 | * Because the time order of estatus in list is reversed, | |
790 | * revert it back to proper order. | |
791 | */ | |
8d21d4c9 | 792 | llnode = llist_reverse_order(llnode); |
46d12f0b HY |
793 | while (llnode) { |
794 | estatus_node = llist_entry(llnode, struct ghes_estatus_node, | |
795 | llnode); | |
796 | estatus = GHES_ESTATUS_FROM_NODE(estatus_node); | |
88f074f4 | 797 | len = cper_estatus_len(estatus); |
46d12f0b HY |
798 | node_len = GHES_ESTATUS_NODE_LEN(len); |
799 | generic = estatus_node->generic; | |
800 | ghes_print_estatus(NULL, generic, estatus); | |
801 | llnode = llnode->next; | |
802 | } | |
803 | } | |
804 | ||
11568496 BP |
805 | /* Save estatus for further processing in IRQ context */ |
806 | static void __process_error(struct ghes *ghes) | |
807 | { | |
808 | #ifdef CONFIG_ARCH_HAVE_NMI_SAFE_CMPXCHG | |
809 | u32 len, node_len; | |
810 | struct ghes_estatus_node *estatus_node; | |
811 | struct acpi_hest_generic_status *estatus; | |
812 | ||
813 | if (ghes_estatus_cached(ghes->estatus)) | |
814 | return; | |
815 | ||
816 | len = cper_estatus_len(ghes->estatus); | |
817 | node_len = GHES_ESTATUS_NODE_LEN(len); | |
818 | ||
819 | estatus_node = (void *)gen_pool_alloc(ghes_estatus_pool, node_len); | |
820 | if (!estatus_node) | |
821 | return; | |
822 | ||
823 | estatus_node->ghes = ghes; | |
824 | estatus_node->generic = ghes->generic; | |
825 | estatus = GHES_ESTATUS_FROM_NODE(estatus_node); | |
826 | memcpy(estatus, ghes->estatus, len); | |
827 | llist_add(&estatus_node->llnode, &ghes_estatus_llist); | |
828 | #endif | |
829 | } | |
830 | ||
e10be03f BP |
831 | static void __ghes_panic(struct ghes *ghes) |
832 | { | |
833 | oops_begin(); | |
834 | ghes_print_queued_estatus(); | |
835 | __ghes_print_estatus(KERN_EMERG, ghes->generic, ghes->estatus); | |
836 | ||
837 | /* reboot to log the error! */ | |
838 | if (panic_timeout == 0) | |
839 | panic_timeout = ghes_panic_timeout; | |
840 | panic("Fatal hardware error!"); | |
841 | } | |
842 | ||
9c48f1c6 | 843 | static int ghes_notify_nmi(unsigned int cmd, struct pt_regs *regs) |
81e88fdc | 844 | { |
6169ddf8 BP |
845 | struct ghes *ghes; |
846 | int sev, ret = NMI_DONE; | |
81e88fdc | 847 | |
6fe9e7c2 JK |
848 | if (!atomic_add_unless(&ghes_in_nmi, 1, 1)) |
849 | return ret; | |
850 | ||
81e88fdc HY |
851 | list_for_each_entry_rcu(ghes, &ghes_nmi, list) { |
852 | if (ghes_read_estatus(ghes, 1)) { | |
853 | ghes_clear_estatus(ghes); | |
854 | continue; | |
855 | } | |
6169ddf8 | 856 | |
81e88fdc | 857 | sev = ghes_severity(ghes->estatus->error_severity); |
6169ddf8 BP |
858 | if (sev >= GHES_SEV_PANIC) |
859 | __ghes_panic(ghes); | |
860 | ||
81e88fdc HY |
861 | if (!(ghes->flags & GHES_TO_CLEAR)) |
862 | continue; | |
11568496 BP |
863 | |
864 | __process_error(ghes); | |
81e88fdc | 865 | ghes_clear_estatus(ghes); |
2383844d BP |
866 | |
867 | ret = NMI_HANDLED; | |
81e88fdc | 868 | } |
11568496 | 869 | |
67eb2e99 HY |
870 | #ifdef CONFIG_ARCH_HAVE_NMI_SAFE_CMPXCHG |
871 | irq_work_queue(&ghes_proc_irq_work); | |
872 | #endif | |
6fe9e7c2 | 873 | atomic_dec(&ghes_in_nmi); |
81e88fdc HY |
874 | return ret; |
875 | } | |
876 | ||
67eb2e99 HY |
877 | static unsigned long ghes_esource_prealloc_size( |
878 | const struct acpi_hest_generic *generic) | |
879 | { | |
880 | unsigned long block_length, prealloc_records, prealloc_size; | |
881 | ||
882 | block_length = min_t(unsigned long, generic->error_block_length, | |
883 | GHES_ESTATUS_MAX_SIZE); | |
884 | prealloc_records = max_t(unsigned long, | |
885 | generic->records_to_preallocate, 1); | |
886 | prealloc_size = min_t(unsigned long, block_length * prealloc_records, | |
887 | GHES_ESOURCE_PREALLOC_MAX_SIZE); | |
888 | ||
889 | return prealloc_size; | |
890 | } | |
891 | ||
44a69f61 TN |
892 | static void ghes_estatus_pool_shrink(unsigned long len) |
893 | { | |
894 | ghes_estatus_pool_size_request -= PAGE_ALIGN(len); | |
895 | } | |
896 | ||
897 | static void ghes_nmi_add(struct ghes *ghes) | |
898 | { | |
899 | unsigned long len; | |
900 | ||
901 | len = ghes_esource_prealloc_size(ghes->generic); | |
902 | ghes_estatus_pool_expand(len); | |
903 | mutex_lock(&ghes_list_mutex); | |
904 | if (list_empty(&ghes_nmi)) | |
905 | register_nmi_handler(NMI_LOCAL, ghes_notify_nmi, 0, "ghes"); | |
906 | list_add_rcu(&ghes->list, &ghes_nmi); | |
907 | mutex_unlock(&ghes_list_mutex); | |
908 | } | |
909 | ||
910 | static void ghes_nmi_remove(struct ghes *ghes) | |
911 | { | |
912 | unsigned long len; | |
913 | ||
914 | mutex_lock(&ghes_list_mutex); | |
915 | list_del_rcu(&ghes->list); | |
916 | if (list_empty(&ghes_nmi)) | |
917 | unregister_nmi_handler(NMI_LOCAL, "ghes"); | |
918 | mutex_unlock(&ghes_list_mutex); | |
919 | /* | |
920 | * To synchronize with NMI handler, ghes can only be | |
921 | * freed after NMI handler finishes. | |
922 | */ | |
923 | synchronize_rcu(); | |
924 | len = ghes_esource_prealloc_size(ghes->generic); | |
925 | ghes_estatus_pool_shrink(len); | |
926 | } | |
927 | ||
928 | static void ghes_nmi_init_cxt(void) | |
929 | { | |
930 | init_irq_work(&ghes_proc_irq_work, ghes_proc_in_irq); | |
931 | } | |
932 | #else /* CONFIG_HAVE_ACPI_APEI_NMI */ | |
933 | static inline void ghes_nmi_add(struct ghes *ghes) | |
934 | { | |
935 | pr_err(GHES_PFX "ID: %d, trying to add NMI notification which is not supported!\n", | |
936 | ghes->generic->header.source_id); | |
937 | BUG(); | |
938 | } | |
939 | ||
940 | static inline void ghes_nmi_remove(struct ghes *ghes) | |
941 | { | |
942 | pr_err(GHES_PFX "ID: %d, trying to remove NMI notification which is not supported!\n", | |
943 | ghes->generic->header.source_id); | |
944 | BUG(); | |
945 | } | |
946 | ||
947 | static inline void ghes_nmi_init_cxt(void) | |
948 | { | |
949 | } | |
950 | #endif /* CONFIG_HAVE_ACPI_APEI_NMI */ | |
951 | ||
da095fd3 | 952 | static int ghes_probe(struct platform_device *ghes_dev) |
d334a491 HY |
953 | { |
954 | struct acpi_hest_generic *generic; | |
955 | struct ghes *ghes = NULL; | |
44a69f61 | 956 | |
7ad6e943 | 957 | int rc = -EINVAL; |
d334a491 | 958 | |
1dd6b20e | 959 | generic = *(struct acpi_hest_generic **)ghes_dev->dev.platform_data; |
d334a491 | 960 | if (!generic->enabled) |
7ad6e943 | 961 | return -ENODEV; |
d334a491 | 962 | |
81e88fdc HY |
963 | switch (generic->notify.type) { |
964 | case ACPI_HEST_NOTIFY_POLLED: | |
965 | case ACPI_HEST_NOTIFY_EXTERNAL: | |
966 | case ACPI_HEST_NOTIFY_SCI: | |
44a69f61 | 967 | break; |
81e88fdc | 968 | case ACPI_HEST_NOTIFY_NMI: |
44a69f61 TN |
969 | if (!IS_ENABLED(CONFIG_HAVE_ACPI_APEI_NMI)) { |
970 | pr_warn(GHES_PFX "Generic hardware error source: %d notified via NMI interrupt is not supported!\n", | |
971 | generic->header.source_id); | |
972 | goto err; | |
973 | } | |
81e88fdc HY |
974 | break; |
975 | case ACPI_HEST_NOTIFY_LOCAL: | |
976 | pr_warning(GHES_PFX "Generic hardware error source: %d notified via local interrupt is not supported!\n", | |
d334a491 HY |
977 | generic->header.source_id); |
978 | goto err; | |
81e88fdc HY |
979 | default: |
980 | pr_warning(FW_WARN GHES_PFX "Unknown notification type: %u for generic hardware error source: %d\n", | |
981 | generic->notify.type, generic->header.source_id); | |
982 | goto err; | |
d334a491 | 983 | } |
81e88fdc HY |
984 | |
985 | rc = -EIO; | |
986 | if (generic->error_block_length < | |
0a00fd5e | 987 | sizeof(struct acpi_hest_generic_status)) { |
81e88fdc HY |
988 | pr_warning(FW_BUG GHES_PFX "Invalid error block length: %u for generic hardware error source: %d\n", |
989 | generic->error_block_length, | |
d334a491 HY |
990 | generic->header.source_id); |
991 | goto err; | |
992 | } | |
993 | ghes = ghes_new(generic); | |
994 | if (IS_ERR(ghes)) { | |
995 | rc = PTR_ERR(ghes); | |
996 | ghes = NULL; | |
997 | goto err; | |
998 | } | |
21480547 MCC |
999 | |
1000 | rc = ghes_edac_register(ghes, &ghes_dev->dev); | |
1001 | if (rc < 0) | |
1002 | goto err; | |
1003 | ||
81e88fdc HY |
1004 | switch (generic->notify.type) { |
1005 | case ACPI_HEST_NOTIFY_POLLED: | |
1006 | ghes->timer.function = ghes_poll_func; | |
1007 | ghes->timer.data = (unsigned long)ghes; | |
1008 | init_timer_deferrable(&ghes->timer); | |
1009 | ghes_add_timer(ghes); | |
1010 | break; | |
1011 | case ACPI_HEST_NOTIFY_EXTERNAL: | |
1012 | /* External interrupt vector is GSI */ | |
a98d4f64 WY |
1013 | rc = acpi_gsi_to_irq(generic->notify.vector, &ghes->irq); |
1014 | if (rc) { | |
81e88fdc HY |
1015 | pr_err(GHES_PFX "Failed to map GSI to IRQ for generic hardware error source: %d\n", |
1016 | generic->header.source_id); | |
21480547 | 1017 | goto err_edac_unreg; |
81e88fdc | 1018 | } |
a98d4f64 WY |
1019 | rc = request_irq(ghes->irq, ghes_irq_func, 0, "GHES IRQ", ghes); |
1020 | if (rc) { | |
81e88fdc HY |
1021 | pr_err(GHES_PFX "Failed to register IRQ for generic hardware error source: %d\n", |
1022 | generic->header.source_id); | |
21480547 | 1023 | goto err_edac_unreg; |
81e88fdc HY |
1024 | } |
1025 | break; | |
1026 | case ACPI_HEST_NOTIFY_SCI: | |
7ad6e943 | 1027 | mutex_lock(&ghes_list_mutex); |
d334a491 HY |
1028 | if (list_empty(&ghes_sci)) |
1029 | register_acpi_hed_notifier(&ghes_notifier_sci); | |
1030 | list_add_rcu(&ghes->list, &ghes_sci); | |
7ad6e943 | 1031 | mutex_unlock(&ghes_list_mutex); |
81e88fdc HY |
1032 | break; |
1033 | case ACPI_HEST_NOTIFY_NMI: | |
44a69f61 | 1034 | ghes_nmi_add(ghes); |
81e88fdc HY |
1035 | break; |
1036 | default: | |
1037 | BUG(); | |
d334a491 | 1038 | } |
7ad6e943 | 1039 | platform_set_drvdata(ghes_dev, ghes); |
d334a491 HY |
1040 | |
1041 | return 0; | |
21480547 MCC |
1042 | err_edac_unreg: |
1043 | ghes_edac_unregister(ghes); | |
d334a491 | 1044 | err: |
7ad6e943 | 1045 | if (ghes) { |
d334a491 | 1046 | ghes_fini(ghes); |
7ad6e943 HY |
1047 | kfree(ghes); |
1048 | } | |
d334a491 HY |
1049 | return rc; |
1050 | } | |
1051 | ||
b59bc2fb | 1052 | static int ghes_remove(struct platform_device *ghes_dev) |
d334a491 | 1053 | { |
7ad6e943 HY |
1054 | struct ghes *ghes; |
1055 | struct acpi_hest_generic *generic; | |
d334a491 | 1056 | |
7ad6e943 HY |
1057 | ghes = platform_get_drvdata(ghes_dev); |
1058 | generic = ghes->generic; | |
1059 | ||
81e88fdc | 1060 | ghes->flags |= GHES_EXITING; |
7ad6e943 | 1061 | switch (generic->notify.type) { |
81e88fdc HY |
1062 | case ACPI_HEST_NOTIFY_POLLED: |
1063 | del_timer_sync(&ghes->timer); | |
1064 | break; | |
1065 | case ACPI_HEST_NOTIFY_EXTERNAL: | |
1066 | free_irq(ghes->irq, ghes); | |
1067 | break; | |
7ad6e943 HY |
1068 | case ACPI_HEST_NOTIFY_SCI: |
1069 | mutex_lock(&ghes_list_mutex); | |
1070 | list_del_rcu(&ghes->list); | |
1071 | if (list_empty(&ghes_sci)) | |
1072 | unregister_acpi_hed_notifier(&ghes_notifier_sci); | |
1073 | mutex_unlock(&ghes_list_mutex); | |
1074 | break; | |
81e88fdc | 1075 | case ACPI_HEST_NOTIFY_NMI: |
44a69f61 | 1076 | ghes_nmi_remove(ghes); |
81e88fdc | 1077 | break; |
7ad6e943 HY |
1078 | default: |
1079 | BUG(); | |
1080 | break; | |
1081 | } | |
d334a491 | 1082 | |
7ad6e943 | 1083 | ghes_fini(ghes); |
21480547 MCC |
1084 | |
1085 | ghes_edac_unregister(ghes); | |
1086 | ||
7ad6e943 | 1087 | kfree(ghes); |
d334a491 | 1088 | |
7ad6e943 HY |
1089 | platform_set_drvdata(ghes_dev, NULL); |
1090 | ||
1091 | return 0; | |
d334a491 HY |
1092 | } |
1093 | ||
7ad6e943 HY |
1094 | static struct platform_driver ghes_platform_driver = { |
1095 | .driver = { | |
1096 | .name = "GHES", | |
7ad6e943 HY |
1097 | }, |
1098 | .probe = ghes_probe, | |
1099 | .remove = ghes_remove, | |
1100 | }; | |
1101 | ||
d334a491 HY |
1102 | static int __init ghes_init(void) |
1103 | { | |
81e88fdc HY |
1104 | int rc; |
1105 | ||
d334a491 HY |
1106 | if (acpi_disabled) |
1107 | return -ENODEV; | |
1108 | ||
1109 | if (hest_disable) { | |
1110 | pr_info(GHES_PFX "HEST is not enabled!\n"); | |
1111 | return -EINVAL; | |
1112 | } | |
1113 | ||
b6a95016 HY |
1114 | if (ghes_disable) { |
1115 | pr_info(GHES_PFX "GHES is not enabled!\n"); | |
1116 | return -EINVAL; | |
1117 | } | |
1118 | ||
44a69f61 | 1119 | ghes_nmi_init_cxt(); |
67eb2e99 | 1120 | |
81e88fdc HY |
1121 | rc = ghes_ioremap_init(); |
1122 | if (rc) | |
1123 | goto err; | |
1124 | ||
67eb2e99 | 1125 | rc = ghes_estatus_pool_init(); |
81e88fdc HY |
1126 | if (rc) |
1127 | goto err_ioremap_exit; | |
1128 | ||
152cef40 HY |
1129 | rc = ghes_estatus_pool_expand(GHES_ESTATUS_CACHE_AVG_SIZE * |
1130 | GHES_ESTATUS_CACHE_ALLOCED_MAX); | |
1131 | if (rc) | |
1132 | goto err_pool_exit; | |
1133 | ||
67eb2e99 HY |
1134 | rc = platform_driver_register(&ghes_platform_driver); |
1135 | if (rc) | |
1136 | goto err_pool_exit; | |
1137 | ||
9fb0bfe1 HY |
1138 | rc = apei_osc_setup(); |
1139 | if (rc == 0 && osc_sb_apei_support_acked) | |
1140 | pr_info(GHES_PFX "APEI firmware first mode is enabled by APEI bit and WHEA _OSC.\n"); | |
1141 | else if (rc == 0 && !osc_sb_apei_support_acked) | |
1142 | pr_info(GHES_PFX "APEI firmware first mode is enabled by WHEA _OSC.\n"); | |
1143 | else if (rc && osc_sb_apei_support_acked) | |
1144 | pr_info(GHES_PFX "APEI firmware first mode is enabled by APEI bit.\n"); | |
1145 | else | |
1146 | pr_info(GHES_PFX "Failed to enable APEI firmware first mode.\n"); | |
1147 | ||
81e88fdc | 1148 | return 0; |
67eb2e99 HY |
1149 | err_pool_exit: |
1150 | ghes_estatus_pool_exit(); | |
81e88fdc HY |
1151 | err_ioremap_exit: |
1152 | ghes_ioremap_exit(); | |
1153 | err: | |
1154 | return rc; | |
d334a491 | 1155 | } |
020bf066 | 1156 | device_initcall(ghes_init); |