Commit | Line | Data |
---|---|---|
97991657 MD |
1 | /* |
2 | * sh7372 lowlevel sleep code for "Core Standby Mode" | |
3 | * | |
4 | * Copyright (C) 2011 Magnus Damm | |
5 | * | |
6 | * In "Core Standby Mode" the ARM core is off, but L2 cache is still on | |
7 | * | |
8 | * Based on mach-omap2/sleep34xx.S | |
9 | * | |
10 | * (C) Copyright 2007 Texas Instruments | |
11 | * Karthik Dasu <karthik-dp@ti.com> | |
12 | * | |
13 | * (C) Copyright 2004 Texas Instruments, <www.ti.com> | |
14 | * Richard Woodruff <r-woodruff2@ti.com> | |
15 | * | |
16 | * This program is free software; you can redistribute it and/or | |
17 | * modify it under the terms of the GNU General Public License as | |
18 | * published by the Free Software Foundation; either version 2 of | |
19 | * the License, or (at your option) any later version. | |
20 | * | |
21 | * This program is distributed in the hope that it will be useful, | |
22 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
23 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR /PURPOSE. See the | |
24 | * GNU General Public License for more details. | |
25 | * | |
26 | * You should have received a copy of the GNU General Public License | |
27 | * along with this program; if not, write to the Free Software | |
28 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | |
29 | * MA 02111-1307 USA | |
30 | */ | |
31 | ||
32 | #include <linux/linkage.h> | |
06b84166 MD |
33 | #include <linux/init.h> |
34 | #include <asm/memory.h> | |
97991657 MD |
35 | #include <asm/assembler.h> |
36 | ||
a0089bd6 | 37 | #if defined(CONFIG_SUSPEND) || defined(CONFIG_CPU_IDLE) |
97991657 MD |
38 | .align 12 |
39 | .text | |
f7dadb37 MD |
40 | .global sh7372_resume_core_standby_sysc |
41 | sh7372_resume_core_standby_sysc: | |
06b84166 | 42 | ldr pc, 1f |
e26f4067 MD |
43 | |
44 | .globl sh7372_cpu_resume | |
45 | sh7372_cpu_resume: | |
46 | 1: .space 4 | |
cf33835c | 47 | |
f7dadb37 MD |
48 | #define SPDCR 0xe6180008 |
49 | ||
50 | /* A3SM & A4S power down */ | |
51 | .global sh7372_do_idle_sysc | |
52 | sh7372_do_idle_sysc: | |
53 | mov r8, r0 /* sleep mode passed in r0 */ | |
54 | ||
cf33835c MD |
55 | /* |
56 | * Clear the SCTLR.C bit to prevent further data cache | |
57 | * allocation. Clearing SCTLR.C would make all the data accesses | |
58 | * strongly ordered and would not hit the cache. | |
59 | */ | |
60 | mrc p15, 0, r0, c1, c0, 0 | |
61 | bic r0, r0, #(1 << 2) @ Disable the C bit | |
62 | mcr p15, 0, r0, c1, c0, 0 | |
63 | isb | |
64 | ||
99161524 GL |
65 | /* |
66 | * Clean and invalidate data cache again. | |
67 | */ | |
68 | ldr r1, kernel_flush | |
69 | blx r1 | |
70 | ||
cf33835c MD |
71 | /* disable L2 cache in the aux control register */ |
72 | mrc p15, 0, r10, c1, c0, 1 | |
73 | bic r10, r10, #2 | |
74 | mcr p15, 0, r10, c1, c0, 1 | |
99161524 | 75 | isb |
cf33835c | 76 | |
cf33835c MD |
77 | /* |
78 | * The kernel doesn't interwork: v7_flush_dcache_all in particluar will | |
79 | * always return in Thumb state when CONFIG_THUMB2_KERNEL is enabled. | |
80 | * This sequence switches back to ARM. Note that .align may insert a | |
81 | * nop: bx pc needs to be word-aligned in order to work. | |
82 | */ | |
83 | THUMB( .thumb ) | |
84 | THUMB( .align ) | |
85 | THUMB( bx pc ) | |
86 | THUMB( nop ) | |
87 | .arm | |
88 | ||
89 | /* Data memory barrier and Data sync barrier */ | |
90 | dsb | |
91 | dmb | |
92 | ||
f7dadb37 | 93 | /* SYSC power down */ |
cf33835c | 94 | ldr r0, =SPDCR |
f7dadb37 | 95 | str r8, [r0] |
cf33835c MD |
96 | 1: |
97 | b 1b | |
98 | ||
99 | kernel_flush: | |
100 | .word v7_flush_dcache_all | |
a0089bd6 | 101 | #endif |