Loading...
1/*
2 * linux/arch/arm/kernel/process.c
3 *
4 * Copyright (C) 1996-2000 Russell King - Converted to ARM.
5 * Original Copyright (C) 1995 Linus Torvalds
6 *
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.
10 */
11#include <stdarg.h>
12
13#include <linux/export.h>
14#include <linux/sched.h>
15#include <linux/kernel.h>
16#include <linux/mm.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>
27#include <linux/pm.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/leds.h>
34#include <linux/reboot.h>
35
36#include <asm/cacheflush.h>
37#include <asm/idmap.h>
38#include <asm/processor.h>
39#include <asm/thread_notify.h>
40#include <asm/stacktrace.h>
41#include <asm/system_misc.h>
42#include <asm/mach/time.h>
43#include <asm/tls.h>
44
45#ifdef CONFIG_CC_STACKPROTECTOR
46#include <linux/stackprotector.h>
47unsigned long __stack_chk_guard __read_mostly;
48EXPORT_SYMBOL(__stack_chk_guard);
49#endif
50
51static const char *processor_modes[] __maybe_unused = {
52 "USER_26", "FIQ_26" , "IRQ_26" , "SVC_26" , "UK4_26" , "UK5_26" , "UK6_26" , "UK7_26" ,
53 "UK8_26" , "UK9_26" , "UK10_26", "UK11_26", "UK12_26", "UK13_26", "UK14_26", "UK15_26",
54 "USER_32", "FIQ_32" , "IRQ_32" , "SVC_32" , "UK4_32" , "UK5_32" , "UK6_32" , "ABT_32" ,
55 "UK8_32" , "UK9_32" , "UK10_32", "UND_32" , "UK12_32", "UK13_32", "UK14_32", "SYS_32"
56};
57
58static const char *isa_modes[] __maybe_unused = {
59 "ARM" , "Thumb" , "Jazelle", "ThumbEE"
60};
61
62extern void call_with_stack(void (*fn)(void *), void *arg, void *sp);
63typedef void (*phys_reset_t)(unsigned long);
64
65/*
66 * A temporary stack to use for CPU reset. This is static so that we
67 * don't clobber it with the identity mapping. When running with this
68 * stack, any references to the current task *will not work* so you
69 * should really do as little as possible before jumping to your reset
70 * code.
71 */
72static u64 soft_restart_stack[16];
73
74static void __soft_restart(void *addr)
75{
76 phys_reset_t phys_reset;
77
78 /* Take out a flat memory mapping. */
79 setup_mm_for_reboot();
80
81 /* Clean and invalidate caches */
82 flush_cache_all();
83
84 /* Turn off caching */
85 cpu_proc_fin();
86
87 /* Push out any further dirty data, and ensure cache is empty */
88 flush_cache_all();
89
90 /* Switch to the identity mapping. */
91 phys_reset = (phys_reset_t)(unsigned long)virt_to_phys(cpu_reset);
92 phys_reset((unsigned long)addr);
93
94 /* Should never get here. */
95 BUG();
96}
97
98void soft_restart(unsigned long addr)
99{
100 u64 *stack = soft_restart_stack + ARRAY_SIZE(soft_restart_stack);
101
102 /* Disable interrupts first */
103 raw_local_irq_disable();
104 local_fiq_disable();
105
106 /* Disable the L2 if we're the last man standing. */
107 if (num_online_cpus() == 1)
108 outer_disable();
109
110 /* Change to the new stack and continue with the reset. */
111 call_with_stack(__soft_restart, (void *)addr, (void *)stack);
112
113 /* Should never get here. */
114 BUG();
115}
116
117static void null_restart(enum reboot_mode reboot_mode, const char *cmd)
118{
119}
120
121/*
122 * Function pointers to optional machine specific functions
123 */
124void (*pm_power_off)(void);
125EXPORT_SYMBOL(pm_power_off);
126
127void (*arm_pm_restart)(enum reboot_mode reboot_mode, const char *cmd) = null_restart;
128EXPORT_SYMBOL_GPL(arm_pm_restart);
129
130/*
131 * This is our default idle handler.
132 */
133
134void (*arm_pm_idle)(void);
135
136/*
137 * Called from the core idle loop.
138 */
139
140void arch_cpu_idle(void)
141{
142 if (arm_pm_idle)
143 arm_pm_idle();
144 else
145 cpu_do_idle();
146 local_irq_enable();
147}
148
149void arch_cpu_idle_prepare(void)
150{
151 local_fiq_enable();
152}
153
154void arch_cpu_idle_enter(void)
155{
156 ledtrig_cpu(CPU_LED_IDLE_START);
157#ifdef CONFIG_PL310_ERRATA_769419
158 wmb();
159#endif
160}
161
162void arch_cpu_idle_exit(void)
163{
164 ledtrig_cpu(CPU_LED_IDLE_END);
165}
166
167#ifdef CONFIG_HOTPLUG_CPU
168void arch_cpu_idle_dead(void)
169{
170 cpu_die();
171}
172#endif
173
174/*
175 * Called by kexec, immediately prior to machine_kexec().
176 *
177 * This must completely disable all secondary CPUs; simply causing those CPUs
178 * to execute e.g. a RAM-based pin loop is not sufficient. This allows the
179 * kexec'd kernel to use any and all RAM as it sees fit, without having to
180 * avoid any code or data used by any SW CPU pin loop. The CPU hotplug
181 * functionality embodied in disable_nonboot_cpus() to achieve this.
182 */
183void machine_shutdown(void)
184{
185 disable_nonboot_cpus();
186}
187
188/*
189 * Halting simply requires that the secondary CPUs stop performing any
190 * activity (executing tasks, handling interrupts). smp_send_stop()
191 * achieves this.
192 */
193void machine_halt(void)
194{
195 local_irq_disable();
196 smp_send_stop();
197
198 local_irq_disable();
199 while (1);
200}
201
202/*
203 * Power-off simply requires that the secondary CPUs stop performing any
204 * activity (executing tasks, handling interrupts). smp_send_stop()
205 * achieves this. When the system power is turned off, it will take all CPUs
206 * with it.
207 */
208void machine_power_off(void)
209{
210 local_irq_disable();
211 smp_send_stop();
212
213 if (pm_power_off)
214 pm_power_off();
215}
216
217/*
218 * Restart requires that the secondary CPUs stop performing any activity
219 * while the primary CPU resets the system. Systems with a single CPU can
220 * use soft_restart() as their machine descriptor's .restart hook, since that
221 * will cause the only available CPU to reset. Systems with multiple CPUs must
222 * provide a HW restart implementation, to ensure that all CPUs reset at once.
223 * This is required so that any code running after reset on the primary CPU
224 * doesn't have to co-ordinate with other CPUs to ensure they aren't still
225 * executing pre-reset code, and using RAM that the primary CPU's code wishes
226 * to use. Implementing such co-ordination would be essentially impossible.
227 */
228void machine_restart(char *cmd)
229{
230 local_irq_disable();
231 smp_send_stop();
232
233 arm_pm_restart(reboot_mode, cmd);
234
235 /* Give a grace period for failure to restart of 1s */
236 mdelay(1000);
237
238 /* Whoops - the platform was unable to reboot. Tell the user! */
239 printk("Reboot failed -- System halted\n");
240 local_irq_disable();
241 while (1);
242}
243
244void __show_regs(struct pt_regs *regs)
245{
246 unsigned long flags;
247 char buf[64];
248
249 show_regs_print_info(KERN_DEFAULT);
250
251 print_symbol("PC is at %s\n", instruction_pointer(regs));
252 print_symbol("LR is at %s\n", regs->ARM_lr);
253 printk("pc : [<%08lx>] lr : [<%08lx>] psr: %08lx\n"
254 "sp : %08lx ip : %08lx fp : %08lx\n",
255 regs->ARM_pc, regs->ARM_lr, regs->ARM_cpsr,
256 regs->ARM_sp, regs->ARM_ip, regs->ARM_fp);
257 printk("r10: %08lx r9 : %08lx r8 : %08lx\n",
258 regs->ARM_r10, regs->ARM_r9,
259 regs->ARM_r8);
260 printk("r7 : %08lx r6 : %08lx r5 : %08lx r4 : %08lx\n",
261 regs->ARM_r7, regs->ARM_r6,
262 regs->ARM_r5, regs->ARM_r4);
263 printk("r3 : %08lx r2 : %08lx r1 : %08lx r0 : %08lx\n",
264 regs->ARM_r3, regs->ARM_r2,
265 regs->ARM_r1, regs->ARM_r0);
266
267 flags = regs->ARM_cpsr;
268 buf[0] = flags & PSR_N_BIT ? 'N' : 'n';
269 buf[1] = flags & PSR_Z_BIT ? 'Z' : 'z';
270 buf[2] = flags & PSR_C_BIT ? 'C' : 'c';
271 buf[3] = flags & PSR_V_BIT ? 'V' : 'v';
272 buf[4] = '\0';
273
274#ifndef CONFIG_CPU_V7M
275 printk("Flags: %s IRQs o%s FIQs o%s Mode %s ISA %s Segment %s\n",
276 buf, interrupts_enabled(regs) ? "n" : "ff",
277 fast_interrupts_enabled(regs) ? "n" : "ff",
278 processor_modes[processor_mode(regs)],
279 isa_modes[isa_mode(regs)],
280 get_fs() == get_ds() ? "kernel" : "user");
281#else
282 printk("xPSR: %08lx\n", regs->ARM_cpsr);
283#endif
284
285#ifdef CONFIG_CPU_CP15
286 {
287 unsigned int ctrl;
288
289 buf[0] = '\0';
290#ifdef CONFIG_CPU_CP15_MMU
291 {
292 unsigned int transbase, dac;
293 asm("mrc p15, 0, %0, c2, c0\n\t"
294 "mrc p15, 0, %1, c3, c0\n"
295 : "=r" (transbase), "=r" (dac));
296 snprintf(buf, sizeof(buf), " Table: %08x DAC: %08x",
297 transbase, dac);
298 }
299#endif
300 asm("mrc p15, 0, %0, c1, c0\n" : "=r" (ctrl));
301
302 printk("Control: %08x%s\n", ctrl, buf);
303 }
304#endif
305}
306
307void show_regs(struct pt_regs * regs)
308{
309 printk("\n");
310 __show_regs(regs);
311 dump_stack();
312}
313
314ATOMIC_NOTIFIER_HEAD(thread_notify_head);
315
316EXPORT_SYMBOL_GPL(thread_notify_head);
317
318/*
319 * Free current thread data structures etc..
320 */
321void exit_thread(void)
322{
323 thread_notify(THREAD_NOTIFY_EXIT, current_thread_info());
324}
325
326void flush_thread(void)
327{
328 struct thread_info *thread = current_thread_info();
329 struct task_struct *tsk = current;
330
331 flush_ptrace_hw_breakpoint(tsk);
332
333 memset(thread->used_cp, 0, sizeof(thread->used_cp));
334 memset(&tsk->thread.debug, 0, sizeof(struct debug_info));
335 memset(&thread->fpstate, 0, sizeof(union fp_state));
336
337 thread_notify(THREAD_NOTIFY_FLUSH, thread);
338}
339
340void release_thread(struct task_struct *dead_task)
341{
342}
343
344asmlinkage void ret_from_fork(void) __asm__("ret_from_fork");
345
346int
347copy_thread(unsigned long clone_flags, unsigned long stack_start,
348 unsigned long stk_sz, struct task_struct *p)
349{
350 struct thread_info *thread = task_thread_info(p);
351 struct pt_regs *childregs = task_pt_regs(p);
352
353 memset(&thread->cpu_context, 0, sizeof(struct cpu_context_save));
354
355 if (likely(!(p->flags & PF_KTHREAD))) {
356 *childregs = *current_pt_regs();
357 childregs->ARM_r0 = 0;
358 if (stack_start)
359 childregs->ARM_sp = stack_start;
360 } else {
361 memset(childregs, 0, sizeof(struct pt_regs));
362 thread->cpu_context.r4 = stk_sz;
363 thread->cpu_context.r5 = stack_start;
364 childregs->ARM_cpsr = SVC_MODE;
365 }
366 thread->cpu_context.pc = (unsigned long)ret_from_fork;
367 thread->cpu_context.sp = (unsigned long)childregs;
368
369 clear_ptrace_hw_breakpoint(p);
370
371 if (clone_flags & CLONE_SETTLS)
372 thread->tp_value[0] = childregs->ARM_r3;
373 thread->tp_value[1] = get_tpuser();
374
375 thread_notify(THREAD_NOTIFY_COPY, thread);
376
377 return 0;
378}
379
380/*
381 * Fill in the task's elfregs structure for a core dump.
382 */
383int dump_task_regs(struct task_struct *t, elf_gregset_t *elfregs)
384{
385 elf_core_copy_regs(elfregs, task_pt_regs(t));
386 return 1;
387}
388
389/*
390 * fill in the fpe structure for a core dump...
391 */
392int dump_fpu (struct pt_regs *regs, struct user_fp *fp)
393{
394 struct thread_info *thread = current_thread_info();
395 int used_math = thread->used_cp[1] | thread->used_cp[2];
396
397 if (used_math)
398 memcpy(fp, &thread->fpstate.soft, sizeof (*fp));
399
400 return used_math != 0;
401}
402EXPORT_SYMBOL(dump_fpu);
403
404unsigned long get_wchan(struct task_struct *p)
405{
406 struct stackframe frame;
407 unsigned long stack_page;
408 int count = 0;
409 if (!p || p == current || p->state == TASK_RUNNING)
410 return 0;
411
412 frame.fp = thread_saved_fp(p);
413 frame.sp = thread_saved_sp(p);
414 frame.lr = 0; /* recovered from the stack */
415 frame.pc = thread_saved_pc(p);
416 stack_page = (unsigned long)task_stack_page(p);
417 do {
418 if (frame.sp < stack_page ||
419 frame.sp >= stack_page + THREAD_SIZE ||
420 unwind_frame(&frame) < 0)
421 return 0;
422 if (!in_sched_functions(frame.pc))
423 return frame.pc;
424 } while (count ++ < 16);
425 return 0;
426}
427
428unsigned long arch_randomize_brk(struct mm_struct *mm)
429{
430 unsigned long range_end = mm->brk + 0x02000000;
431 return randomize_range(mm->brk, range_end, 0) ? : mm->brk;
432}
433
434#ifdef CONFIG_MMU
435#ifdef CONFIG_KUSER_HELPERS
436/*
437 * The vectors page is always readable from user space for the
438 * atomic helpers. Insert it into the gate_vma so that it is visible
439 * through ptrace and /proc/<pid>/mem.
440 */
441static struct vm_area_struct gate_vma = {
442 .vm_start = 0xffff0000,
443 .vm_end = 0xffff0000 + PAGE_SIZE,
444 .vm_flags = VM_READ | VM_EXEC | VM_MAYREAD | VM_MAYEXEC,
445};
446
447static int __init gate_vma_init(void)
448{
449 gate_vma.vm_page_prot = PAGE_READONLY_EXEC;
450 return 0;
451}
452arch_initcall(gate_vma_init);
453
454struct vm_area_struct *get_gate_vma(struct mm_struct *mm)
455{
456 return &gate_vma;
457}
458
459int in_gate_area(struct mm_struct *mm, unsigned long addr)
460{
461 return (addr >= gate_vma.vm_start) && (addr < gate_vma.vm_end);
462}
463
464int in_gate_area_no_mm(unsigned long addr)
465{
466 return in_gate_area(NULL, addr);
467}
468#define is_gate_vma(vma) ((vma) == &gate_vma)
469#else
470#define is_gate_vma(vma) 0
471#endif
472
473const char *arch_vma_name(struct vm_area_struct *vma)
474{
475 return is_gate_vma(vma) ? "[vectors]" :
476 (vma->vm_mm && vma->vm_start == vma->vm_mm->context.sigpage) ?
477 "[sigpage]" : NULL;
478}
479
480static struct page *signal_page;
481extern struct page *get_signal_page(void);
482
483int arch_setup_additional_pages(struct linux_binprm *bprm, int uses_interp)
484{
485 struct mm_struct *mm = current->mm;
486 unsigned long addr;
487 int ret;
488
489 if (!signal_page)
490 signal_page = get_signal_page();
491 if (!signal_page)
492 return -ENOMEM;
493
494 down_write(&mm->mmap_sem);
495 addr = get_unmapped_area(NULL, 0, PAGE_SIZE, 0, 0);
496 if (IS_ERR_VALUE(addr)) {
497 ret = addr;
498 goto up_fail;
499 }
500
501 ret = install_special_mapping(mm, addr, PAGE_SIZE,
502 VM_READ | VM_EXEC | VM_MAYREAD | VM_MAYWRITE | VM_MAYEXEC,
503 &signal_page);
504
505 if (ret == 0)
506 mm->context.sigpage = addr;
507
508 up_fail:
509 up_write(&mm->mmap_sem);
510 return ret;
511}
512#endif
1/*
2 * linux/arch/arm/kernel/process.c
3 *
4 * Copyright (C) 1996-2000 Russell King - Converted to ARM.
5 * Original Copyright (C) 1995 Linus Torvalds
6 *
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.
10 */
11#include <stdarg.h>
12
13#include <linux/export.h>
14#include <linux/sched.h>
15#include <linux/kernel.h>
16#include <linux/mm.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>
27#include <linux/pm.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
35#include <asm/cacheflush.h>
36#include <asm/leds.h>
37#include <asm/processor.h>
38#include <asm/thread_notify.h>
39#include <asm/stacktrace.h>
40#include <asm/mach/time.h>
41
42#ifdef CONFIG_CC_STACKPROTECTOR
43#include <linux/stackprotector.h>
44unsigned long __stack_chk_guard __read_mostly;
45EXPORT_SYMBOL(__stack_chk_guard);
46#endif
47
48static const char *processor_modes[] = {
49 "USER_26", "FIQ_26" , "IRQ_26" , "SVC_26" , "UK4_26" , "UK5_26" , "UK6_26" , "UK7_26" ,
50 "UK8_26" , "UK9_26" , "UK10_26", "UK11_26", "UK12_26", "UK13_26", "UK14_26", "UK15_26",
51 "USER_32", "FIQ_32" , "IRQ_32" , "SVC_32" , "UK4_32" , "UK5_32" , "UK6_32" , "ABT_32" ,
52 "UK8_32" , "UK9_32" , "UK10_32", "UND_32" , "UK12_32", "UK13_32", "UK14_32", "SYS_32"
53};
54
55static const char *isa_modes[] = {
56 "ARM" , "Thumb" , "Jazelle", "ThumbEE"
57};
58
59extern void setup_mm_for_reboot(void);
60
61static volatile int hlt_counter;
62
63void disable_hlt(void)
64{
65 hlt_counter++;
66}
67
68EXPORT_SYMBOL(disable_hlt);
69
70void enable_hlt(void)
71{
72 hlt_counter--;
73}
74
75EXPORT_SYMBOL(enable_hlt);
76
77static int __init nohlt_setup(char *__unused)
78{
79 hlt_counter = 1;
80 return 1;
81}
82
83static int __init hlt_setup(char *__unused)
84{
85 hlt_counter = 0;
86 return 1;
87}
88
89__setup("nohlt", nohlt_setup);
90__setup("hlt", hlt_setup);
91
92extern void call_with_stack(void (*fn)(void *), void *arg, void *sp);
93typedef void (*phys_reset_t)(unsigned long);
94
95/*
96 * A temporary stack to use for CPU reset. This is static so that we
97 * don't clobber it with the identity mapping. When running with this
98 * stack, any references to the current task *will not work* so you
99 * should really do as little as possible before jumping to your reset
100 * code.
101 */
102static u64 soft_restart_stack[16];
103
104static void __soft_restart(void *addr)
105{
106 phys_reset_t phys_reset;
107
108 /* Take out a flat memory mapping. */
109 setup_mm_for_reboot();
110
111 /* Clean and invalidate caches */
112 flush_cache_all();
113
114 /* Turn off caching */
115 cpu_proc_fin();
116
117 /* Push out any further dirty data, and ensure cache is empty */
118 flush_cache_all();
119
120 /* Switch to the identity mapping. */
121 phys_reset = (phys_reset_t)(unsigned long)virt_to_phys(cpu_reset);
122 phys_reset((unsigned long)addr);
123
124 /* Should never get here. */
125 BUG();
126}
127
128void soft_restart(unsigned long addr)
129{
130 u64 *stack = soft_restart_stack + ARRAY_SIZE(soft_restart_stack);
131
132 /* Disable interrupts first */
133 local_irq_disable();
134 local_fiq_disable();
135
136 /* Disable the L2 if we're the last man standing. */
137 if (num_online_cpus() == 1)
138 outer_disable();
139
140 /* Change to the new stack and continue with the reset. */
141 call_with_stack(__soft_restart, (void *)addr, (void *)stack);
142
143 /* Should never get here. */
144 BUG();
145}
146
147static void null_restart(char mode, const char *cmd)
148{
149}
150
151/*
152 * Function pointers to optional machine specific functions
153 */
154void (*pm_power_off)(void);
155EXPORT_SYMBOL(pm_power_off);
156
157void (*arm_pm_restart)(char str, const char *cmd) = null_restart;
158EXPORT_SYMBOL_GPL(arm_pm_restart);
159
160/*
161 * This is our default idle handler.
162 */
163
164void (*arm_pm_idle)(void);
165
166static void default_idle(void)
167{
168 if (arm_pm_idle)
169 arm_pm_idle();
170 else
171 cpu_do_idle();
172 local_irq_enable();
173}
174
175void (*pm_idle)(void) = default_idle;
176EXPORT_SYMBOL(pm_idle);
177
178/*
179 * The idle thread, has rather strange semantics for calling pm_idle,
180 * but this is what x86 does and we need to do the same, so that
181 * things like cpuidle get called in the same way. The only difference
182 * is that we always respect 'hlt_counter' to prevent low power idle.
183 */
184void cpu_idle(void)
185{
186 local_fiq_enable();
187
188 /* endless idle loop with no priority at all */
189 while (1) {
190 tick_nohz_idle_enter();
191 rcu_idle_enter();
192 leds_event(led_idle_start);
193 while (!need_resched()) {
194#ifdef CONFIG_HOTPLUG_CPU
195 if (cpu_is_offline(smp_processor_id()))
196 cpu_die();
197#endif
198
199 /*
200 * We need to disable interrupts here
201 * to ensure we don't miss a wakeup call.
202 */
203 local_irq_disable();
204#ifdef CONFIG_PL310_ERRATA_769419
205 wmb();
206#endif
207 if (hlt_counter) {
208 local_irq_enable();
209 cpu_relax();
210 } else if (!need_resched()) {
211 stop_critical_timings();
212 if (cpuidle_idle_call())
213 pm_idle();
214 start_critical_timings();
215 /*
216 * pm_idle functions must always
217 * return with IRQs enabled.
218 */
219 WARN_ON(irqs_disabled());
220 } else
221 local_irq_enable();
222 }
223 leds_event(led_idle_end);
224 rcu_idle_exit();
225 tick_nohz_idle_exit();
226 schedule_preempt_disabled();
227 }
228}
229
230static char reboot_mode = 'h';
231
232int __init reboot_setup(char *str)
233{
234 reboot_mode = str[0];
235 return 1;
236}
237
238__setup("reboot=", reboot_setup);
239
240void machine_shutdown(void)
241{
242#ifdef CONFIG_SMP
243 smp_send_stop();
244#endif
245}
246
247void machine_halt(void)
248{
249 machine_shutdown();
250 local_irq_disable();
251 while (1);
252}
253
254void machine_power_off(void)
255{
256 machine_shutdown();
257 if (pm_power_off)
258 pm_power_off();
259}
260
261void machine_restart(char *cmd)
262{
263 machine_shutdown();
264
265 arm_pm_restart(reboot_mode, cmd);
266
267 /* Give a grace period for failure to restart of 1s */
268 mdelay(1000);
269
270 /* Whoops - the platform was unable to reboot. Tell the user! */
271 printk("Reboot failed -- System halted\n");
272 local_irq_disable();
273 while (1);
274}
275
276void __show_regs(struct pt_regs *regs)
277{
278 unsigned long flags;
279 char buf[64];
280
281 printk("CPU: %d %s (%s %.*s)\n",
282 raw_smp_processor_id(), print_tainted(),
283 init_utsname()->release,
284 (int)strcspn(init_utsname()->version, " "),
285 init_utsname()->version);
286 print_symbol("PC is at %s\n", instruction_pointer(regs));
287 print_symbol("LR is at %s\n", regs->ARM_lr);
288 printk("pc : [<%08lx>] lr : [<%08lx>] psr: %08lx\n"
289 "sp : %08lx ip : %08lx fp : %08lx\n",
290 regs->ARM_pc, regs->ARM_lr, regs->ARM_cpsr,
291 regs->ARM_sp, regs->ARM_ip, regs->ARM_fp);
292 printk("r10: %08lx r9 : %08lx r8 : %08lx\n",
293 regs->ARM_r10, regs->ARM_r9,
294 regs->ARM_r8);
295 printk("r7 : %08lx r6 : %08lx r5 : %08lx r4 : %08lx\n",
296 regs->ARM_r7, regs->ARM_r6,
297 regs->ARM_r5, regs->ARM_r4);
298 printk("r3 : %08lx r2 : %08lx r1 : %08lx r0 : %08lx\n",
299 regs->ARM_r3, regs->ARM_r2,
300 regs->ARM_r1, regs->ARM_r0);
301
302 flags = regs->ARM_cpsr;
303 buf[0] = flags & PSR_N_BIT ? 'N' : 'n';
304 buf[1] = flags & PSR_Z_BIT ? 'Z' : 'z';
305 buf[2] = flags & PSR_C_BIT ? 'C' : 'c';
306 buf[3] = flags & PSR_V_BIT ? 'V' : 'v';
307 buf[4] = '\0';
308
309 printk("Flags: %s IRQs o%s FIQs o%s Mode %s ISA %s Segment %s\n",
310 buf, interrupts_enabled(regs) ? "n" : "ff",
311 fast_interrupts_enabled(regs) ? "n" : "ff",
312 processor_modes[processor_mode(regs)],
313 isa_modes[isa_mode(regs)],
314 get_fs() == get_ds() ? "kernel" : "user");
315#ifdef CONFIG_CPU_CP15
316 {
317 unsigned int ctrl;
318
319 buf[0] = '\0';
320#ifdef CONFIG_CPU_CP15_MMU
321 {
322 unsigned int transbase, dac;
323 asm("mrc p15, 0, %0, c2, c0\n\t"
324 "mrc p15, 0, %1, c3, c0\n"
325 : "=r" (transbase), "=r" (dac));
326 snprintf(buf, sizeof(buf), " Table: %08x DAC: %08x",
327 transbase, dac);
328 }
329#endif
330 asm("mrc p15, 0, %0, c1, c0\n" : "=r" (ctrl));
331
332 printk("Control: %08x%s\n", ctrl, buf);
333 }
334#endif
335}
336
337void show_regs(struct pt_regs * regs)
338{
339 printk("\n");
340 printk("Pid: %d, comm: %20s\n", task_pid_nr(current), current->comm);
341 __show_regs(regs);
342 dump_stack();
343}
344
345ATOMIC_NOTIFIER_HEAD(thread_notify_head);
346
347EXPORT_SYMBOL_GPL(thread_notify_head);
348
349/*
350 * Free current thread data structures etc..
351 */
352void exit_thread(void)
353{
354 thread_notify(THREAD_NOTIFY_EXIT, current_thread_info());
355}
356
357void flush_thread(void)
358{
359 struct thread_info *thread = current_thread_info();
360 struct task_struct *tsk = current;
361
362 flush_ptrace_hw_breakpoint(tsk);
363
364 memset(thread->used_cp, 0, sizeof(thread->used_cp));
365 memset(&tsk->thread.debug, 0, sizeof(struct debug_info));
366 memset(&thread->fpstate, 0, sizeof(union fp_state));
367
368 thread_notify(THREAD_NOTIFY_FLUSH, thread);
369}
370
371void release_thread(struct task_struct *dead_task)
372{
373}
374
375asmlinkage void ret_from_fork(void) __asm__("ret_from_fork");
376
377int
378copy_thread(unsigned long clone_flags, unsigned long stack_start,
379 unsigned long stk_sz, struct task_struct *p, struct pt_regs *regs)
380{
381 struct thread_info *thread = task_thread_info(p);
382 struct pt_regs *childregs = task_pt_regs(p);
383
384 *childregs = *regs;
385 childregs->ARM_r0 = 0;
386 childregs->ARM_sp = stack_start;
387
388 memset(&thread->cpu_context, 0, sizeof(struct cpu_context_save));
389 thread->cpu_context.sp = (unsigned long)childregs;
390 thread->cpu_context.pc = (unsigned long)ret_from_fork;
391
392 clear_ptrace_hw_breakpoint(p);
393
394 if (clone_flags & CLONE_SETTLS)
395 thread->tp_value = regs->ARM_r3;
396
397 thread_notify(THREAD_NOTIFY_COPY, thread);
398
399 return 0;
400}
401
402/*
403 * Fill in the task's elfregs structure for a core dump.
404 */
405int dump_task_regs(struct task_struct *t, elf_gregset_t *elfregs)
406{
407 elf_core_copy_regs(elfregs, task_pt_regs(t));
408 return 1;
409}
410
411/*
412 * fill in the fpe structure for a core dump...
413 */
414int dump_fpu (struct pt_regs *regs, struct user_fp *fp)
415{
416 struct thread_info *thread = current_thread_info();
417 int used_math = thread->used_cp[1] | thread->used_cp[2];
418
419 if (used_math)
420 memcpy(fp, &thread->fpstate.soft, sizeof (*fp));
421
422 return used_math != 0;
423}
424EXPORT_SYMBOL(dump_fpu);
425
426/*
427 * Shuffle the argument into the correct register before calling the
428 * thread function. r4 is the thread argument, r5 is the pointer to
429 * the thread function, and r6 points to the exit function.
430 */
431extern void kernel_thread_helper(void);
432asm( ".pushsection .text\n"
433" .align\n"
434" .type kernel_thread_helper, #function\n"
435"kernel_thread_helper:\n"
436#ifdef CONFIG_TRACE_IRQFLAGS
437" bl trace_hardirqs_on\n"
438#endif
439" msr cpsr_c, r7\n"
440" mov r0, r4\n"
441" mov lr, r6\n"
442" mov pc, r5\n"
443" .size kernel_thread_helper, . - kernel_thread_helper\n"
444" .popsection");
445
446#ifdef CONFIG_ARM_UNWIND
447extern void kernel_thread_exit(long code);
448asm( ".pushsection .text\n"
449" .align\n"
450" .type kernel_thread_exit, #function\n"
451"kernel_thread_exit:\n"
452" .fnstart\n"
453" .cantunwind\n"
454" bl do_exit\n"
455" nop\n"
456" .fnend\n"
457" .size kernel_thread_exit, . - kernel_thread_exit\n"
458" .popsection");
459#else
460#define kernel_thread_exit do_exit
461#endif
462
463/*
464 * Create a kernel thread.
465 */
466pid_t kernel_thread(int (*fn)(void *), void *arg, unsigned long flags)
467{
468 struct pt_regs regs;
469
470 memset(®s, 0, sizeof(regs));
471
472 regs.ARM_r4 = (unsigned long)arg;
473 regs.ARM_r5 = (unsigned long)fn;
474 regs.ARM_r6 = (unsigned long)kernel_thread_exit;
475 regs.ARM_r7 = SVC_MODE | PSR_ENDSTATE | PSR_ISETSTATE;
476 regs.ARM_pc = (unsigned long)kernel_thread_helper;
477 regs.ARM_cpsr = regs.ARM_r7 | PSR_I_BIT;
478
479 return do_fork(flags|CLONE_VM|CLONE_UNTRACED, 0, ®s, 0, NULL, NULL);
480}
481EXPORT_SYMBOL(kernel_thread);
482
483unsigned long get_wchan(struct task_struct *p)
484{
485 struct stackframe frame;
486 int count = 0;
487 if (!p || p == current || p->state == TASK_RUNNING)
488 return 0;
489
490 frame.fp = thread_saved_fp(p);
491 frame.sp = thread_saved_sp(p);
492 frame.lr = 0; /* recovered from the stack */
493 frame.pc = thread_saved_pc(p);
494 do {
495 int ret = unwind_frame(&frame);
496 if (ret < 0)
497 return 0;
498 if (!in_sched_functions(frame.pc))
499 return frame.pc;
500 } while (count ++ < 16);
501 return 0;
502}
503
504unsigned long arch_randomize_brk(struct mm_struct *mm)
505{
506 unsigned long range_end = mm->brk + 0x02000000;
507 return randomize_range(mm->brk, range_end, 0) ? : mm->brk;
508}
509
510#ifdef CONFIG_MMU
511/*
512 * The vectors page is always readable from user space for the
513 * atomic helpers and the signal restart code. Insert it into the
514 * gate_vma so that it is visible through ptrace and /proc/<pid>/mem.
515 */
516static struct vm_area_struct gate_vma;
517
518static int __init gate_vma_init(void)
519{
520 gate_vma.vm_start = 0xffff0000;
521 gate_vma.vm_end = 0xffff0000 + PAGE_SIZE;
522 gate_vma.vm_page_prot = PAGE_READONLY_EXEC;
523 gate_vma.vm_flags = VM_READ | VM_EXEC |
524 VM_MAYREAD | VM_MAYEXEC;
525 return 0;
526}
527arch_initcall(gate_vma_init);
528
529struct vm_area_struct *get_gate_vma(struct mm_struct *mm)
530{
531 return &gate_vma;
532}
533
534int in_gate_area(struct mm_struct *mm, unsigned long addr)
535{
536 return (addr >= gate_vma.vm_start) && (addr < gate_vma.vm_end);
537}
538
539int in_gate_area_no_mm(unsigned long addr)
540{
541 return in_gate_area(NULL, addr);
542}
543
544const char *arch_vma_name(struct vm_area_struct *vma)
545{
546 return (vma == &gate_vma) ? "[vectors]" : NULL;
547}
548#endif