Commit | Line | Data |
---|---|---|
f65aad41 RB |
1 | /* |
2 | * This file is subject to the terms and conditions of the GNU General Public | |
3 | * License. See the file "COPYING" in the main directory of this archive | |
4 | * for more details. | |
5 | * | |
e1ced097 DD |
6 | * Copyright (C) 2012 Cavium, Inc. |
7 | * | |
f65aad41 RB |
8 | * Copyright (C) 2009 Wind River Systems, |
9 | * written by Ralf Baechle <ralf@linux-mips.org> | |
10 | */ | |
11 | #include <linux/module.h> | |
12 | #include <linux/init.h> | |
13 | #include <linux/slab.h> | |
14 | #include <linux/interrupt.h> | |
15 | #include <linux/io.h> | |
16 | #include <linux/edac.h> | |
17 | ||
18 | #include "edac_core.h" | |
19 | #include "edac_module.h" | |
20 | ||
21 | #include <asm/octeon/cvmx.h> | |
22 | #include <asm/mipsregs.h> | |
23 | ||
f65aad41 RB |
24 | extern int register_co_cache_error_notifier(struct notifier_block *nb); |
25 | extern int unregister_co_cache_error_notifier(struct notifier_block *nb); | |
26 | ||
27 | extern unsigned long long cache_err_dcache[NR_CPUS]; | |
28 | ||
e1ced097 DD |
29 | struct co_cache_error { |
30 | struct notifier_block notifier; | |
31 | struct edac_device_ctl_info *ed; | |
32 | }; | |
f65aad41 | 33 | |
e1ced097 | 34 | /** |
f65aad41 RB |
35 | * EDAC CPU cache error callback |
36 | * | |
e1ced097 | 37 | * @event: non-zero if unrecoverable. |
f65aad41 | 38 | */ |
f65aad41 RB |
39 | static int co_cache_error_event(struct notifier_block *this, |
40 | unsigned long event, void *ptr) | |
41 | { | |
e1ced097 DD |
42 | struct co_cache_error *p = container_of(this, struct co_cache_error, |
43 | notifier); | |
44 | ||
f65aad41 RB |
45 | unsigned int core = cvmx_get_core_num(); |
46 | unsigned int cpu = smp_processor_id(); | |
e1ced097 DD |
47 | u64 icache_err = read_octeon_c0_icacheerr(); |
48 | u64 dcache_err; | |
49 | ||
50 | if (event) { | |
51 | dcache_err = cache_err_dcache[core]; | |
52 | cache_err_dcache[core] = 0; | |
53 | } else { | |
54 | dcache_err = read_octeon_c0_dcacheerr(); | |
55 | } | |
56 | ||
f65aad41 | 57 | if (icache_err & 1) { |
e1ced097 DD |
58 | edac_device_printk(p->ed, KERN_ERR, |
59 | "CacheErr (Icache):%llx, core %d/cpu %d, cp0_errorepc == %lx\n", | |
60 | (unsigned long long)icache_err, core, cpu, | |
61 | read_c0_errorepc()); | |
f65aad41 | 62 | write_octeon_c0_icacheerr(0); |
e1ced097 | 63 | edac_device_handle_ce(p->ed, cpu, 1, "icache"); |
f65aad41 | 64 | } |
e1ced097 DD |
65 | if (dcache_err & 1) { |
66 | edac_device_printk(p->ed, KERN_ERR, | |
67 | "CacheErr (Dcache):%llx, core %d/cpu %d, cp0_errorepc == %lx\n", | |
68 | (unsigned long long)dcache_err, core, cpu, | |
69 | read_c0_errorepc()); | |
70 | if (event) | |
71 | edac_device_handle_ue(p->ed, cpu, 0, "dcache"); | |
72 | else | |
73 | edac_device_handle_ce(p->ed, cpu, 0, "dcache"); | |
74 | ||
75 | /* Clear the error indication */ | |
75a15a78 | 76 | if (OCTEON_IS_OCTEON2()) |
e1ced097 DD |
77 | write_octeon_c0_dcacheerr(1); |
78 | else | |
79 | write_octeon_c0_dcacheerr(0); | |
f65aad41 RB |
80 | } |
81 | ||
e1ced097 | 82 | return NOTIFY_STOP; |
f65aad41 RB |
83 | } |
84 | ||
9b3c6e85 | 85 | static int co_cache_error_probe(struct platform_device *pdev) |
f65aad41 | 86 | { |
e1ced097 DD |
87 | struct co_cache_error *p = devm_kzalloc(&pdev->dev, sizeof(*p), |
88 | GFP_KERNEL); | |
89 | if (!p) | |
90 | return -ENOMEM; | |
91 | ||
92 | p->notifier.notifier_call = co_cache_error_event; | |
93 | platform_set_drvdata(pdev, p); | |
94 | ||
95 | p->ed = edac_device_alloc_ctl_info(0, "cpu", num_possible_cpus(), | |
96 | "cache", 2, 0, NULL, 0, | |
97 | edac_device_alloc_index()); | |
98 | if (!p->ed) | |
99 | goto err; | |
f65aad41 | 100 | |
e1ced097 | 101 | p->ed->dev = &pdev->dev; |
f65aad41 | 102 | |
e1ced097 | 103 | p->ed->dev_name = dev_name(&pdev->dev); |
f65aad41 | 104 | |
e1ced097 DD |
105 | p->ed->mod_name = "octeon-cpu"; |
106 | p->ed->ctl_name = "cache"; | |
f65aad41 | 107 | |
e1ced097 | 108 | if (edac_device_add_device(p->ed)) { |
f65aad41 | 109 | pr_err("%s: edac_device_add_device() failed\n", __func__); |
e1ced097 | 110 | goto err1; |
f65aad41 RB |
111 | } |
112 | ||
e1ced097 | 113 | register_co_cache_error_notifier(&p->notifier); |
f65aad41 RB |
114 | |
115 | return 0; | |
116 | ||
e1ced097 DD |
117 | err1: |
118 | edac_device_free_ctl_info(p->ed); | |
f65aad41 | 119 | err: |
e1ced097 | 120 | return -ENXIO; |
f65aad41 RB |
121 | } |
122 | ||
123 | static int co_cache_error_remove(struct platform_device *pdev) | |
124 | { | |
e1ced097 | 125 | struct co_cache_error *p = platform_get_drvdata(pdev); |
f65aad41 | 126 | |
e1ced097 | 127 | unregister_co_cache_error_notifier(&p->notifier); |
f65aad41 | 128 | edac_device_del_device(&pdev->dev); |
e1ced097 | 129 | edac_device_free_ctl_info(p->ed); |
f65aad41 RB |
130 | return 0; |
131 | } | |
132 | ||
133 | static struct platform_driver co_cache_error_driver = { | |
134 | .probe = co_cache_error_probe, | |
135 | .remove = co_cache_error_remove, | |
136 | .driver = { | |
e1ced097 | 137 | .name = "octeon_pc_edac", |
f65aad41 RB |
138 | } |
139 | }; | |
e1ced097 | 140 | module_platform_driver(co_cache_error_driver); |
f65aad41 RB |
141 | |
142 | MODULE_LICENSE("GPL"); | |
143 | MODULE_AUTHOR("Ralf Baechle <ralf@linux-mips.org>"); |