20ed2d56c1af6a3109ff3ea10843cda25d2a289e
[linux-3.10.git] / arch / arm / mach-imx / hotplug.c
1 /*
2  * Copyright 2011 Freescale Semiconductor, Inc.
3  * Copyright 2011 Linaro Ltd.
4  *
5  * The code contained herein is licensed under the GNU General Public
6  * License. You may obtain a copy of the GNU General Public License
7  * Version 2 or later at the following locations:
8  *
9  * http://www.opensource.org/licenses/gpl-license.html
10  * http://www.gnu.org/copyleft/gpl.html
11  */
12
13 #include <linux/errno.h>
14 #include <asm/cacheflush.h>
15 #include <asm/cp15.h>
16 #include <mach/common.h>
17
18 int platform_cpu_kill(unsigned int cpu)
19 {
20         return 1;
21 }
22
23 static inline void cpu_enter_lowpower(void)
24 {
25         unsigned int v;
26
27         flush_cache_all();
28         asm volatile(
29                 "mcr    p15, 0, %1, c7, c5, 0\n"
30         "       mcr     p15, 0, %1, c7, c10, 4\n"
31         /*
32          * Turn off coherency
33          */
34         "       mrc     p15, 0, %0, c1, c0, 1\n"
35         "       bic     %0, %0, %3\n"
36         "       mcr     p15, 0, %0, c1, c0, 1\n"
37         "       mrc     p15, 0, %0, c1, c0, 0\n"
38         "       bic     %0, %0, %2\n"
39         "       mcr     p15, 0, %0, c1, c0, 0\n"
40           : "=&r" (v)
41           : "r" (0), "Ir" (CR_C), "Ir" (0x40)
42           : "cc");
43 }
44
45 static inline void cpu_leave_lowpower(void)
46 {
47         unsigned int v;
48
49         asm volatile(
50                 "mrc    p15, 0, %0, c1, c0, 0\n"
51         "       orr     %0, %0, %1\n"
52         "       mcr     p15, 0, %0, c1, c0, 0\n"
53         "       mrc     p15, 0, %0, c1, c0, 1\n"
54         "       orr     %0, %0, %2\n"
55         "       mcr     p15, 0, %0, c1, c0, 1\n"
56           : "=&r" (v)
57           : "Ir" (CR_C), "Ir" (0x40)
58           : "cc");
59 }
60
61 /*
62  * platform-specific code to shutdown a CPU
63  *
64  * Called with IRQs disabled
65  */
66 void platform_cpu_die(unsigned int cpu)
67 {
68         cpu_enter_lowpower();
69         imx_enable_cpu(cpu, false);
70         cpu_do_idle();
71         cpu_leave_lowpower();
72
73         /* We should never return from idle */
74         panic("cpu %d unexpectedly exit from shutdown\n", cpu);
75 }
76
77 int platform_cpu_disable(unsigned int cpu)
78 {
79         /*
80          * we don't allow CPU 0 to be shutdown (it is still too special
81          * e.g. clock tick interrupts)
82          */
83         return cpu == 0 ? -EPERM : 0;
84 }