ARM: rockchip: rk3228: implement function rk3228_restart
[firefly-linux-kernel-4.4.55.git] / arch / arm / kernel / smp_tlb.c
1 /*
2  *  linux/arch/arm/kernel/smp_tlb.c
3  *
4  *  Copyright (C) 2002 ARM Limited, All Rights Reserved.
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 as
8  * published by the Free Software Foundation.
9  */
10 #include <linux/preempt.h>
11 #include <linux/smp.h>
12
13 #include <asm/smp_plat.h>
14 #include <asm/tlbflush.h>
15 #include <asm/mmu_context.h>
16
17 /**********************************************************************/
18
19 /*
20  * TLB operations
21  */
22 struct tlb_args {
23         struct vm_area_struct *ta_vma;
24         unsigned long ta_start;
25         unsigned long ta_end;
26 };
27
28 static inline void ipi_flush_tlb_all(void *ignored)
29 {
30         local_flush_tlb_all();
31 }
32
33 static inline void ipi_flush_tlb_mm(void *arg)
34 {
35         struct mm_struct *mm = (struct mm_struct *)arg;
36
37         local_flush_tlb_mm(mm);
38 }
39
40 static inline void ipi_flush_tlb_page(void *arg)
41 {
42         struct tlb_args *ta = (struct tlb_args *)arg;
43
44         local_flush_tlb_page(ta->ta_vma, ta->ta_start);
45 }
46
47 static inline void ipi_flush_tlb_kernel_page(void *arg)
48 {
49         struct tlb_args *ta = (struct tlb_args *)arg;
50
51         local_flush_tlb_kernel_page(ta->ta_start);
52 }
53
54 static inline void ipi_flush_tlb_range(void *arg)
55 {
56         struct tlb_args *ta = (struct tlb_args *)arg;
57
58         local_flush_tlb_range(ta->ta_vma, ta->ta_start, ta->ta_end);
59 }
60
61 static inline void ipi_flush_tlb_kernel_range(void *arg)
62 {
63         struct tlb_args *ta = (struct tlb_args *)arg;
64
65         local_flush_tlb_kernel_range(ta->ta_start, ta->ta_end);
66 }
67
68 static inline void ipi_flush_bp_all(void *ignored)
69 {
70         local_flush_bp_all();
71 }
72
73 #ifdef CONFIG_ARM_ERRATA_798181
74 static int erratum_a15_798181(void)
75 {
76         unsigned int midr = read_cpuid_id();
77
78         /* Cortex-A15 r0p0..r3p2 affected */
79         if ((midr & 0xff0ffff0) != 0x410fc0f0 || midr > 0x413fc0f2)
80                 return 0;
81         return 1;
82 }
83 #else
84 static int erratum_a15_798181(void)
85 {
86         return 0;
87 }
88 #endif
89
90 static void ipi_flush_tlb_a15_erratum(void *arg)
91 {
92         dmb();
93 }
94
95 static void broadcast_tlb_a15_erratum(void)
96 {
97         if (!erratum_a15_798181())
98                 return;
99
100         dummy_flush_tlb_a15_erratum();
101         smp_call_function(ipi_flush_tlb_a15_erratum, NULL, 1);
102 }
103
104 static void broadcast_tlb_mm_a15_erratum(struct mm_struct *mm)
105 {
106         int this_cpu;
107         cpumask_t mask = { CPU_BITS_NONE };
108
109         if (!erratum_a15_798181())
110                 return;
111
112         dummy_flush_tlb_a15_erratum();
113         this_cpu = get_cpu();
114         a15_erratum_get_cpumask(this_cpu, mm, &mask);
115         smp_call_function_many(&mask, ipi_flush_tlb_a15_erratum, NULL, 1);
116         put_cpu();
117 }
118
119 void flush_tlb_all(void)
120 {
121         if (tlb_ops_need_broadcast())
122                 on_each_cpu(ipi_flush_tlb_all, NULL, 1);
123         else
124                 local_flush_tlb_all();
125         broadcast_tlb_a15_erratum();
126 }
127
128 void flush_tlb_mm(struct mm_struct *mm)
129 {
130         if (tlb_ops_need_broadcast())
131                 on_each_cpu_mask(mm_cpumask(mm), ipi_flush_tlb_mm, mm, 1);
132         else
133                 local_flush_tlb_mm(mm);
134         broadcast_tlb_mm_a15_erratum(mm);
135 }
136
137 void flush_tlb_page(struct vm_area_struct *vma, unsigned long uaddr)
138 {
139         if (tlb_ops_need_broadcast()) {
140                 struct tlb_args ta;
141                 ta.ta_vma = vma;
142                 ta.ta_start = uaddr;
143                 on_each_cpu_mask(mm_cpumask(vma->vm_mm), ipi_flush_tlb_page,
144                                         &ta, 1);
145         } else
146                 local_flush_tlb_page(vma, uaddr);
147         broadcast_tlb_mm_a15_erratum(vma->vm_mm);
148 }
149
150 void flush_tlb_kernel_page(unsigned long kaddr)
151 {
152         if (tlb_ops_need_broadcast()) {
153                 struct tlb_args ta;
154                 ta.ta_start = kaddr;
155                 on_each_cpu(ipi_flush_tlb_kernel_page, &ta, 1);
156         } else
157                 local_flush_tlb_kernel_page(kaddr);
158         broadcast_tlb_a15_erratum();
159 }
160
161 void flush_tlb_range(struct vm_area_struct *vma,
162                      unsigned long start, unsigned long end)
163 {
164         if (tlb_ops_need_broadcast()) {
165                 struct tlb_args ta;
166                 ta.ta_vma = vma;
167                 ta.ta_start = start;
168                 ta.ta_end = end;
169                 on_each_cpu_mask(mm_cpumask(vma->vm_mm), ipi_flush_tlb_range,
170                                         &ta, 1);
171         } else
172                 local_flush_tlb_range(vma, start, end);
173         broadcast_tlb_mm_a15_erratum(vma->vm_mm);
174 }
175
176 void flush_tlb_kernel_range(unsigned long start, unsigned long end)
177 {
178         if (tlb_ops_need_broadcast()) {
179                 struct tlb_args ta;
180                 ta.ta_start = start;
181                 ta.ta_end = end;
182                 on_each_cpu(ipi_flush_tlb_kernel_range, &ta, 1);
183         } else
184                 local_flush_tlb_kernel_range(start, end);
185         broadcast_tlb_a15_erratum();
186 }
187
188 void flush_bp_all(void)
189 {
190         if (tlb_ops_need_broadcast())
191                 on_each_cpu(ipi_flush_bp_all, NULL, 1);
192         else
193                 local_flush_bp_all();
194 }