Commit | Line | Data |
---|---|---|
e8ce0eb5 | 1 | #include <linux/init.h> |
7604537b | 2 | #include <linux/slab.h> |
e8ce0eb5 | 3 | |
7604537b | 4 | #include <asm/cacheflush.h> |
e6eadc67 | 5 | #include <asm/idmap.h> |
e8ce0eb5 RK |
6 | #include <asm/pgalloc.h> |
7 | #include <asm/pgtable.h> | |
8 | #include <asm/memory.h> | |
7604537b | 9 | #include <asm/smp_plat.h> |
e8ce0eb5 RK |
10 | #include <asm/suspend.h> |
11 | #include <asm/tlbflush.h> | |
12 | ||
71a8986d | 13 | extern int __cpu_suspend(unsigned long, int (*)(unsigned long), u32 cpuid); |
62b2d07c | 14 | extern void cpu_resume_mmu(void); |
e8ce0eb5 | 15 | |
aa1aadc3 WD |
16 | #ifdef CONFIG_MMU |
17 | /* | |
18 | * Hide the first two arguments to __cpu_suspend - these are an implementation | |
19 | * detail which platform code shouldn't have to know about. | |
20 | */ | |
21 | int cpu_suspend(unsigned long arg, int (*fn)(unsigned long)) | |
22 | { | |
23 | struct mm_struct *mm = current->active_mm; | |
71a8986d | 24 | u32 __mpidr = cpu_logical_map(smp_processor_id()); |
aa1aadc3 WD |
25 | int ret; |
26 | ||
27 | if (!idmap_pgd) | |
28 | return -EINVAL; | |
29 | ||
30 | /* | |
31 | * Provide a temporary page table with an identity mapping for | |
32 | * the MMU-enable code, required for resuming. On successful | |
33 | * resume (indicated by a zero return code), we need to switch | |
34 | * back to the correct page tables. | |
35 | */ | |
71a8986d | 36 | ret = __cpu_suspend(arg, fn, __mpidr); |
aa1aadc3 WD |
37 | if (ret == 0) { |
38 | cpu_switch_mm(mm->pgd, mm); | |
39 | local_flush_bp_all(); | |
40 | local_flush_tlb_all(); | |
41 | } | |
42 | ||
43 | return ret; | |
44 | } | |
45 | #else | |
46 | int cpu_suspend(unsigned long arg, int (*fn)(unsigned long)) | |
47 | { | |
71a8986d NP |
48 | u32 __mpidr = cpu_logical_map(smp_processor_id()); |
49 | return __cpu_suspend(arg, fn, __mpidr); | |
aa1aadc3 WD |
50 | } |
51 | #define idmap_pgd NULL | |
52 | #endif | |
53 | ||
abda1bd5 RK |
54 | /* |
55 | * This is called by __cpu_suspend() to save the state, and do whatever | |
56 | * flushing is required to ensure that when the CPU goes to sleep we have | |
57 | * the necessary data available when the caches are not searched. | |
58 | */ | |
59 | void __cpu_suspend_save(u32 *ptr, u32 ptrsz, u32 sp, u32 *save_ptr) | |
60 | { | |
dbee0c6f LP |
61 | u32 *ctx = ptr; |
62 | ||
abda1bd5 RK |
63 | *save_ptr = virt_to_phys(ptr); |
64 | ||
65 | /* This must correspond to the LDM in cpu_resume() assembly */ | |
e6eadc67 | 66 | *ptr++ = virt_to_phys(idmap_pgd); |
abda1bd5 RK |
67 | *ptr++ = sp; |
68 | *ptr++ = virt_to_phys(cpu_do_resume); | |
69 | ||
70 | cpu_do_suspend(ptr); | |
71 | ||
dbee0c6f LP |
72 | flush_cache_louis(); |
73 | ||
74 | /* | |
75 | * flush_cache_louis does not guarantee that | |
76 | * save_ptr and ptr are cleaned to main memory, | |
77 | * just up to the Level of Unification Inner Shareable. | |
78 | * Since the context pointer and context itself | |
79 | * are to be retrieved with the MMU off that | |
80 | * data must be cleaned from all cache levels | |
81 | * to main memory using "area" cache primitives. | |
82 | */ | |
83 | __cpuc_flush_dcache_area(ctx, ptrsz); | |
84 | __cpuc_flush_dcache_area(save_ptr, sizeof(*save_ptr)); | |
85 | ||
8e6f83bb RK |
86 | outer_clean_range(*save_ptr, *save_ptr + ptrsz); |
87 | outer_clean_range(virt_to_phys(save_ptr), | |
88 | virt_to_phys(save_ptr) + sizeof(*save_ptr)); | |
abda1bd5 | 89 | } |
7604537b LP |
90 | |
91 | extern struct sleep_save_sp sleep_save_sp; | |
92 | ||
93 | static int cpu_suspend_alloc_sp(void) | |
94 | { | |
95 | void *ctx_ptr; | |
96 | /* ctx_ptr is an array of physical addresses */ | |
97 | ctx_ptr = kcalloc(mpidr_hash_size(), sizeof(u32), GFP_KERNEL); | |
98 | ||
99 | if (WARN_ON(!ctx_ptr)) | |
100 | return -ENOMEM; | |
101 | sleep_save_sp.save_ptr_stash = ctx_ptr; | |
102 | sleep_save_sp.save_ptr_stash_phys = virt_to_phys(ctx_ptr); | |
103 | sync_cache_w(&sleep_save_sp); | |
104 | return 0; | |
105 | } | |
106 | early_initcall(cpu_suspend_alloc_sp); |