2 * Copyright (C) 2008-2009 Michal Simek <monstr@monstr.eu>
3 * Copyright (C) 2008-2009 PetaLogix
4 * Copyright (C) 2006 Atmark Techno, Inc.
6 * This file is subject to the terms and conditions of the GNU General Public
7 * License. See the file "COPYING" in the main directory of this archive
11 #include <linux/module.h>
12 #include <linux/sched.h>
14 #include <linux/tick.h>
15 #include <linux/bitops.h>
16 #include <asm/pgalloc.h>
17 #include <asm/uaccess.h> /* for USER_DS macros */
18 #include <asm/cacheflush.h>
20 void show_regs(struct pt_regs
*regs
)
22 printk(KERN_INFO
" Registers dump: mode=%X\r\n", regs
->pt_mode
);
23 printk(KERN_INFO
" r1=%08lX, r2=%08lX, r3=%08lX, r4=%08lX\n",
24 regs
->r1
, regs
->r2
, regs
->r3
, regs
->r4
);
25 printk(KERN_INFO
" r5=%08lX, r6=%08lX, r7=%08lX, r8=%08lX\n",
26 regs
->r5
, regs
->r6
, regs
->r7
, regs
->r8
);
27 printk(KERN_INFO
" r9=%08lX, r10=%08lX, r11=%08lX, r12=%08lX\n",
28 regs
->r9
, regs
->r10
, regs
->r11
, regs
->r12
);
29 printk(KERN_INFO
" r13=%08lX, r14=%08lX, r15=%08lX, r16=%08lX\n",
30 regs
->r13
, regs
->r14
, regs
->r15
, regs
->r16
);
31 printk(KERN_INFO
" r17=%08lX, r18=%08lX, r19=%08lX, r20=%08lX\n",
32 regs
->r17
, regs
->r18
, regs
->r19
, regs
->r20
);
33 printk(KERN_INFO
" r21=%08lX, r22=%08lX, r23=%08lX, r24=%08lX\n",
34 regs
->r21
, regs
->r22
, regs
->r23
, regs
->r24
);
35 printk(KERN_INFO
" r25=%08lX, r26=%08lX, r27=%08lX, r28=%08lX\n",
36 regs
->r25
, regs
->r26
, regs
->r27
, regs
->r28
);
37 printk(KERN_INFO
" r29=%08lX, r30=%08lX, r31=%08lX, rPC=%08lX\n",
38 regs
->r29
, regs
->r30
, regs
->r31
, regs
->pc
);
39 printk(KERN_INFO
" msr=%08lX, ear=%08lX, esr=%08lX, fsr=%08lX\n",
40 regs
->msr
, regs
->ear
, regs
->esr
, regs
->fsr
);
43 void (*pm_idle
)(void);
44 void (*pm_power_off
)(void) = NULL
;
45 EXPORT_SYMBOL(pm_power_off
);
47 static int hlt_counter
= 1;
49 void disable_hlt(void)
53 EXPORT_SYMBOL(disable_hlt
);
59 EXPORT_SYMBOL(enable_hlt
);
61 static int __init
nohlt_setup(char *__unused
)
66 __setup("nohlt", nohlt_setup
);
68 static int __init
hlt_setup(char *__unused
)
73 __setup("hlt", hlt_setup
);
75 void default_idle(void)
77 if (likely(hlt_counter
)) {
79 stop_critical_timings();
81 start_critical_timings();
84 clear_thread_flag(TIF_POLLING_NRFLAG
);
85 smp_mb__after_clear_bit();
87 while (!need_resched())
90 set_thread_flag(TIF_POLLING_NRFLAG
);
96 set_thread_flag(TIF_POLLING_NRFLAG
);
98 /* endless idle loop with no priority at all */
100 void (*idle
)(void) = pm_idle
;
105 tick_nohz_idle_enter();
107 while (!need_resched())
110 tick_nohz_idle_exit();
112 schedule_preempt_disabled();
117 void flush_thread(void)
121 int copy_thread(unsigned long clone_flags
, unsigned long usp
,
123 struct task_struct
*p
, struct pt_regs
*regs
)
125 struct pt_regs
*childregs
= task_pt_regs(p
);
126 struct thread_info
*ti
= task_thread_info(p
);
128 if (unlikely(p
->flags
& PF_KTHREAD
)) {
129 /* if we're creating a new kernel thread then just zeroing all
130 * the registers. That's OK for a brand new thread.*/
131 memset(childregs
, 0, sizeof(struct pt_regs
));
132 memset(&ti
->cpu_context
, 0, sizeof(struct cpu_context
));
133 ti
->cpu_context
.r1
= (unsigned long)childregs
;
134 ti
->cpu_context
.r20
= (unsigned long)usp
; /* fn */
135 ti
->cpu_context
.r19
= (unsigned long)arg
;
136 childregs
->pt_mode
= 1;
137 local_save_flags(childregs
->msr
);
139 ti
->cpu_context
.msr
= childregs
->msr
& ~MSR_IE
;
141 ti
->cpu_context
.r15
= (unsigned long)ret_from_kernel_thread
- 8;
147 memset(&ti
->cpu_context
, 0, sizeof(struct cpu_context
));
148 ti
->cpu_context
.r1
= (unsigned long)childregs
;
150 ti
->cpu_context
.msr
= (unsigned long)childregs
->msr
;
152 childregs
->msr
|= MSR_UMS
;
154 /* we should consider the fact that childregs is a copy of the parent
155 * regs which were saved immediately after entering the kernel state
156 * before enabling VM. This MSR will be restored in switch_to and
157 * RETURN() and we want to have the right machine state there
158 * specifically this state must have INTs disabled before and enabled
159 * after performing rtbd
160 * compose the right MSR for RETURN(). It will work for switch_to also
161 * excepting for VM and UMS
162 * don't touch UMS , CARRY and cache bits
163 * right now MSR is a copy of parent one */
164 childregs
->msr
|= MSR_BIP
;
165 childregs
->msr
&= ~MSR_EIP
;
166 childregs
->msr
|= MSR_IE
;
167 childregs
->msr
&= ~MSR_VM
;
168 childregs
->msr
|= MSR_VMS
;
169 childregs
->msr
|= MSR_EE
; /* exceptions will be enabled*/
171 ti
->cpu_context
.msr
= (childregs
->msr
|MSR_VM
);
172 ti
->cpu_context
.msr
&= ~MSR_UMS
; /* switch_to to kernel mode */
173 ti
->cpu_context
.msr
&= ~MSR_IE
;
175 ti
->cpu_context
.r15
= (unsigned long)ret_from_fork
- 8;
178 * r21 is the thread reg, r10 is 6th arg to clone
179 * which contains TLS area
181 if (clone_flags
& CLONE_SETTLS
)
182 childregs
->r21
= childregs
->r10
;
189 * Return saved PC of a blocked thread.
191 unsigned long thread_saved_pc(struct task_struct
*tsk
)
193 struct cpu_context
*ctx
=
194 &(((struct thread_info
*)(tsk
->stack
))->cpu_context
);
196 /* Check whether the thread is blocked in resume() */
197 if (in_sched_functions(ctx
->r15
))
198 return (unsigned long)ctx
->r15
;
204 unsigned long get_wchan(struct task_struct
*p
)
206 /* TBD (used by procfs) */
210 /* Set up a thread for executing a new program */
211 void start_thread(struct pt_regs
*regs
, unsigned long pc
, unsigned long usp
)
217 regs
->msr
|= MSR_UMS
;
218 regs
->msr
&= ~MSR_VM
;
223 #include <linux/elfcore.h>
225 * Set up a thread for executing a new program
227 int dump_fpu(struct pt_regs
*regs
, elf_fpregset_t
*fpregs
)
229 return 0; /* MicroBlaze has no separate FPU registers */
231 #endif /* CONFIG_MMU */
This page took 0.036141 seconds and 6 git commands to generate.