ad14dbc07db8d4a135fdb64226b4ae87f87b7ddc
2 * Based on arch/arm/kernel/process.c
4 * Original Copyright (C) 1995 Linus Torvalds
5 * Copyright (C) 1996-2000 Russell King - Converted to ARM.
6 * Copyright (C) 2012 ARM Ltd.
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program. If not, see <http://www.gnu.org/licenses/>.
23 #include <linux/compat.h>
24 #include <linux/export.h>
25 #include <linux/sched.h>
26 #include <linux/kernel.h>
28 #include <linux/stddef.h>
29 #include <linux/unistd.h>
30 #include <linux/user.h>
31 #include <linux/delay.h>
32 #include <linux/reboot.h>
33 #include <linux/interrupt.h>
34 #include <linux/kallsyms.h>
35 #include <linux/init.h>
36 #include <linux/cpu.h>
37 #include <linux/elfcore.h>
39 #include <linux/tick.h>
40 #include <linux/utsname.h>
41 #include <linux/uaccess.h>
42 #include <linux/random.h>
43 #include <linux/hw_breakpoint.h>
44 #include <linux/cpuidle.h>
45 #include <linux/leds.h>
46 #include <linux/personality.h>
47 #include <linux/notifier.h>
48 #include <linux/mtk_ram_console.h>
50 #include <asm/compat.h>
51 #include <asm/cacheflush.h>
52 #include <asm/fpsimd.h>
53 #include <asm/mmu_context.h>
54 #include <asm/processor.h>
55 #include <asm/stacktrace.h>
57 extern void arch_reset(char mode
, const char *cmd
);
59 static void setup_restart(void)
62 * Tell the mm system that we are going to reboot -
63 * we may need it to insert some 1:1 mappings so that
66 setup_mm_for_reboot();
68 /* Clean and invalidate caches */
71 /* Turn D-cache off */
74 /* Push out any further dirty data, and ensure cache is empty */
78 void soft_restart(unsigned long addr
)
85 * Function pointers to optional machine specific functions
87 void (*pm_power_off
)(void);
88 EXPORT_SYMBOL_GPL(pm_power_off
);
90 void (*arm_pm_restart
)(char str
, const char *cmd
);
91 EXPORT_SYMBOL_GPL(arm_pm_restart
);
94 * This is our default idle handler.
97 void (*arm_pm_idle
)(void);
99 static void default_idle(void)
108 void arch_cpu_idle_prepare(void)
113 void arch_cpu_idle_enter(void)
115 idle_notifier_call_chain(IDLE_START
);
116 ledtrig_cpu(CPU_LED_IDLE_START
);
117 #ifdef CONFIG_PL310_ERRATA_769419
122 void arch_cpu_idle_exit(void)
124 ledtrig_cpu(CPU_LED_IDLE_END
);
125 idle_notifier_call_chain(IDLE_END
);
128 #ifdef CONFIG_HOTPLUG_CPU
129 void arch_cpu_idle_dead(void)
136 * Called from the core idle loop.
138 void arch_cpu_idle(void)
140 if (cpuidle_idle_call())
144 void machine_shutdown(void)
151 void machine_halt(void)
157 extern int reboot_pid
;
158 //static int reboot_pid = 0;
160 void machine_power_off(void)
162 struct task_struct
*tsk
;
163 /* Disable interrupts first */
170 tsk
= find_task_by_vpid(reboot_pid
);
182 if(tsk
->real_parent
->real_parent
)
184 printk("machine_shutdown: start, Proess(%s:%d). father %s:%d. grandfather %s:%d.\n",
185 tsk
->comm
, tsk
->pid
,tsk
->real_parent
->comm
,tsk
->real_parent
->pid
,
186 tsk
->real_parent
->real_parent
->comm
,tsk
->real_parent
->real_parent
->pid
);
190 printk("machine_shutdown: start, Proess(%s:%d). father %s:%d.\n",
191 tsk
->comm
, tsk
->pid
,tsk
->real_parent
->comm
,tsk
->real_parent
->pid
);
196 printk("machine_shutdown: start, Proess(%s:%d)\n", tsk
->comm
, tsk
->pid
);
199 #ifdef CONFIG_MTK_EMMC_SUPPORT
200 last_kmsg_store_to_emmc();
206 void machine_restart(char *cmd
)
208 struct task_struct
*tsk
;
210 /* Disable interrupts first */
218 tsk
= find_task_by_vpid(reboot_pid
);
230 if(tsk
->real_parent
->real_parent
)
232 printk("machine_shutdown: start, Proess(%s:%d). father %s:%d. grandfather %s:%d.\n",
233 tsk
->comm
, tsk
->pid
,tsk
->real_parent
->comm
,tsk
->real_parent
->pid
,
234 tsk
->real_parent
->real_parent
->comm
,tsk
->real_parent
->real_parent
->pid
);
238 printk("machine_shutdown: start, Proess(%s:%d). father %s:%d.\n",
239 tsk
->comm
, tsk
->pid
,tsk
->real_parent
->comm
,tsk
->real_parent
->pid
);
244 printk("machine_shutdown: start, Proess(%s:%d)\n", tsk
->comm
, tsk
->pid
);
247 /* Now call the architecture specific reboot code. */
249 arm_pm_restart('h', cmd
);
250 #ifndef CONFIG_MTK_FPGA
252 arch_reset('h', cmd
);
255 * Whoops - the architecture was unable to reboot.
257 printk("Reboot failed -- System halted\n");
262 * dump a block of kernel memory from around the given address
264 static void show_data(unsigned long addr
, int nbytes
, const char *name
)
271 * don't attempt to dump non-kernel addresses or
272 * values that are probably just small negative numbers
274 if (addr
< PAGE_OFFSET
|| addr
> -256UL)
277 printk("\n%s: %#lx:\n", name
, addr
);
280 * round address down to a 32 bit boundary
281 * and always dump a multiple of 32 bytes
283 p
= (u32
*)(addr
& ~(sizeof(u32
) - 1));
284 nbytes
+= (addr
& (sizeof(u32
) - 1));
285 nlines
= (nbytes
+ 31) / 32;
288 for (i
= 0; i
< nlines
; i
++) {
290 * just display low 16 bits of address to keep
291 * each line of the dump < 80 characters
293 printk("%04lx ", (unsigned long)p
& 0xffff);
294 for (j
= 0; j
< 8; j
++) {
296 if (probe_kernel_address(p
, data
)) {
299 printk(" %08x", data
);
307 static void show_extra_register_data(struct pt_regs
*regs
, int nbytes
)
314 show_data(regs
->pc
- nbytes
, nbytes
* 2, "PC");
315 show_data(regs
->regs
[30] - nbytes
, nbytes
* 2, "LR");
316 show_data(regs
->sp
- nbytes
, nbytes
* 2, "SP");
317 for (i
= 0; i
< 30; i
++) {
319 snprintf(name
, sizeof(name
), "X%u", i
);
320 show_data(regs
->regs
[i
] - nbytes
, nbytes
* 2, name
);
325 void __show_regs(struct pt_regs
*regs
)
329 show_regs_print_info(KERN_DEFAULT
);
330 print_symbol("PC is at %s\n", instruction_pointer(regs
));
331 print_symbol("LR is at %s\n", regs
->regs
[30]);
332 printk("pc : [<%016llx>] lr : [<%016llx>] pstate: %08llx\n",
333 regs
->pc
, regs
->regs
[30], regs
->pstate
);
334 printk("sp : %016llx\n", regs
->sp
);
335 for (i
= 29; i
>= 0; i
--) {
336 printk("x%-2d: %016llx ", i
, regs
->regs
[i
]);
340 if (!user_mode(regs
))
341 show_extra_register_data(regs
, 128);
345 void show_regs(struct pt_regs
* regs
)
352 * Free current thread data structures etc..
354 void exit_thread(void)
358 static void tls_thread_flush(void)
360 asm ("msr tpidr_el0, xzr");
362 if (is_compat_task()) {
363 current
->thread
.tp_value
= 0;
366 * We need to ensure ordering between the shadow state and the
367 * hardware state, so that we don't corrupt the hardware state
368 * with a stale shadow state during context switch.
371 asm ("msr tpidrro_el0, xzr");
375 void flush_thread(void)
377 fpsimd_flush_thread();
379 flush_ptrace_hw_breakpoint(current
);
382 void release_thread(struct task_struct
*dead_task
)
386 int arch_dup_task_struct(struct task_struct
*dst
, struct task_struct
*src
)
388 fpsimd_preserve_current_state();
393 asmlinkage
void ret_from_fork(void) asm("ret_from_fork");
395 int copy_thread(unsigned long clone_flags
, unsigned long stack_start
,
396 unsigned long stk_sz
, struct task_struct
*p
)
398 struct pt_regs
*childregs
= task_pt_regs(p
);
399 unsigned long tls
= p
->thread
.tp_value
;
401 memset(&p
->thread
.cpu_context
, 0, sizeof(struct cpu_context
));
403 if (likely(!(p
->flags
& PF_KTHREAD
))) {
404 *childregs
= *current_pt_regs();
405 childregs
->regs
[0] = 0;
406 if (is_compat_thread(task_thread_info(p
))) {
408 childregs
->compat_sp
= stack_start
;
411 * Read the current TLS pointer from tpidr_el0 as it may be
412 * out-of-sync with the saved value.
414 asm("mrs %0, tpidr_el0" : "=r" (tls
));
416 /* 16-byte aligned stack mandatory on AArch64 */
417 if (stack_start
& 15)
419 childregs
->sp
= stack_start
;
423 * If a TLS pointer was passed to clone (4th argument), use it
424 * for the new thread.
426 if (clone_flags
& CLONE_SETTLS
)
427 tls
= childregs
->regs
[3];
429 memset(childregs
, 0, sizeof(struct pt_regs
));
430 childregs
->pstate
= PSR_MODE_EL1h
;
431 p
->thread
.cpu_context
.x19
= stack_start
;
432 p
->thread
.cpu_context
.x20
= stk_sz
;
434 p
->thread
.cpu_context
.pc
= (unsigned long)ret_from_fork
;
435 p
->thread
.cpu_context
.sp
= (unsigned long)childregs
;
436 p
->thread
.tp_value
= tls
;
438 ptrace_hw_copy_thread(p
);
443 static void tls_thread_switch(struct task_struct
*next
)
445 unsigned long tpidr
, tpidrro
;
447 if (!is_compat_task()) {
448 asm("mrs %0, tpidr_el0" : "=r" (tpidr
));
449 current
->thread
.tp_value
= tpidr
;
452 if (is_compat_thread(task_thread_info(next
))) {
454 tpidrro
= next
->thread
.tp_value
;
456 tpidr
= next
->thread
.tp_value
;
461 " msr tpidr_el0, %0\n"
462 " msr tpidrro_el0, %1"
463 : : "r" (tpidr
), "r" (tpidrro
));
469 struct task_struct
*__switch_to(struct task_struct
*prev
,
470 struct task_struct
*next
)
472 struct task_struct
*last
;
474 fpsimd_thread_switch(next
);
475 tls_thread_switch(next
);
476 hw_breakpoint_thread_switch(next
);
477 contextidr_thread_switch(next
);
480 * Complete any pending TLB or cache maintenance on this CPU in case
481 * the thread migrates to a different CPU.
485 /* the actual thread switch */
486 last
= cpu_switch_to(prev
, next
);
491 unsigned long get_wchan(struct task_struct
*p
)
493 struct stackframe frame
;
495 if (!p
|| p
== current
|| p
->state
== TASK_RUNNING
)
498 frame
.fp
= thread_saved_fp(p
);
499 frame
.sp
= thread_saved_sp(p
);
500 frame
.pc
= thread_saved_pc(p
);
502 int ret
= unwind_frame(&frame
);
505 if (!in_sched_functions(frame
.pc
))
507 } while (count
++ < 16);
511 unsigned long arch_align_stack(unsigned long sp
)
513 if (!(current
->personality
& ADDR_NO_RANDOMIZE
) && randomize_va_space
)
514 sp
-= get_random_int() & ~PAGE_MASK
;
518 static unsigned long randomize_base(unsigned long base
)
520 unsigned long range_end
= base
+ (STACK_RND_MASK
<< PAGE_SHIFT
) + 1;
521 return randomize_range(base
, range_end
, 0) ? : base
;
524 unsigned long arch_randomize_brk(struct mm_struct
*mm
)
526 return randomize_base(mm
->brk
);
529 unsigned long randomize_et_dyn(unsigned long base
)
531 return randomize_base(base
);