blob: 2784aab0d3e59d22f0b0a20fcc946f5d61b96855 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* $Id: process.c,v 1.131 2002/02/09 19:49:30 davem Exp $
2 * arch/sparc64/kernel/process.c
3 *
4 * Copyright (C) 1995, 1996 David S. Miller (davem@caip.rutgers.edu)
5 * Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be)
6 * Copyright (C) 1997, 1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
7 */
8
9/*
10 * This file handles the architecture-dependent parts of process handling..
11 */
12
13#include <stdarg.h>
14
15#include <linux/config.h>
16#include <linux/errno.h>
17#include <linux/module.h>
18#include <linux/sched.h>
19#include <linux/kernel.h>
20#include <linux/kallsyms.h>
21#include <linux/mm.h>
22#include <linux/smp.h>
23#include <linux/smp_lock.h>
24#include <linux/stddef.h>
25#include <linux/ptrace.h>
26#include <linux/slab.h>
27#include <linux/user.h>
28#include <linux/a.out.h>
29#include <linux/config.h>
30#include <linux/reboot.h>
31#include <linux/delay.h>
32#include <linux/compat.h>
33#include <linux/init.h>
34
35#include <asm/oplib.h>
36#include <asm/uaccess.h>
37#include <asm/system.h>
38#include <asm/page.h>
39#include <asm/pgalloc.h>
40#include <asm/pgtable.h>
41#include <asm/processor.h>
42#include <asm/pstate.h>
43#include <asm/elf.h>
44#include <asm/fpumacro.h>
45#include <asm/head.h>
46#include <asm/cpudata.h>
David S. Miller74bf4312006-01-31 18:29:18 -080047#include <asm/mmu_context.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070048#include <asm/unistd.h>
49
50/* #define VERBOSE_SHOWREGS */
51
52/*
53 * Nothing special yet...
54 */
55void default_idle(void)
56{
57}
58
59#ifndef CONFIG_SMP
60
61/*
62 * the idle loop on a Sparc... ;)
63 */
64void cpu_idle(void)
65{
Linus Torvalds1da177e2005-04-16 15:20:36 -070066 /* endless idle loop with no priority at all */
67 for (;;) {
68 /* If current->work.need_resched is zero we should really
69 * setup for a system wakup event and execute a shutdown
70 * instruction.
71 *
72 * But this requires writing back the contents of the
73 * L2 cache etc. so implement this later. -DaveM
74 */
75 while (!need_resched())
76 barrier();
77
Nick Piggin5bfb5d62005-11-08 21:39:01 -080078 preempt_enable_no_resched();
Linus Torvalds1da177e2005-04-16 15:20:36 -070079 schedule();
Nick Piggin5bfb5d62005-11-08 21:39:01 -080080 preempt_disable();
Linus Torvalds1da177e2005-04-16 15:20:36 -070081 check_pgt_cache();
82 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070083}
84
85#else
86
87/*
88 * the idle loop on a UltraMultiPenguin...
Nick Piggin64c7c8f2005-11-08 21:39:04 -080089 *
90 * TIF_POLLING_NRFLAG is set because we do not sleep the cpu
91 * inside of the idler task, so an interrupt is not needed
92 * to get a clean fast response.
93 *
94 * XXX Reverify this assumption... -DaveM
95 *
96 * Addendum: We do want it to do something for the signal
97 * delivery case, we detect that by just seeing
98 * if we are trying to send this to an idler or not.
Linus Torvalds1da177e2005-04-16 15:20:36 -070099 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100void cpu_idle(void)
101{
Nick Piggin64c7c8f2005-11-08 21:39:04 -0800102 cpuinfo_sparc *cpuinfo = &local_cpu_data();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 set_thread_flag(TIF_POLLING_NRFLAG);
Nick Piggin64c7c8f2005-11-08 21:39:04 -0800104
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105 while(1) {
106 if (need_resched()) {
Nick Piggin64c7c8f2005-11-08 21:39:04 -0800107 cpuinfo->idle_volume = 0;
Nick Piggin5bfb5d62005-11-08 21:39:01 -0800108 preempt_enable_no_resched();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109 schedule();
Nick Piggin5bfb5d62005-11-08 21:39:01 -0800110 preempt_disable();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111 check_pgt_cache();
112 }
Nick Piggin64c7c8f2005-11-08 21:39:04 -0800113 cpuinfo->idle_volume++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114
115 /* The store ordering is so that IRQ handlers on
116 * other cpus see our increasing idleness for the buddy
117 * redistribution algorithm. -DaveM
118 */
David S. Miller4f071182005-08-29 12:46:22 -0700119 membar_storeload_storestore();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120 }
121}
122
123#endif
124
125extern char reboot_command [];
126
127extern void (*prom_palette)(int);
128extern void (*prom_keyboard)(void);
129
130void machine_halt(void)
131{
132 if (!serial_console && prom_palette)
133 prom_palette (1);
134 if (prom_keyboard)
135 prom_keyboard();
136 prom_halt();
137 panic("Halt failed!");
138}
139
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140void machine_alt_power_off(void)
141{
142 if (!serial_console && prom_palette)
143 prom_palette(1);
144 if (prom_keyboard)
145 prom_keyboard();
146 prom_halt_power_off();
147 panic("Power-off failed!");
148}
149
150void machine_restart(char * cmd)
151{
152 char *p;
153
154 p = strchr (reboot_command, '\n');
155 if (p) *p = 0;
156 if (!serial_console && prom_palette)
157 prom_palette (1);
158 if (prom_keyboard)
159 prom_keyboard();
160 if (cmd)
161 prom_reboot(cmd);
162 if (*reboot_command)
163 prom_reboot(reboot_command);
164 prom_reboot("");
165 panic("Reboot failed!");
166}
167
David S. Miller959a85a2006-01-18 14:58:05 -0800168#ifdef CONFIG_COMPAT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700169static void show_regwindow32(struct pt_regs *regs)
170{
171 struct reg_window32 __user *rw;
172 struct reg_window32 r_w;
173 mm_segment_t old_fs;
174
175 __asm__ __volatile__ ("flushw");
176 rw = compat_ptr((unsigned)regs->u_regs[14]);
177 old_fs = get_fs();
178 set_fs (USER_DS);
179 if (copy_from_user (&r_w, rw, sizeof(r_w))) {
180 set_fs (old_fs);
181 return;
182 }
183
184 set_fs (old_fs);
185 printk("l0: %08x l1: %08x l2: %08x l3: %08x "
186 "l4: %08x l5: %08x l6: %08x l7: %08x\n",
187 r_w.locals[0], r_w.locals[1], r_w.locals[2], r_w.locals[3],
188 r_w.locals[4], r_w.locals[5], r_w.locals[6], r_w.locals[7]);
189 printk("i0: %08x i1: %08x i2: %08x i3: %08x "
190 "i4: %08x i5: %08x i6: %08x i7: %08x\n",
191 r_w.ins[0], r_w.ins[1], r_w.ins[2], r_w.ins[3],
192 r_w.ins[4], r_w.ins[5], r_w.ins[6], r_w.ins[7]);
193}
David S. Miller959a85a2006-01-18 14:58:05 -0800194#else
195#define show_regwindow32(regs) do { } while (0)
196#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197
198static void show_regwindow(struct pt_regs *regs)
199{
200 struct reg_window __user *rw;
201 struct reg_window *rwk;
202 struct reg_window r_w;
203 mm_segment_t old_fs;
204
205 if ((regs->tstate & TSTATE_PRIV) || !(test_thread_flag(TIF_32BIT))) {
206 __asm__ __volatile__ ("flushw");
207 rw = (struct reg_window __user *)
208 (regs->u_regs[14] + STACK_BIAS);
209 rwk = (struct reg_window *)
210 (regs->u_regs[14] + STACK_BIAS);
211 if (!(regs->tstate & TSTATE_PRIV)) {
212 old_fs = get_fs();
213 set_fs (USER_DS);
214 if (copy_from_user (&r_w, rw, sizeof(r_w))) {
215 set_fs (old_fs);
216 return;
217 }
218 rwk = &r_w;
219 set_fs (old_fs);
220 }
221 } else {
222 show_regwindow32(regs);
223 return;
224 }
225 printk("l0: %016lx l1: %016lx l2: %016lx l3: %016lx\n",
226 rwk->locals[0], rwk->locals[1], rwk->locals[2], rwk->locals[3]);
227 printk("l4: %016lx l5: %016lx l6: %016lx l7: %016lx\n",
228 rwk->locals[4], rwk->locals[5], rwk->locals[6], rwk->locals[7]);
229 printk("i0: %016lx i1: %016lx i2: %016lx i3: %016lx\n",
230 rwk->ins[0], rwk->ins[1], rwk->ins[2], rwk->ins[3]);
231 printk("i4: %016lx i5: %016lx i6: %016lx i7: %016lx\n",
232 rwk->ins[4], rwk->ins[5], rwk->ins[6], rwk->ins[7]);
233 if (regs->tstate & TSTATE_PRIV)
234 print_symbol("I7: <%s>\n", rwk->ins[7]);
235}
236
237void show_stackframe(struct sparc_stackf *sf)
238{
239 unsigned long size;
240 unsigned long *stk;
241 int i;
242
243 printk("l0: %016lx l1: %016lx l2: %016lx l3: %016lx\n"
244 "l4: %016lx l5: %016lx l6: %016lx l7: %016lx\n",
245 sf->locals[0], sf->locals[1], sf->locals[2], sf->locals[3],
246 sf->locals[4], sf->locals[5], sf->locals[6], sf->locals[7]);
247 printk("i0: %016lx i1: %016lx i2: %016lx i3: %016lx\n"
248 "i4: %016lx i5: %016lx fp: %016lx ret_pc: %016lx\n",
249 sf->ins[0], sf->ins[1], sf->ins[2], sf->ins[3],
250 sf->ins[4], sf->ins[5], (unsigned long)sf->fp, sf->callers_pc);
251 printk("sp: %016lx x0: %016lx x1: %016lx x2: %016lx\n"
252 "x3: %016lx x4: %016lx x5: %016lx xx: %016lx\n",
253 (unsigned long)sf->structptr, sf->xargs[0], sf->xargs[1],
254 sf->xargs[2], sf->xargs[3], sf->xargs[4], sf->xargs[5],
255 sf->xxargs[0]);
256 size = ((unsigned long)sf->fp) - ((unsigned long)sf);
257 size -= STACKFRAME_SZ;
258 stk = (unsigned long *)((unsigned long)sf + STACKFRAME_SZ);
259 i = 0;
260 do {
261 printk("s%d: %016lx\n", i++, *stk++);
262 } while ((size -= sizeof(unsigned long)));
263}
264
265void show_stackframe32(struct sparc_stackf32 *sf)
266{
267 unsigned long size;
268 unsigned *stk;
269 int i;
270
271 printk("l0: %08x l1: %08x l2: %08x l3: %08x\n",
272 sf->locals[0], sf->locals[1], sf->locals[2], sf->locals[3]);
273 printk("l4: %08x l5: %08x l6: %08x l7: %08x\n",
274 sf->locals[4], sf->locals[5], sf->locals[6], sf->locals[7]);
275 printk("i0: %08x i1: %08x i2: %08x i3: %08x\n",
276 sf->ins[0], sf->ins[1], sf->ins[2], sf->ins[3]);
277 printk("i4: %08x i5: %08x fp: %08x ret_pc: %08x\n",
278 sf->ins[4], sf->ins[5], sf->fp, sf->callers_pc);
279 printk("sp: %08x x0: %08x x1: %08x x2: %08x\n"
280 "x3: %08x x4: %08x x5: %08x xx: %08x\n",
281 sf->structptr, sf->xargs[0], sf->xargs[1],
282 sf->xargs[2], sf->xargs[3], sf->xargs[4], sf->xargs[5],
283 sf->xxargs[0]);
284 size = ((unsigned long)sf->fp) - ((unsigned long)sf);
285 size -= STACKFRAME32_SZ;
286 stk = (unsigned *)((unsigned long)sf + STACKFRAME32_SZ);
287 i = 0;
288 do {
289 printk("s%d: %08x\n", i++, *stk++);
290 } while ((size -= sizeof(unsigned)));
291}
292
293#ifdef CONFIG_SMP
294static DEFINE_SPINLOCK(regdump_lock);
295#endif
296
297void __show_regs(struct pt_regs * regs)
298{
299#ifdef CONFIG_SMP
300 unsigned long flags;
301
302 /* Protect against xcall ipis which might lead to livelock on the lock */
303 __asm__ __volatile__("rdpr %%pstate, %0\n\t"
304 "wrpr %0, %1, %%pstate"
305 : "=r" (flags)
306 : "i" (PSTATE_IE));
307 spin_lock(&regdump_lock);
308#endif
309 printk("TSTATE: %016lx TPC: %016lx TNPC: %016lx Y: %08x %s\n", regs->tstate,
310 regs->tpc, regs->tnpc, regs->y, print_tainted());
311 print_symbol("TPC: <%s>\n", regs->tpc);
312 printk("g0: %016lx g1: %016lx g2: %016lx g3: %016lx\n",
313 regs->u_regs[0], regs->u_regs[1], regs->u_regs[2],
314 regs->u_regs[3]);
315 printk("g4: %016lx g5: %016lx g6: %016lx g7: %016lx\n",
316 regs->u_regs[4], regs->u_regs[5], regs->u_regs[6],
317 regs->u_regs[7]);
318 printk("o0: %016lx o1: %016lx o2: %016lx o3: %016lx\n",
319 regs->u_regs[8], regs->u_regs[9], regs->u_regs[10],
320 regs->u_regs[11]);
321 printk("o4: %016lx o5: %016lx sp: %016lx ret_pc: %016lx\n",
322 regs->u_regs[12], regs->u_regs[13], regs->u_regs[14],
323 regs->u_regs[15]);
324 print_symbol("RPC: <%s>\n", regs->u_regs[15]);
325 show_regwindow(regs);
326#ifdef CONFIG_SMP
327 spin_unlock(&regdump_lock);
328 __asm__ __volatile__("wrpr %0, 0, %%pstate"
329 : : "r" (flags));
330#endif
331}
332
333#ifdef VERBOSE_SHOWREGS
334static void idump_from_user (unsigned int *pc)
335{
336 int i;
337 int code;
338
339 if((((unsigned long) pc) & 3))
340 return;
341
342 pc -= 3;
343 for(i = -3; i < 6; i++) {
344 get_user(code, pc);
345 printk("%c%08x%c",i?' ':'<',code,i?' ':'>');
346 pc++;
347 }
348 printk("\n");
349}
350#endif
351
352void show_regs(struct pt_regs *regs)
353{
354#ifdef VERBOSE_SHOWREGS
355 extern long etrap, etraptl1;
356#endif
357 __show_regs(regs);
358#ifdef CONFIG_SMP
359 {
360 extern void smp_report_regs(void);
361
362 smp_report_regs();
363 }
364#endif
365
366#ifdef VERBOSE_SHOWREGS
367 if (regs->tpc >= &etrap && regs->tpc < &etraptl1 &&
368 regs->u_regs[14] >= (long)current - PAGE_SIZE &&
369 regs->u_regs[14] < (long)current + 6 * PAGE_SIZE) {
370 printk ("*********parent**********\n");
371 __show_regs((struct pt_regs *)(regs->u_regs[14] + PTREGS_OFF));
372 idump_from_user(((struct pt_regs *)(regs->u_regs[14] + PTREGS_OFF))->tpc);
373 printk ("*********endpar**********\n");
374 }
375#endif
376}
377
378void show_regs32(struct pt_regs32 *regs)
379{
380 printk("PSR: %08x PC: %08x NPC: %08x Y: %08x %s\n", regs->psr,
381 regs->pc, regs->npc, regs->y, print_tainted());
382 printk("g0: %08x g1: %08x g2: %08x g3: %08x ",
383 regs->u_regs[0], regs->u_regs[1], regs->u_regs[2],
384 regs->u_regs[3]);
385 printk("g4: %08x g5: %08x g6: %08x g7: %08x\n",
386 regs->u_regs[4], regs->u_regs[5], regs->u_regs[6],
387 regs->u_regs[7]);
388 printk("o0: %08x o1: %08x o2: %08x o3: %08x ",
389 regs->u_regs[8], regs->u_regs[9], regs->u_regs[10],
390 regs->u_regs[11]);
391 printk("o4: %08x o5: %08x sp: %08x ret_pc: %08x\n",
392 regs->u_regs[12], regs->u_regs[13], regs->u_regs[14],
393 regs->u_regs[15]);
394}
395
396unsigned long thread_saved_pc(struct task_struct *tsk)
397{
Al Virof3169642006-01-12 01:05:42 -0800398 struct thread_info *ti = task_thread_info(tsk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399 unsigned long ret = 0xdeadbeefUL;
400
401 if (ti && ti->ksp) {
402 unsigned long *sp;
403 sp = (unsigned long *)(ti->ksp + STACK_BIAS);
404 if (((unsigned long)sp & (sizeof(long) - 1)) == 0UL &&
405 sp[14]) {
406 unsigned long *fp;
407 fp = (unsigned long *)(sp[14] + STACK_BIAS);
408 if (((unsigned long)fp & (sizeof(long) - 1)) == 0UL)
409 ret = fp[15];
410 }
411 }
412 return ret;
413}
414
415/* Free current thread data structures etc.. */
416void exit_thread(void)
417{
418 struct thread_info *t = current_thread_info();
419
420 if (t->utraps) {
421 if (t->utraps[0] < 2)
422 kfree (t->utraps);
423 else
424 t->utraps[0]--;
425 }
426
427 if (test_and_clear_thread_flag(TIF_PERFCTR)) {
428 t->user_cntd0 = t->user_cntd1 = NULL;
429 t->pcr_reg = 0;
430 write_pcr(0);
431 }
432}
433
434void flush_thread(void)
435{
436 struct thread_info *t = current_thread_info();
David S. Miller74bf4312006-01-31 18:29:18 -0800437 struct mm_struct *mm;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700438
439 if (t->flags & _TIF_ABI_PENDING)
440 t->flags ^= (_TIF_ABI_PENDING | _TIF_32BIT);
441
David S. Miller74bf4312006-01-31 18:29:18 -0800442 mm = t->task->mm;
443 if (mm)
444 tsb_context_switch(__pa(mm->pgd),
445 mm->context.sparc64_tsb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700446
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447 set_thread_wsaved(0);
448
449 /* Turn off performance counters if on. */
450 if (test_and_clear_thread_flag(TIF_PERFCTR)) {
451 t->user_cntd0 = t->user_cntd1 = NULL;
452 t->pcr_reg = 0;
453 write_pcr(0);
454 }
455
456 /* Clear FPU register state. */
457 t->fpsaved[0] = 0;
458
459 if (get_thread_current_ds() != ASI_AIUS)
460 set_fs(USER_DS);
461
462 /* Init new signal delivery disposition. */
463 clear_thread_flag(TIF_NEWSIGNALS);
464}
465
466/* It's a bit more tricky when 64-bit tasks are involved... */
467static unsigned long clone_stackframe(unsigned long csp, unsigned long psp)
468{
469 unsigned long fp, distance, rval;
470
471 if (!(test_thread_flag(TIF_32BIT))) {
472 csp += STACK_BIAS;
473 psp += STACK_BIAS;
474 __get_user(fp, &(((struct reg_window __user *)psp)->ins[6]));
475 fp += STACK_BIAS;
476 } else
477 __get_user(fp, &(((struct reg_window32 __user *)psp)->ins[6]));
478
479 /* Now 8-byte align the stack as this is mandatory in the
480 * Sparc ABI due to how register windows work. This hides
481 * the restriction from thread libraries etc. -DaveM
482 */
483 csp &= ~7UL;
484
485 distance = fp - psp;
486 rval = (csp - distance);
487 if (copy_in_user((void __user *) rval, (void __user *) psp, distance))
488 rval = 0;
489 else if (test_thread_flag(TIF_32BIT)) {
490 if (put_user(((u32)csp),
491 &(((struct reg_window32 __user *)rval)->ins[6])))
492 rval = 0;
493 } else {
494 if (put_user(((u64)csp - STACK_BIAS),
495 &(((struct reg_window __user *)rval)->ins[6])))
496 rval = 0;
497 else
498 rval = rval - STACK_BIAS;
499 }
500
501 return rval;
502}
503
504/* Standard stuff. */
505static inline void shift_window_buffer(int first_win, int last_win,
506 struct thread_info *t)
507{
508 int i;
509
510 for (i = first_win; i < last_win; i++) {
511 t->rwbuf_stkptrs[i] = t->rwbuf_stkptrs[i+1];
512 memcpy(&t->reg_window[i], &t->reg_window[i+1],
513 sizeof(struct reg_window));
514 }
515}
516
517void synchronize_user_stack(void)
518{
519 struct thread_info *t = current_thread_info();
520 unsigned long window;
521
522 flush_user_windows();
523 if ((window = get_thread_wsaved()) != 0) {
524 int winsize = sizeof(struct reg_window);
525 int bias = 0;
526
527 if (test_thread_flag(TIF_32BIT))
528 winsize = sizeof(struct reg_window32);
529 else
530 bias = STACK_BIAS;
531
532 window -= 1;
533 do {
534 unsigned long sp = (t->rwbuf_stkptrs[window] + bias);
535 struct reg_window *rwin = &t->reg_window[window];
536
537 if (!copy_to_user((char __user *)sp, rwin, winsize)) {
538 shift_window_buffer(window, get_thread_wsaved() - 1, t);
539 set_thread_wsaved(get_thread_wsaved() - 1);
540 }
541 } while (window--);
542 }
543}
544
545void fault_in_user_windows(void)
546{
547 struct thread_info *t = current_thread_info();
548 unsigned long window;
549 int winsize = sizeof(struct reg_window);
550 int bias = 0;
551
552 if (test_thread_flag(TIF_32BIT))
553 winsize = sizeof(struct reg_window32);
554 else
555 bias = STACK_BIAS;
556
557 flush_user_windows();
558 window = get_thread_wsaved();
559
560 if (window != 0) {
561 window -= 1;
562 do {
563 unsigned long sp = (t->rwbuf_stkptrs[window] + bias);
564 struct reg_window *rwin = &t->reg_window[window];
565
566 if (copy_to_user((char __user *)sp, rwin, winsize))
567 goto barf;
568 } while (window--);
569 }
570 set_thread_wsaved(0);
571 return;
572
573barf:
574 set_thread_wsaved(window + 1);
575 do_exit(SIGILL);
576}
577
578asmlinkage long sparc_do_fork(unsigned long clone_flags,
579 unsigned long stack_start,
580 struct pt_regs *regs,
581 unsigned long stack_size)
582{
583 int __user *parent_tid_ptr, *child_tid_ptr;
584
585#ifdef CONFIG_COMPAT
586 if (test_thread_flag(TIF_32BIT)) {
587 parent_tid_ptr = compat_ptr(regs->u_regs[UREG_I2]);
588 child_tid_ptr = compat_ptr(regs->u_regs[UREG_I4]);
589 } else
590#endif
591 {
592 parent_tid_ptr = (int __user *) regs->u_regs[UREG_I2];
593 child_tid_ptr = (int __user *) regs->u_regs[UREG_I4];
594 }
595
596 return do_fork(clone_flags, stack_start,
597 regs, stack_size,
598 parent_tid_ptr, child_tid_ptr);
599}
600
601/* Copy a Sparc thread. The fork() return value conventions
602 * under SunOS are nothing short of bletcherous:
603 * Parent --> %o0 == childs pid, %o1 == 0
604 * Child --> %o0 == parents pid, %o1 == 1
605 */
606int copy_thread(int nr, unsigned long clone_flags, unsigned long sp,
607 unsigned long unused,
608 struct task_struct *p, struct pt_regs *regs)
609{
Al Viroee3eea12006-01-12 01:05:43 -0800610 struct thread_info *t = task_thread_info(p);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611 char *child_trap_frame;
612
Linus Torvalds1da177e2005-04-16 15:20:36 -0700613 /* Calculate offset to stack_frame & pt_regs */
Al Viroee3eea12006-01-12 01:05:43 -0800614 child_trap_frame = task_stack_page(p) + (THREAD_SIZE - (TRACEREG_SZ+STACKFRAME_SZ));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615 memcpy(child_trap_frame, (((struct sparc_stackf *)regs)-1), (TRACEREG_SZ+STACKFRAME_SZ));
616
617 t->flags = (t->flags & ~((0xffUL << TI_FLAG_CWP_SHIFT) | (0xffUL << TI_FLAG_CURRENT_DS_SHIFT))) |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618 (((regs->tstate + 1) & TSTATE_CWP) << TI_FLAG_CWP_SHIFT);
David S. Millerdb7d9a42005-07-24 19:36:26 -0700619 t->new_child = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700620 t->ksp = ((unsigned long) child_trap_frame) - STACK_BIAS;
621 t->kregs = (struct pt_regs *)(child_trap_frame+sizeof(struct sparc_stackf));
622 t->fpsaved[0] = 0;
623
624 if (regs->tstate & TSTATE_PRIV) {
625 /* Special case, if we are spawning a kernel thread from
626 * a userspace task (via KMOD, NFS, or similar) we must
627 * disable performance counters in the child because the
628 * address space and protection realm are changing.
629 */
630 if (t->flags & _TIF_PERFCTR) {
631 t->user_cntd0 = t->user_cntd1 = NULL;
632 t->pcr_reg = 0;
633 t->flags &= ~_TIF_PERFCTR;
634 }
635 t->kregs->u_regs[UREG_FP] = t->ksp;
636 t->flags |= ((long)ASI_P << TI_FLAG_CURRENT_DS_SHIFT);
637 flush_register_windows();
638 memcpy((void *)(t->ksp + STACK_BIAS),
639 (void *)(regs->u_regs[UREG_FP] + STACK_BIAS),
640 sizeof(struct sparc_stackf));
641 t->kregs->u_regs[UREG_G6] = (unsigned long) t;
642 t->kregs->u_regs[UREG_G4] = (unsigned long) t->task;
643 } else {
644 if (t->flags & _TIF_32BIT) {
645 sp &= 0x00000000ffffffffUL;
646 regs->u_regs[UREG_FP] &= 0x00000000ffffffffUL;
647 }
648 t->kregs->u_regs[UREG_FP] = sp;
649 t->flags |= ((long)ASI_AIUS << TI_FLAG_CURRENT_DS_SHIFT);
650 if (sp != regs->u_regs[UREG_FP]) {
651 unsigned long csp;
652
653 csp = clone_stackframe(sp, regs->u_regs[UREG_FP]);
654 if (!csp)
655 return -EFAULT;
656 t->kregs->u_regs[UREG_FP] = csp;
657 }
658 if (t->utraps)
659 t->utraps[0]++;
660 }
661
662 /* Set the return value for the child. */
663 t->kregs->u_regs[UREG_I0] = current->pid;
664 t->kregs->u_regs[UREG_I1] = 1;
665
666 /* Set the second return value for the parent. */
667 regs->u_regs[UREG_I1] = 0;
668
669 if (clone_flags & CLONE_SETTLS)
670 t->kregs->u_regs[UREG_G7] = regs->u_regs[UREG_I3];
671
672 return 0;
673}
674
675/*
676 * This is the mechanism for creating a new kernel thread.
677 *
678 * NOTE! Only a kernel-only process(ie the swapper or direct descendants
679 * who haven't done an "execve()") should use this: it will work within
680 * a system call from a "real" process, but the process memory space will
681 * not be free'd until both the parent and the child have exited.
682 */
683pid_t kernel_thread(int (*fn)(void *), void * arg, unsigned long flags)
684{
685 long retval;
686
687 /* If the parent runs before fn(arg) is called by the child,
688 * the input registers of this function can be clobbered.
689 * So we stash 'fn' and 'arg' into global registers which
690 * will not be modified by the parent.
691 */
692 __asm__ __volatile__("mov %4, %%g2\n\t" /* Save FN into global */
693 "mov %5, %%g3\n\t" /* Save ARG into global */
694 "mov %1, %%g1\n\t" /* Clone syscall nr. */
695 "mov %2, %%o0\n\t" /* Clone flags. */
696 "mov 0, %%o1\n\t" /* usp arg == 0 */
697 "t 0x6d\n\t" /* Linux/Sparc clone(). */
698 "brz,a,pn %%o1, 1f\n\t" /* Parent, just return. */
699 " mov %%o0, %0\n\t"
700 "jmpl %%g2, %%o7\n\t" /* Call the function. */
701 " mov %%g3, %%o0\n\t" /* Set arg in delay. */
702 "mov %3, %%g1\n\t"
703 "t 0x6d\n\t" /* Linux/Sparc exit(). */
704 /* Notreached by child. */
705 "1:" :
706 "=r" (retval) :
707 "i" (__NR_clone), "r" (flags | CLONE_VM | CLONE_UNTRACED),
708 "i" (__NR_exit), "r" (fn), "r" (arg) :
709 "g1", "g2", "g3", "o0", "o1", "memory", "cc");
710 return retval;
711}
712
713/*
714 * fill in the user structure for a core dump..
715 */
716void dump_thread(struct pt_regs * regs, struct user * dump)
717{
718 /* Only should be used for SunOS and ancient a.out
719 * SparcLinux binaries... Not worth implementing.
720 */
721 memset(dump, 0, sizeof(struct user));
722}
723
724typedef struct {
725 union {
726 unsigned int pr_regs[32];
727 unsigned long pr_dregs[16];
728 } pr_fr;
729 unsigned int __unused;
730 unsigned int pr_fsr;
731 unsigned char pr_qcnt;
732 unsigned char pr_q_entrysize;
733 unsigned char pr_en;
734 unsigned int pr_q[64];
735} elf_fpregset_t32;
736
737/*
738 * fill in the fpu structure for a core dump.
739 */
740int dump_fpu (struct pt_regs * regs, elf_fpregset_t * fpregs)
741{
742 unsigned long *kfpregs = current_thread_info()->fpregs;
743 unsigned long fprs = current_thread_info()->fpsaved[0];
744
745 if (test_thread_flag(TIF_32BIT)) {
746 elf_fpregset_t32 *fpregs32 = (elf_fpregset_t32 *)fpregs;
747
748 if (fprs & FPRS_DL)
749 memcpy(&fpregs32->pr_fr.pr_regs[0], kfpregs,
750 sizeof(unsigned int) * 32);
751 else
752 memset(&fpregs32->pr_fr.pr_regs[0], 0,
753 sizeof(unsigned int) * 32);
754 fpregs32->pr_qcnt = 0;
755 fpregs32->pr_q_entrysize = 8;
756 memset(&fpregs32->pr_q[0], 0,
757 (sizeof(unsigned int) * 64));
758 if (fprs & FPRS_FEF) {
759 fpregs32->pr_fsr = (unsigned int) current_thread_info()->xfsr[0];
760 fpregs32->pr_en = 1;
761 } else {
762 fpregs32->pr_fsr = 0;
763 fpregs32->pr_en = 0;
764 }
765 } else {
766 if(fprs & FPRS_DL)
767 memcpy(&fpregs->pr_regs[0], kfpregs,
768 sizeof(unsigned int) * 32);
769 else
770 memset(&fpregs->pr_regs[0], 0,
771 sizeof(unsigned int) * 32);
772 if(fprs & FPRS_DU)
773 memcpy(&fpregs->pr_regs[16], kfpregs+16,
774 sizeof(unsigned int) * 32);
775 else
776 memset(&fpregs->pr_regs[16], 0,
777 sizeof(unsigned int) * 32);
778 if(fprs & FPRS_FEF) {
779 fpregs->pr_fsr = current_thread_info()->xfsr[0];
780 fpregs->pr_gsr = current_thread_info()->gsr[0];
781 } else {
782 fpregs->pr_fsr = fpregs->pr_gsr = 0;
783 }
784 fpregs->pr_fprs = fprs;
785 }
786 return 1;
787}
788
789/*
790 * sparc_execve() executes a new program after the asm stub has set
791 * things up for us. This should basically do what I want it to.
792 */
793asmlinkage int sparc_execve(struct pt_regs *regs)
794{
795 int error, base = 0;
796 char *filename;
797
798 /* User register window flush is done by entry.S */
799
800 /* Check for indirect call. */
801 if (regs->u_regs[UREG_G1] == 0)
802 base = 1;
803
804 filename = getname((char __user *)regs->u_regs[base + UREG_I0]);
805 error = PTR_ERR(filename);
806 if (IS_ERR(filename))
807 goto out;
808 error = do_execve(filename,
809 (char __user * __user *)
810 regs->u_regs[base + UREG_I1],
811 (char __user * __user *)
812 regs->u_regs[base + UREG_I2], regs);
813 putname(filename);
814 if (!error) {
815 fprs_write(0);
816 current_thread_info()->xfsr[0] = 0;
817 current_thread_info()->fpsaved[0] = 0;
818 regs->tstate &= ~TSTATE_PEF;
819 task_lock(current);
820 current->ptrace &= ~PT_DTRACE;
821 task_unlock(current);
822 }
823out:
824 return error;
825}
826
827unsigned long get_wchan(struct task_struct *task)
828{
829 unsigned long pc, fp, bias = 0;
830 unsigned long thread_info_base;
831 struct reg_window *rw;
832 unsigned long ret = 0;
833 int count = 0;
834
835 if (!task || task == current ||
836 task->state == TASK_RUNNING)
837 goto out;
838
Al Viroee3eea12006-01-12 01:05:43 -0800839 thread_info_base = (unsigned long) task_stack_page(task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700840 bias = STACK_BIAS;
Al Virof3169642006-01-12 01:05:42 -0800841 fp = task_thread_info(task)->ksp + bias;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700842
843 do {
844 /* Bogus frame pointer? */
845 if (fp < (thread_info_base + sizeof(struct thread_info)) ||
846 fp >= (thread_info_base + THREAD_SIZE))
847 break;
848 rw = (struct reg_window *) fp;
849 pc = rw->ins[7];
850 if (!in_sched_functions(pc)) {
851 ret = pc;
852 goto out;
853 }
854 fp = rw->ins[6] + bias;
855 } while (++count < 16);
856
857out:
858 return ret;
859}