2 * This file is subject to the terms and conditions of the GNU General Public
3 * License. See the file "COPYING" in the main directory of this archive
6 * Copyright (C) 1994 - 1999, 2000 by Ralf Baechle and others.
7 * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
8 * Copyright (C) 2004 Thiemo Seufer
10 #include <linux/config.h>
11 #include <linux/errno.h>
12 #include <linux/module.h>
13 #include <linux/sched.h>
14 #include <linux/kernel.h>
16 #include <linux/stddef.h>
17 #include <linux/unistd.h>
18 #include <linux/ptrace.h>
19 #include <linux/slab.h>
20 #include <linux/mman.h>
21 #include <linux/personality.h>
22 #include <linux/sys.h>
23 #include <linux/user.h>
24 #include <linux/a.out.h>
25 #include <linux/init.h>
26 #include <linux/completion.h>
29 #include <asm/bootinfo.h>
33 #include <asm/pgtable.h>
34 #include <asm/system.h>
35 #include <asm/mipsregs.h>
36 #include <asm/processor.h>
37 #include <asm/uaccess.h>
40 #include <asm/isadep.h>
44 * The idle thread. There's no useful work to be done, so just try to conserve
45 * power and have a low exit latency (ie sit in a loop waiting for somebody to
46 * say that they'd like to reschedule)
48 ATTRIB_NORET
void cpu_idle(void)
50 /* endless idle loop with no priority at all */
52 while (!need_resched())
55 preempt_enable_no_resched();
61 extern int do_signal(sigset_t
*oldset
, struct pt_regs
*regs
);
62 extern int do_signal32(sigset_t
*oldset
, struct pt_regs
*regs
);
65 * Native o32 and N64 ABI without DSP ASE
67 extern int setup_frame(struct k_sigaction
* ka
, struct pt_regs
*regs
,
68 int signr
, sigset_t
*set
);
69 extern int setup_rt_frame(struct k_sigaction
* ka
, struct pt_regs
*regs
,
70 int signr
, sigset_t
*set
, siginfo_t
*info
);
72 struct mips_abi mips_abi
= {
73 .do_signal
= do_signal
,
74 #ifdef CONFIG_TRAD_SIGNALS
75 .setup_frame
= setup_frame
,
77 .setup_rt_frame
= setup_rt_frame
80 #ifdef CONFIG_MIPS32_O32
82 * o32 compatibility on 64-bit kernels, without DSP ASE
84 extern int setup_frame_32(struct k_sigaction
* ka
, struct pt_regs
*regs
,
85 int signr
, sigset_t
*set
);
86 extern int setup_rt_frame_32(struct k_sigaction
* ka
, struct pt_regs
*regs
,
87 int signr
, sigset_t
*set
, siginfo_t
*info
);
89 struct mips_abi mips_abi_32
= {
90 .do_signal
= do_signal32
,
91 .setup_frame
= setup_frame_32
,
92 .setup_rt_frame
= setup_rt_frame_32
94 #endif /* CONFIG_MIPS32_O32 */
96 #ifdef CONFIG_MIPS32_N32
98 * N32 on 64-bit kernels, without DSP ASE
100 extern int setup_rt_frame_n32(struct k_sigaction
* ka
, struct pt_regs
*regs
,
101 int signr
, sigset_t
*set
, siginfo_t
*info
);
103 struct mips_abi mips_abi_n32
= {
104 .do_signal
= do_signal
,
105 .setup_rt_frame
= setup_rt_frame_n32
107 #endif /* CONFIG_MIPS32_N32 */
109 asmlinkage
void ret_from_fork(void);
111 void start_thread(struct pt_regs
* regs
, unsigned long pc
, unsigned long sp
)
113 unsigned long status
;
115 /* New thread loses kernel privileges. */
116 status
= regs
->cp0_status
& ~(ST0_CU0
|ST0_CU1
|KU_MASK
);
119 status
|= (current
->thread
.mflags
& MF_32BIT_REGS
) ? 0 : ST0_FR
;
122 regs
->cp0_status
= status
;
129 current_thread_info()->addr_limit
= USER_DS
;
132 void exit_thread(void)
136 void flush_thread(void)
140 int copy_thread(int nr
, unsigned long clone_flags
, unsigned long usp
,
141 unsigned long unused
, struct task_struct
*p
, struct pt_regs
*regs
)
143 struct thread_info
*ti
= p
->thread_info
;
144 struct pt_regs
*childregs
;
146 p
->set_child_tid
= p
->clear_child_tid
= NULL
;
148 childksp
= (unsigned long)ti
+ THREAD_SIZE
- 32;
160 /* set up new TSS. */
161 childregs
= (struct pt_regs
*) childksp
- 1;
163 childregs
->regs
[7] = 0; /* Clear error flag */
165 #if defined(CONFIG_BINFMT_IRIX)
166 if (current
->personality
!= PER_LINUX
) {
167 /* Under IRIX things are a little different. */
168 childregs
->regs
[3] = 1;
172 childregs
->regs
[2] = 0; /* Child gets zero as return value */
173 regs
->regs
[2] = p
->pid
;
175 if (childregs
->cp0_status
& ST0_CU0
) {
176 childregs
->regs
[28] = (unsigned long) ti
;
177 childregs
->regs
[29] = childksp
;
178 ti
->addr_limit
= KERNEL_DS
;
180 childregs
->regs
[29] = usp
;
181 ti
->addr_limit
= USER_DS
;
183 p
->thread
.reg29
= (unsigned long) childregs
;
184 p
->thread
.reg31
= (unsigned long) ret_from_fork
;
187 * New tasks lose permission to use the fpu. This accelerates context
188 * switching for most programs since they don't use the fpu.
190 p
->thread
.cp0_status
= read_c0_status() & ~(ST0_CU2
|ST0_CU1
);
191 childregs
->cp0_status
&= ~(ST0_CU2
|ST0_CU1
);
192 clear_tsk_thread_flag(p
, TIF_USEDFPU
);
194 if (clone_flags
& CLONE_SETTLS
)
195 ti
->tp_value
= regs
->regs
[7];
200 /* Fill in the fpu structure for a core dump.. */
201 int dump_fpu(struct pt_regs
*regs
, elf_fpregset_t
*r
)
203 memcpy(r
, ¤t
->thread
.fpu
, sizeof(current
->thread
.fpu
));
208 void dump_regs(elf_greg_t
*gp
, struct pt_regs
*regs
)
212 for (i
= 0; i
< EF_R0
; i
++)
215 for (i
= 1; i
<= 31; i
++)
216 gp
[EF_R0
+ i
] = regs
->regs
[i
];
219 gp
[EF_LO
] = regs
->lo
;
220 gp
[EF_HI
] = regs
->hi
;
221 gp
[EF_CP0_EPC
] = regs
->cp0_epc
;
222 gp
[EF_CP0_BADVADDR
] = regs
->cp0_badvaddr
;
223 gp
[EF_CP0_STATUS
] = regs
->cp0_status
;
224 gp
[EF_CP0_CAUSE
] = regs
->cp0_cause
;
230 int dump_task_regs (struct task_struct
*tsk
, elf_gregset_t
*regs
)
232 struct thread_info
*ti
= tsk
->thread_info
;
233 long ksp
= (unsigned long)ti
+ THREAD_SIZE
- 32;
234 dump_regs(&(*regs
)[0], (struct pt_regs
*) ksp
- 1);
238 int dump_task_fpu (struct task_struct
*t
, elf_fpregset_t
*fpr
)
240 memcpy(fpr
, &t
->thread
.fpu
, sizeof(current
->thread
.fpu
));
246 * Create a kernel thread
248 ATTRIB_NORET
void kernel_thread_helper(void *arg
, int (*fn
)(void *))
253 long kernel_thread(int (*fn
)(void *), void *arg
, unsigned long flags
)
257 memset(®s
, 0, sizeof(regs
));
259 regs
.regs
[4] = (unsigned long) arg
;
260 regs
.regs
[5] = (unsigned long) fn
;
261 regs
.cp0_epc
= (unsigned long) kernel_thread_helper
;
262 regs
.cp0_status
= read_c0_status();
263 #if defined(CONFIG_CPU_R3000) || defined(CONFIG_CPU_TX39XX)
264 regs
.cp0_status
&= ~(ST0_KUP
| ST0_IEC
);
265 regs
.cp0_status
|= ST0_IEP
;
267 regs
.cp0_status
|= ST0_EXL
;
270 /* Ok, create the new process.. */
271 return do_fork(flags
| CLONE_VM
| CLONE_UNTRACED
, 0, ®s
, 0, NULL
, NULL
);
274 static struct mips_frame_info
{
276 int omit_fp
; /* compiled without fno-omit-frame-pointer */
279 } schedule_frame
, mfinfo
[] = {
280 { schedule
, 0 }, /* must be first */
281 /* arch/mips/kernel/semaphore.c */
283 { __down_interruptible
, 1 },
285 #ifdef CONFIG_PREEMPT
286 { preempt_schedule
, 0 },
288 { wait_for_completion
, 0 },
289 { interruptible_sleep_on
, 0 },
290 { interruptible_sleep_on_timeout
, 0 },
292 { sleep_on_timeout
, 0 },
295 { io_schedule_timeout
, 0 },
296 #if defined(CONFIG_SMP) && defined(CONFIG_PREEMPT)
297 { __preempt_spin_lock
, 0 },
298 { __preempt_write_lock
, 0 },
301 { schedule_timeout
, 1 },
302 /* { nanosleep_restart, 1 }, */
303 /* lib/rwsem-spinlock.c */
308 static int mips_frame_info_initialized
;
309 static int __init
get_frame_info(struct mips_frame_info
*info
)
312 void *func
= info
->func
;
313 union mips_instruction
*ip
= (union mips_instruction
*)func
;
314 info
->pc_offset
= -1;
315 info
->frame_offset
= info
->omit_fp
? 0 : -1;
316 for (i
= 0; i
< 128; i
++, ip
++) {
317 /* if jal, jalr, jr, stop. */
318 if (ip
->j_format
.opcode
== jal_op
||
319 (ip
->r_format
.opcode
== spec_op
&&
320 (ip
->r_format
.func
== jalr_op
||
321 ip
->r_format
.func
== jr_op
)))
326 ip
->i_format
.opcode
== sw_op
&&
329 ip
->i_format
.opcode
== sd_op
&&
331 ip
->i_format
.rs
== 29)
333 /* sw / sd $ra, offset($sp) */
334 if (ip
->i_format
.rt
== 31) {
335 if (info
->pc_offset
!= -1)
338 ip
->i_format
.simmediate
/ sizeof(long);
340 /* sw / sd $s8, offset($sp) */
341 if (ip
->i_format
.rt
== 30) {
342 //#if 0 /* gcc 3.4 does aggressive optimization... */
343 if (info
->frame_offset
!= -1)
347 ip
->i_format
.simmediate
/ sizeof(long);
351 if (info
->pc_offset
== -1 || info
->frame_offset
== -1) {
352 printk("Can't analyze prologue code at %p\n", func
);
353 info
->pc_offset
= -1;
354 info
->frame_offset
= -1;
361 static int __init
frame_info_init(void)
364 for (i
= 0; i
< ARRAY_SIZE(mfinfo
); i
++)
365 if (get_frame_info(&mfinfo
[i
]))
367 schedule_frame
= mfinfo
[0];
370 struct mips_frame_info tmp
;
372 for (i
= 1; i
< ARRAY_SIZE(mfinfo
); i
++) {
373 if (mfinfo
[i
-1].func
> mfinfo
[i
].func
) {
375 mfinfo
[i
] = mfinfo
[i
-1];
381 mips_frame_info_initialized
= 1;
385 arch_initcall(frame_info_init
);
388 * Return saved PC of a blocked thread.
390 unsigned long thread_saved_pc(struct task_struct
*tsk
)
392 struct thread_struct
*t
= &tsk
->thread
;
394 /* New born processes are a special case */
395 if (t
->reg31
== (unsigned long) ret_from_fork
)
398 if (schedule_frame
.pc_offset
< 0)
400 return ((unsigned long *)t
->reg29
)[schedule_frame
.pc_offset
];
403 /* get_wchan - a maintenance nightmare^W^Wpain in the ass ... */
404 unsigned long get_wchan(struct task_struct
*p
)
406 unsigned long stack_page
;
407 unsigned long frame
, pc
;
409 if (!p
|| p
== current
|| p
->state
== TASK_RUNNING
)
412 stack_page
= (unsigned long)p
->thread_info
;
413 if (!stack_page
|| !mips_frame_info_initialized
)
416 pc
= thread_saved_pc(p
);
417 if (!in_sched_functions(pc
))
420 frame
= ((unsigned long *)p
->thread
.reg30
)[schedule_frame
.frame_offset
];
424 if (frame
< stack_page
|| frame
> stack_page
+ THREAD_SIZE
- 32)
427 for (i
= ARRAY_SIZE(mfinfo
) - 1; i
>= 0; i
--) {
428 if (pc
>= (unsigned long) mfinfo
[i
].func
)
434 if (mfinfo
[i
].omit_fp
)
436 pc
= ((unsigned long *)frame
)[mfinfo
[i
].pc_offset
];
437 frame
= ((unsigned long *)frame
)[mfinfo
[i
].frame_offset
];
438 } while (in_sched_functions(pc
));
443 EXPORT_SYMBOL(get_wchan
);