2 * linux/arch/arm/kernel/process.c
4 * Copyright (C) 1996-2000 Russell King - Converted to ARM.
5 * Original Copyright (C) 1995 Linus Torvalds
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
13 #include <linux/export.h>
14 #include <linux/sched.h>
15 #include <linux/kernel.h>
17 #include <linux/stddef.h>
18 #include <linux/unistd.h>
19 #include <linux/user.h>
20 #include <linux/delay.h>
21 #include <linux/reboot.h>
22 #include <linux/interrupt.h>
23 #include <linux/kallsyms.h>
24 #include <linux/init.h>
25 #include <linux/cpu.h>
26 #include <linux/elfcore.h>
28 #include <linux/tick.h>
29 #include <linux/utsname.h>
30 #include <linux/uaccess.h>
31 #include <linux/random.h>
32 #include <linux/hw_breakpoint.h>
33 #include <linux/cpuidle.h>
34 #include <linux/leds.h>
35 #include <linux/console.h>
36 #include <linux/mtk_ram_console.h>
38 #include <asm/cacheflush.h>
39 #include <asm/idmap.h>
40 #include <asm/processor.h>
41 #include <asm/thread_notify.h>
42 #include <asm/stacktrace.h>
43 #include <asm/mach/time.h>
44 #include <mach/system.h>
46 #ifdef CONFIG_CC_STACKPROTECTOR
47 #include <linux/stackprotector.h>
48 unsigned long __stack_chk_guard __read_mostly
;
49 EXPORT_SYMBOL(__stack_chk_guard
);
52 static const char *processor_modes
[] = {
53 "USER_26", "FIQ_26" , "IRQ_26" , "SVC_26" , "UK4_26" , "UK5_26" , "UK6_26" , "UK7_26" ,
54 "UK8_26" , "UK9_26" , "UK10_26", "UK11_26", "UK12_26", "UK13_26", "UK14_26", "UK15_26",
55 "USER_32", "FIQ_32" , "IRQ_32" , "SVC_32" , "UK4_32" , "UK5_32" , "UK6_32" , "ABT_32" ,
56 "UK8_32" , "UK9_32" , "UK10_32", "UND_32" , "UK12_32", "UK13_32", "UK14_32", "SYS_32"
59 static const char *isa_modes
[] = {
60 "ARM" , "Thumb" , "Jazelle", "ThumbEE"
64 void arch_trigger_all_cpu_backtrace(void)
66 smp_send_all_cpu_backtrace();
69 void arch_trigger_all_cpu_backtrace(void)
75 extern void call_with_stack(void (*fn
)(void *), void *arg
, void *sp
);
76 typedef void (*phys_reset_t
)(unsigned long);
78 #ifdef CONFIG_ARM_FLUSH_CONSOLE_ON_RESTART
79 void arm_machine_flush_console(void)
82 pr_emerg("Restarting %s\n", linux_banner
);
83 if (console_trylock()) {
91 if (!console_trylock())
92 pr_emerg("arm_restart: Console was locked! Busting\n");
94 pr_emerg("arm_restart: Console was locked!\n");
98 void arm_machine_flush_console(void)
104 * A temporary stack to use for CPU reset. This is static so that we
105 * don't clobber it with the identity mapping. When running with this
106 * stack, any references to the current task *will not work* so you
107 * should really do as little as possible before jumping to your reset
110 static u64 soft_restart_stack
[16];
112 void arm_machine_restart(char mode
, const char *cmd
)
114 /* Flush the console to make sure all the relevant messages make it
115 * out to the console drivers */
116 arm_machine_flush_console();
118 /* Disable interrupts first */
123 * Tell the mm system that we are going to reboot -
124 * we may need it to insert some 1:1 mappings so that
127 setup_mm_for_reboot();
129 /* When l1 is disabled and l2 is enabled, the spinlock cannot get the lock,
130 * so we need to disable the l2 as well. by Chia-Hao Hsu
136 /* Clean and invalidate caches */
138 #ifdef CONFIG_RESTART_DISABLE_CACHE
139 /* Turn off caching */
140 // cpu_proc_fin(); // Don't turn off cach during reboot phase. CA15 have risk if turn off cach.
142 /* Push out any further dirty data, and ensure cache is empty */
146 * Now call the architecture specific reboot code.
148 arch_reset(mode
, cmd
);
151 * Whoops - the architecture was unable to reboot.
155 printk("Reboot failed -- System halted\n");
159 static void __soft_restart(void *addr
)
161 phys_reset_t phys_reset
;
163 /* Take out a flat memory mapping. */
164 setup_mm_for_reboot();
166 /* Clean and invalidate caches */
169 /* Turn off caching */
172 /* Push out any further dirty data, and ensure cache is empty */
175 /* Switch to the identity mapping. */
176 phys_reset
= (phys_reset_t
)(unsigned long)virt_to_phys(cpu_reset
);
177 phys_reset((unsigned long)addr
);
179 /* Should never get here. */
183 void soft_restart(unsigned long addr
)
185 u64
*stack
= soft_restart_stack
+ ARRAY_SIZE(soft_restart_stack
);
187 /* Disable interrupts first */
191 /* Disable the L2 if we're the last man standing. */
192 if (num_online_cpus() == 1) {
197 /* Change to the new stack and continue with the reset. */
198 call_with_stack(__soft_restart
, (void *)addr
, (void *)stack
);
200 /* Should never get here. */
204 static void null_restart(char mode
, const char *cmd
)
209 * Function pointers to optional machine specific functions
211 void (*pm_power_off
)(void);
212 EXPORT_SYMBOL(pm_power_off
);
214 void (*arm_pm_restart
)(char str
, const char *cmd
) = null_restart
;
215 EXPORT_SYMBOL_GPL(arm_pm_restart
);
218 * This is our default idle handler.
221 void (*arm_pm_idle
)(void);
223 static void default_idle(void)
232 void arch_cpu_idle_prepare(void)
237 void arch_cpu_idle_enter(void)
239 idle_notifier_call_chain(IDLE_START
);
240 ledtrig_cpu(CPU_LED_IDLE_START
);
241 #ifdef CONFIG_PL310_ERRATA_769419
246 void arch_cpu_idle_exit(void)
248 ledtrig_cpu(CPU_LED_IDLE_END
);
249 idle_notifier_call_chain(IDLE_END
);
252 #ifdef CONFIG_HOTPLUG_CPU
253 void arch_cpu_idle_dead(void)
260 * Called from the core idle loop.
262 void arch_cpu_idle(void)
264 if (cpuidle_idle_call())
268 static char reboot_mode
= 'h';
270 int __init
reboot_setup(char *str
)
272 reboot_mode
= str
[0];
276 __setup("reboot=", reboot_setup
);
279 * Called by kexec, immediately prior to machine_kexec().
281 * This must completely disable all secondary CPUs; simply causing those CPUs
282 * to execute e.g. a RAM-based pin loop is not sufficient. This allows the
283 * kexec'd kernel to use any and all RAM as it sees fit, without having to
284 * avoid any code or data used by any SW CPU pin loop. The CPU hotplug
285 * functionality embodied in disable_nonboot_cpus() to achieve this.
287 void machine_shutdown(void)
291 * Disable preemption so we're guaranteed to
292 * run to power off or reboot and prevent
293 * the possibility of switching to another
294 * thread that might wind up blocking on
295 * one of the stopped CPUs.
297 printk("machine_shutdown: start, Proess(%s:%d)\n", current
->comm
, current
->pid
);
301 disable_nonboot_cpus();
302 printk("machine_shutdown: done\n");
306 * Halting simply requires that the secondary CPUs stop performing any
307 * activity (executing tasks, handling interrupts). smp_send_stop()
310 void machine_halt(void)
318 extern int reboot_pid
;
320 * Power-off simply requires that the secondary CPUs stop performing any
321 * activity (executing tasks, handling interrupts). smp_send_stop()
322 * achieves this. When the system power is turned off, it will take all CPUs
325 void machine_power_off(void)
327 struct task_struct
*tsk
;
329 /* Disable interrupts first */
336 tsk
= find_task_by_vpid(reboot_pid
);
348 if(tsk
->real_parent
->real_parent
)
350 printk("machine_shutdown: start, Proess(%s:%d). father %s:%d. grandfather %s:%d.\n",
351 tsk
->comm
, tsk
->pid
,tsk
->real_parent
->comm
,tsk
->real_parent
->pid
,
352 tsk
->real_parent
->real_parent
->comm
,tsk
->real_parent
->real_parent
->pid
);
356 printk("machine_shutdown: start, Proess(%s:%d). father %s:%d.\n",
357 tsk
->comm
, tsk
->pid
,tsk
->real_parent
->comm
,tsk
->real_parent
->pid
);
362 printk("machine_shutdown: start, Proess(%s:%d)\n", tsk
->comm
, tsk
->pid
);
365 #ifdef CONFIG_MTK_EMMC_SUPPORT
366 last_kmsg_store_to_emmc();
374 * Restart requires that the secondary CPUs stop performing any activity
375 * while the primary CPU resets the system. Systems with a single CPU can
376 * use soft_restart() as their machine descriptor's .restart hook, since that
377 * will cause the only available CPU to reset. Systems with multiple CPUs must
378 * provide a HW restart implementation, to ensure that all CPUs reset at once.
379 * This is required so that any code running after reset on the primary CPU
380 * doesn't have to co-ordinate with other CPUs to ensure they aren't still
381 * executing pre-reset code, and using RAM that the primary CPU's code wishes
382 * to use. Implementing such co-ordination would be essentially impossible.
384 void machine_restart(char *cmd
)
386 struct task_struct
*tsk
;
387 /* Disable interrupts first */
395 tsk
= find_task_by_vpid(reboot_pid
);
407 if(tsk
->real_parent
->real_parent
)
409 printk("machine_shutdown: start, Proess(%s:%d). father %s:%d. grandfather %s:%d.\n",
410 tsk
->comm
, tsk
->pid
,tsk
->real_parent
->comm
,tsk
->real_parent
->pid
,
411 tsk
->real_parent
->real_parent
->comm
,tsk
->real_parent
->real_parent
->pid
);
415 printk("machine_shutdown: start, Proess(%s:%d). father %s:%d.\n",
416 tsk
->comm
, tsk
->pid
,tsk
->real_parent
->comm
,tsk
->real_parent
->pid
);
421 printk("machine_shutdown: start, Proess(%s:%d)\n", tsk
->comm
, tsk
->pid
);
424 /* Flush the console to make sure all the relevant messages make it
425 * out to the console drivers */
426 arm_machine_flush_console();
428 arm_pm_restart(reboot_mode
, cmd
);
430 /* Give a grace period for failure to restart of 1s */
433 /* Whoops - the platform was unable to reboot. Tell the user! */
434 printk("Reboot failed -- System halted\n");
440 * dump a block of kernel memory from around the given address
442 static void show_data(unsigned long addr
, int nbytes
, const char *name
)
449 * don't attempt to dump non-kernel addresses or
450 * values that are probably just small negative numbers
452 if (addr
< PAGE_OFFSET
|| addr
> -256UL)
455 printk("\n%s: %#lx:\n", name
, addr
);
458 * round address down to a 32 bit boundary
459 * and always dump a multiple of 32 bytes
461 p
= (u32
*)(addr
& ~(sizeof(u32
) - 1));
462 nbytes
+= (addr
& (sizeof(u32
) - 1));
463 nlines
= (nbytes
+ 31) / 32;
466 for (i
= 0; i
< nlines
; i
++) {
468 * just display low 16 bits of address to keep
469 * each line of the dump < 80 characters
471 printk("%04lx ", (unsigned long)p
& 0xffff);
472 for (j
= 0; j
< 8; j
++) {
474 if (probe_kernel_address(p
, data
)) {
477 printk(" %08x", data
);
485 static void show_extra_register_data(struct pt_regs
*regs
, int nbytes
)
491 show_data(regs
->ARM_pc
- nbytes
, nbytes
* 2, "PC");
492 show_data(regs
->ARM_lr
- nbytes
, nbytes
* 2, "LR");
493 show_data(regs
->ARM_sp
- nbytes
, nbytes
* 2, "SP");
494 show_data(regs
->ARM_ip
- nbytes
, nbytes
* 2, "IP");
495 show_data(regs
->ARM_fp
- nbytes
, nbytes
* 2, "FP");
496 show_data(regs
->ARM_r0
- nbytes
, nbytes
* 2, "R0");
497 show_data(regs
->ARM_r1
- nbytes
, nbytes
* 2, "R1");
498 show_data(regs
->ARM_r2
- nbytes
, nbytes
* 2, "R2");
499 show_data(regs
->ARM_r3
- nbytes
, nbytes
* 2, "R3");
500 show_data(regs
->ARM_r4
- nbytes
, nbytes
* 2, "R4");
501 show_data(regs
->ARM_r5
- nbytes
, nbytes
* 2, "R5");
502 show_data(regs
->ARM_r6
- nbytes
, nbytes
* 2, "R6");
503 show_data(regs
->ARM_r7
- nbytes
, nbytes
* 2, "R7");
504 show_data(regs
->ARM_r8
- nbytes
, nbytes
* 2, "R8");
505 show_data(regs
->ARM_r9
- nbytes
, nbytes
* 2, "R9");
506 show_data(regs
->ARM_r10
- nbytes
, nbytes
* 2, "R10");
510 void __show_regs(struct pt_regs
*regs
)
515 show_regs_print_info(KERN_DEFAULT
);
517 print_symbol("PC is at %s\n", instruction_pointer(regs
));
518 print_symbol("LR is at %s\n", regs
->ARM_lr
);
519 printk("pc : [<%08lx>] lr : [<%08lx>] psr: %08lx\n"
520 "sp : %08lx ip : %08lx fp : %08lx\n",
521 regs
->ARM_pc
, regs
->ARM_lr
, regs
->ARM_cpsr
,
522 regs
->ARM_sp
, regs
->ARM_ip
, regs
->ARM_fp
);
523 printk("r10: %08lx r9 : %08lx r8 : %08lx\n",
524 regs
->ARM_r10
, regs
->ARM_r9
,
526 printk("r7 : %08lx r6 : %08lx r5 : %08lx r4 : %08lx\n",
527 regs
->ARM_r7
, regs
->ARM_r6
,
528 regs
->ARM_r5
, regs
->ARM_r4
);
529 printk("r3 : %08lx r2 : %08lx r1 : %08lx r0 : %08lx\n",
530 regs
->ARM_r3
, regs
->ARM_r2
,
531 regs
->ARM_r1
, regs
->ARM_r0
);
533 flags
= regs
->ARM_cpsr
;
534 buf
[0] = flags
& PSR_N_BIT
? 'N' : 'n';
535 buf
[1] = flags
& PSR_Z_BIT
? 'Z' : 'z';
536 buf
[2] = flags
& PSR_C_BIT
? 'C' : 'c';
537 buf
[3] = flags
& PSR_V_BIT
? 'V' : 'v';
540 printk("Flags: %s IRQs o%s FIQs o%s Mode %s ISA %s Segment %s\n",
541 buf
, interrupts_enabled(regs
) ? "n" : "ff",
542 fast_interrupts_enabled(regs
) ? "n" : "ff",
543 processor_modes
[processor_mode(regs
)],
544 isa_modes
[isa_mode(regs
)],
545 get_fs() == get_ds() ? "kernel" : "user");
546 #ifdef CONFIG_CPU_CP15
551 #ifdef CONFIG_CPU_CP15_MMU
553 unsigned int transbase
, dac
;
554 asm("mrc p15, 0, %0, c2, c0\n\t"
555 "mrc p15, 0, %1, c3, c0\n"
556 : "=r" (transbase
), "=r" (dac
));
557 snprintf(buf
, sizeof(buf
), " Table: %08x DAC: %08x",
561 asm("mrc p15, 0, %0, c1, c0\n" : "=r" (ctrl
));
563 printk("Control: %08x%s\n", ctrl
, buf
);
567 show_extra_register_data(regs
, 128);
570 void show_regs(struct pt_regs
* regs
)
577 ATOMIC_NOTIFIER_HEAD(thread_notify_head
);
579 EXPORT_SYMBOL_GPL(thread_notify_head
);
582 * Free current thread data structures etc..
584 void exit_thread(void)
586 thread_notify(THREAD_NOTIFY_EXIT
, current_thread_info());
589 void flush_thread(void)
591 struct thread_info
*thread
= current_thread_info();
592 struct task_struct
*tsk
= current
;
594 flush_ptrace_hw_breakpoint(tsk
);
596 memset(thread
->used_cp
, 0, sizeof(thread
->used_cp
));
597 memset(&tsk
->thread
.debug
, 0, sizeof(struct debug_info
));
598 memset(&thread
->fpstate
, 0, sizeof(union fp_state
));
600 thread_notify(THREAD_NOTIFY_FLUSH
, thread
);
603 void release_thread(struct task_struct
*dead_task
)
607 asmlinkage
void ret_from_fork(void) __asm__("ret_from_fork");
610 copy_thread(unsigned long clone_flags
, unsigned long stack_start
,
611 unsigned long stk_sz
, struct task_struct
*p
)
613 struct thread_info
*thread
= task_thread_info(p
);
614 struct pt_regs
*childregs
= task_pt_regs(p
);
616 memset(&thread
->cpu_context
, 0, sizeof(struct cpu_context_save
));
618 if (likely(!(p
->flags
& PF_KTHREAD
))) {
619 *childregs
= *current_pt_regs();
620 childregs
->ARM_r0
= 0;
622 childregs
->ARM_sp
= stack_start
;
624 memset(childregs
, 0, sizeof(struct pt_regs
));
625 thread
->cpu_context
.r4
= stk_sz
;
626 thread
->cpu_context
.r5
= stack_start
;
627 childregs
->ARM_cpsr
= SVC_MODE
;
629 thread
->cpu_context
.pc
= (unsigned long)ret_from_fork
;
630 thread
->cpu_context
.sp
= (unsigned long)childregs
;
632 clear_ptrace_hw_breakpoint(p
);
634 if (clone_flags
& CLONE_SETTLS
)
635 thread
->tp_value
= childregs
->ARM_r3
;
637 thread_notify(THREAD_NOTIFY_COPY
, thread
);
643 * Fill in the task's elfregs structure for a core dump.
645 int dump_task_regs(struct task_struct
*t
, elf_gregset_t
*elfregs
)
647 elf_core_copy_regs(elfregs
, task_pt_regs(t
));
652 * fill in the fpe structure for a core dump...
654 int dump_fpu (struct pt_regs
*regs
, struct user_fp
*fp
)
656 struct thread_info
*thread
= current_thread_info();
657 int used_math
= thread
->used_cp
[1] | thread
->used_cp
[2];
660 memcpy(fp
, &thread
->fpstate
.soft
, sizeof (*fp
));
662 return used_math
!= 0;
664 EXPORT_SYMBOL(dump_fpu
);
666 unsigned long get_wchan(struct task_struct
*p
)
668 struct stackframe frame
;
669 unsigned long stack_page
;
671 if (!p
|| p
== current
|| p
->state
== TASK_RUNNING
)
674 frame
.fp
= thread_saved_fp(p
);
675 frame
.sp
= thread_saved_sp(p
);
676 frame
.lr
= 0; /* recovered from the stack */
677 frame
.pc
= thread_saved_pc(p
);
678 stack_page
= (unsigned long)task_stack_page(p
);
680 if (frame
.sp
< stack_page
||
681 frame
.sp
>= stack_page
+ THREAD_SIZE
||
682 unwind_frame(&frame
) < 0)
684 if (!in_sched_functions(frame
.pc
))
686 } while (count
++ < 16);
690 unsigned long arch_randomize_brk(struct mm_struct
*mm
)
692 unsigned long range_end
= mm
->brk
+ 0x02000000;
693 return randomize_range(mm
->brk
, range_end
, 0) ? : mm
->brk
;
697 #ifdef CONFIG_KUSER_HELPERS
699 * The vectors page is always readable from user space for the
700 * atomic helpers. Insert it into the gate_vma so that it is visible
701 * through ptrace and /proc/<pid>/mem.
703 static struct vm_area_struct gate_vma
= {
704 .vm_start
= 0xffff0000,
705 .vm_end
= 0xffff0000 + PAGE_SIZE
,
706 .vm_flags
= VM_READ
| VM_EXEC
| VM_MAYREAD
| VM_MAYEXEC
,
709 static int __init
gate_vma_init(void)
711 gate_vma
.vm_page_prot
= PAGE_READONLY_EXEC
;
714 arch_initcall(gate_vma_init
);
716 struct vm_area_struct
*get_gate_vma(struct mm_struct
*mm
)
721 int in_gate_area(struct mm_struct
*mm
, unsigned long addr
)
723 return (addr
>= gate_vma
.vm_start
) && (addr
< gate_vma
.vm_end
);
726 int in_gate_area_no_mm(unsigned long addr
)
728 return in_gate_area(NULL
, addr
);
730 #define is_gate_vma(vma) ((vma) == &gate_vma)
732 #define is_gate_vma(vma) 0
735 const char *arch_vma_name(struct vm_area_struct
*vma
)
737 return is_gate_vma(vma
) ? "[vectors]" :
738 (vma
->vm_mm
&& vma
->vm_start
== vma
->vm_mm
->context
.sigpage
) ?
742 static struct page
*signal_page
;
743 extern struct page
*get_signal_page(void);
745 int arch_setup_additional_pages(struct linux_binprm
*bprm
, int uses_interp
)
747 struct mm_struct
*mm
= current
->mm
;
752 signal_page
= get_signal_page();
756 down_write(&mm
->mmap_sem
);
757 addr
= get_unmapped_area(NULL
, 0, PAGE_SIZE
, 0, 0);
758 if (IS_ERR_VALUE(addr
)) {
763 ret
= install_special_mapping(mm
, addr
, PAGE_SIZE
,
764 VM_READ
| VM_EXEC
| VM_MAYREAD
| VM_MAYWRITE
| VM_MAYEXEC
,
768 mm
->context
.sigpage
= addr
;
771 up_write(&mm
->mmap_sem
);