/*
|
/*
|
* linux/arch/ppc/kernel/signal.c
|
* linux/arch/ppc/kernel/signal.c
|
*
|
*
|
* Copyright (C) 1991, 1992 Linus Torvalds
|
* Copyright (C) 1991, 1992 Linus Torvalds
|
* Adapted for PowerPC by Gary Thomas
|
* Adapted for PowerPC by Gary Thomas
|
*/
|
*/
|
|
|
#include <linux/config.h>
|
#include <linux/config.h>
|
|
|
#include <linux/sched.h>
|
#include <linux/sched.h>
|
#include <linux/mm.h>
|
#include <linux/mm.h>
|
#include <linux/kernel.h>
|
#include <linux/kernel.h>
|
#include <linux/signal.h>
|
#include <linux/signal.h>
|
#include <linux/errno.h>
|
#include <linux/errno.h>
|
#include <linux/wait.h>
|
#include <linux/wait.h>
|
#include <linux/ptrace.h>
|
#include <linux/ptrace.h>
|
#include <linux/unistd.h>
|
#include <linux/unistd.h>
|
|
|
#include <asm/segment.h>
|
#include <asm/segment.h>
|
#include <asm/pgtable.h>
|
#include <asm/pgtable.h>
|
#include <asm/traps.h>
|
#include <asm/traps.h>
|
|
|
/*
|
/*
|
#define DEBUG
|
#define DEBUG
|
*/
|
*/
|
|
|
#define offsetof(type, member) ((size_t)(&((type *)0)->member))
|
#define offsetof(type, member) ((size_t)(&((type *)0)->member))
|
|
|
#define _S(nr) (1<<((nr)-1))
|
#define _S(nr) (1<<((nr)-1))
|
|
|
#define _BLOCKABLE (~(_S(SIGKILL) | _S(SIGSTOP)))
|
#define _BLOCKABLE (~(_S(SIGKILL) | _S(SIGSTOP)))
|
|
|
asmlinkage int sys_waitpid(pid_t pid,unsigned long * stat_addr, int options);
|
asmlinkage int sys_waitpid(pid_t pid,unsigned long * stat_addr, int options);
|
asmlinkage int do_signal(unsigned long oldmask, struct pt_regs *regs);
|
asmlinkage int do_signal(unsigned long oldmask, struct pt_regs *regs);
|
|
|
/*
|
/*
|
* atomically swap in the new signal mask, and wait for a signal.
|
* atomically swap in the new signal mask, and wait for a signal.
|
*/
|
*/
|
asmlinkage int sys_sigsuspend(unsigned long set, int p2, int p3, int p4, int p6, int p7, struct pt_regs *regs)
|
asmlinkage int sys_sigsuspend(unsigned long set, int p2, int p3, int p4, int p6, int p7, struct pt_regs *regs)
|
{
|
{
|
unsigned long mask;
|
unsigned long mask;
|
|
|
mask = current->blocked;
|
mask = current->blocked;
|
current->blocked = set & _BLOCKABLE;
|
current->blocked = set & _BLOCKABLE;
|
regs->gprs[1] = -EINTR;
|
regs->gprs[1] = -EINTR;
|
#if 0
|
#if 0
|
printk("Task: %x[%d] - SIGSUSPEND at %x, Mask: %x\n", current, current->pid, regs->nip,
|
printk("Task: %x[%d] - SIGSUSPEND at %x, Mask: %x\n", current, current->pid, regs->nip,
|
set);
|
set);
|
#endif
|
#endif
|
while (1) {
|
while (1) {
|
current->state = TASK_INTERRUPTIBLE;
|
current->state = TASK_INTERRUPTIBLE;
|
schedule();
|
schedule();
|
if (do_signal(mask,regs))
|
if (do_signal(mask,regs))
|
return -EINTR;
|
return -EINTR;
|
}
|
}
|
}
|
}
|
|
|
/*
|
/*
|
* This sets regs->esp even though we don't actually use sigstacks yet..
|
* This sets regs->esp even though we don't actually use sigstacks yet..
|
*/
|
*/
|
asmlinkage int sys_sigreturn(struct pt_regs *regs)
|
asmlinkage int sys_sigreturn(struct pt_regs *regs)
|
{
|
{
|
struct sigcontext_struct *sc;
|
struct sigcontext_struct *sc;
|
struct pt_regs *int_regs;
|
struct pt_regs *int_regs;
|
int signo;
|
int signo;
|
sc = (struct sigcontext_struct *)regs->sp;
|
sc = (struct sigcontext_struct *)regs->sp;
|
current->blocked = sc->oldmask & _BLOCKABLE;
|
current->blocked = sc->oldmask & _BLOCKABLE;
|
int_regs = sc->regs;
|
int_regs = sc->regs;
|
signo = sc->signal;
|
signo = sc->signal;
|
sc++; /* Pop signal 'context' */
|
sc++; /* Pop signal 'context' */
|
if (sc == (struct sigcontext_struct *)(int_regs))
|
if (sc == (struct sigcontext_struct *)(int_regs))
|
{ /* Last stacked signal */
|
{ /* Last stacked signal */
|
int i;
|
int i;
|
#if 1
|
#if 1
|
memcpy(regs, int_regs, sizeof(*regs));
|
memcpy(regs, int_regs, sizeof(*regs));
|
#else
|
#else
|
/* Don't mess up 'my' stack frame */
|
/* Don't mess up 'my' stack frame */
|
for(i = 0; i < 30; i++)
|
for(i = 0; i < 30; i++)
|
if(i != 7)
|
if(i != 7)
|
regs->gprs[i] = int_regs->gprs[i];
|
regs->gprs[i] = int_regs->gprs[i];
|
regs->sp = int_regs->sp;
|
regs->sp = int_regs->sp;
|
#endif
|
#endif
|
if ((int)regs->orig_gpr3 >= 0 &&
|
if ((int)regs->orig_gpr3 >= 0 &&
|
((int)regs->result == -ERESTARTNOHAND ||
|
((int)regs->result == -ERESTARTNOHAND ||
|
(int)regs->result == -ERESTARTSYS ||
|
(int)regs->result == -ERESTARTSYS ||
|
(int)regs->result == -ERESTARTNOINTR))
|
(int)regs->result == -ERESTARTNOINTR))
|
{
|
{
|
regs->gprs[1] = regs->orig_gpr3;
|
regs->gprs[1] = regs->orig_gpr3;
|
regs->pc -= 8; /* Back up & retry system call */
|
regs->pc -= 8; /* Back up & retry system call */
|
regs->result = 0;
|
regs->result = 0;
|
}
|
}
|
return (regs->result);
|
return (regs->result);
|
} else
|
} else
|
{ /* More signals to go */
|
{ /* More signals to go */
|
regs->sp = (unsigned long)sc;
|
regs->sp = (unsigned long)sc;
|
regs->gprs[1] = sc->signal; /* r3 */
|
regs->gprs[1] = sc->signal; /* r3 */
|
regs->gprs[2] = (unsigned long)sc->regs; /* r4 */
|
regs->gprs[2] = (unsigned long)sc->regs; /* r4 */
|
regs->gprs[7] = (unsigned long)((sc->regs)+1); /* r9 - link register */
|
regs->gprs[7] = (unsigned long)((sc->regs)+1); /* r9 - link register */
|
regs->pc = sc->handler;
|
regs->pc = sc->handler;
|
return (sc->signal);
|
return (sc->signal);
|
}
|
}
|
}
|
}
|
|
|
/*
|
/*
|
* Note that 'init' is a special process: it doesn't get signals it doesn't
|
* Note that 'init' is a special process: it doesn't get signals it doesn't
|
* want to handle. Thus you cannot kill init even with a SIGKILL even by
|
* want to handle. Thus you cannot kill init even with a SIGKILL even by
|
* mistake.
|
* mistake.
|
*
|
*
|
* Note that we go through the signals twice: once to check the signals that
|
* Note that we go through the signals twice: once to check the signals that
|
* the kernel can handle, and then we build all the user-level signal handling
|
* the kernel can handle, and then we build all the user-level signal handling
|
* stack-frames in one go after that.
|
* stack-frames in one go after that.
|
*/
|
*/
|
asmlinkage int do_signal(unsigned long oldmask, struct pt_regs * regs)
|
asmlinkage int do_signal(unsigned long oldmask, struct pt_regs * regs)
|
{
|
{
|
unsigned long mask = ~current->blocked;
|
unsigned long mask = ~current->blocked;
|
unsigned long handler_signal = 0;
|
unsigned long handler_signal = 0;
|
unsigned long *frame = NULL;
|
unsigned long *frame = NULL;
|
unsigned long *trampoline;
|
unsigned long *trampoline;
|
unsigned long *regs_ptr;
|
unsigned long *regs_ptr;
|
unsigned long nip = 0;
|
unsigned long nip = 0;
|
unsigned long signr;
|
unsigned long signr;
|
int bitno;
|
int bitno;
|
struct sigcontext_struct *sc;
|
struct sigcontext_struct *sc;
|
struct sigaction * sa;
|
struct sigaction * sa;
|
unsigned long flags;
|
unsigned long flags;
|
|
|
save_flags(flags);
|
save_flags(flags);
|
cli();
|
cli();
|
|
|
while ((signr = current->signal & mask)) {
|
while ((signr = current->signal & mask)) {
|
#if 0
|
#if 0
|
signr = ffz(~signr); /* Compute bit # */
|
signr = ffz(~signr); /* Compute bit # */
|
#else
|
#else
|
for (bitno = 0; bitno < 32; bitno++)
|
for (bitno = 0; bitno < 32; bitno++)
|
{
|
{
|
if (signr & (1<<bitno)) break;
|
if (signr & (1<<bitno)) break;
|
}
|
}
|
signr = bitno;
|
signr = bitno;
|
#endif
|
#endif
|
current->signal &= ~(1<<signr); /* Clear bit */
|
current->signal &= ~(1<<signr); /* Clear bit */
|
sa = current->sig->action + signr;
|
sa = current->sig->action + signr;
|
signr++;
|
signr++;
|
if ((current->flags & PF_PTRACED) && signr != SIGKILL) {
|
if ((current->flags & PF_PTRACED) && signr != SIGKILL) {
|
current->exit_code = signr;
|
current->exit_code = signr;
|
current->state = TASK_STOPPED;
|
current->state = TASK_STOPPED;
|
notify_parent(current, SIGCHLD);
|
notify_parent(current, SIGCHLD);
|
schedule();
|
schedule();
|
if (!(signr = current->exit_code))
|
if (!(signr = current->exit_code))
|
continue;
|
continue;
|
current->exit_code = 0;
|
current->exit_code = 0;
|
if (signr == SIGSTOP)
|
if (signr == SIGSTOP)
|
continue;
|
continue;
|
if (_S(signr) & current->blocked) {
|
if (_S(signr) & current->blocked) {
|
current->signal |= _S(signr);
|
current->signal |= _S(signr);
|
continue;
|
continue;
|
}
|
}
|
sa = current->sig->action + signr - 1;
|
sa = current->sig->action + signr - 1;
|
}
|
}
|
if (sa->sa_handler == SIG_IGN) {
|
if (sa->sa_handler == SIG_IGN) {
|
if (signr != SIGCHLD)
|
if (signr != SIGCHLD)
|
continue;
|
continue;
|
/* check for SIGCHLD: it's special */
|
/* check for SIGCHLD: it's special */
|
while (sys_waitpid(-1,NULL,WNOHANG) > 0)
|
while (sys_waitpid(-1,NULL,WNOHANG) > 0)
|
/* nothing */;
|
/* nothing */;
|
continue;
|
continue;
|
}
|
}
|
if (sa->sa_handler == SIG_DFL) {
|
if (sa->sa_handler == SIG_DFL) {
|
if (current->pid == 1)
|
if (current->pid == 1)
|
continue;
|
continue;
|
switch (signr) {
|
switch (signr) {
|
case SIGCONT: case SIGCHLD: case SIGWINCH:
|
case SIGCONT: case SIGCHLD: case SIGWINCH:
|
continue;
|
continue;
|
|
|
case SIGSTOP: case SIGTSTP: case SIGTTIN: case SIGTTOU:
|
case SIGSTOP: case SIGTSTP: case SIGTTIN: case SIGTTOU:
|
if (current->flags & PF_PTRACED)
|
if (current->flags & PF_PTRACED)
|
continue;
|
continue;
|
current->state = TASK_STOPPED;
|
current->state = TASK_STOPPED;
|
current->exit_code = signr;
|
current->exit_code = signr;
|
if (!(current->p_pptr->sig->action[SIGCHLD-1].sa_flags &
|
if (!(current->p_pptr->sig->action[SIGCHLD-1].sa_flags &
|
SA_NOCLDSTOP))
|
SA_NOCLDSTOP))
|
notify_parent(current, SIGCHLD);
|
notify_parent(current, SIGCHLD);
|
schedule();
|
schedule();
|
continue;
|
continue;
|
|
|
case SIGQUIT: case SIGILL: case SIGTRAP:
|
case SIGQUIT: case SIGILL: case SIGTRAP:
|
case SIGIOT: case SIGFPE: case SIGSEGV:
|
case SIGIOT: case SIGFPE: case SIGSEGV:
|
if (current->binfmt && current->binfmt->core_dump) {
|
if (current->binfmt && current->binfmt->core_dump) {
|
if (current->binfmt->core_dump(signr, regs))
|
if (current->binfmt->core_dump(signr, regs))
|
signr |= 0x80;
|
signr |= 0x80;
|
}
|
}
|
/* fall through */
|
/* fall through */
|
default:
|
default:
|
current->signal |= _S(signr & 0x7f);
|
current->signal |= _S(signr & 0x7f);
|
do_exit(signr);
|
do_exit(signr);
|
}
|
}
|
}
|
}
|
/*
|
/*
|
* OK, we're invoking a handler
|
* OK, we're invoking a handler
|
*/
|
*/
|
if ((int)regs->orig_gpr3 >= 0) {
|
if ((int)regs->orig_gpr3 >= 0) {
|
if ((int)regs->result == -ERESTARTNOHAND ||
|
if ((int)regs->result == -ERESTARTNOHAND ||
|
((int)regs->result == -ERESTARTSYS && !(sa->sa_flags & SA_RESTART)))
|
((int)regs->result == -ERESTARTSYS && !(sa->sa_flags & SA_RESTART)))
|
(int)regs->result = -EINTR;
|
(int)regs->result = -EINTR;
|
}
|
}
|
handler_signal |= 1 << (signr-1);
|
handler_signal |= 1 << (signr-1);
|
mask &= ~sa->sa_mask;
|
mask &= ~sa->sa_mask;
|
}
|
}
|
if (!handler_signal) /* no handler will be called - return 0 */
|
if (!handler_signal) /* no handler will be called - return 0 */
|
{
|
{
|
restore_flags(flags);
|
restore_flags(flags);
|
return 0;
|
return 0;
|
}
|
}
|
nip = regs->pc;
|
nip = regs->pc;
|
frame = (unsigned long *) regs->sp;
|
frame = (unsigned long *) regs->sp;
|
/* Build trampoline code on stack */
|
/* Build trampoline code on stack */
|
frame -= 3;
|
frame -= 3;
|
trampoline = frame;
|
trampoline = frame;
|
trampoline[0] = 0x9d607777; /* l.addi r11,r0,0x7777 */
|
trampoline[0] = 0x9d607777; /* l.addi r11,r0,0x7777 */
|
trampoline[1] = 0x20000001; /* l.sys 1 */
|
trampoline[1] = 0x20000001; /* l.sys 1 */
|
trampoline[2] = 0x15000000; /* l.nop 0 */
|
trampoline[2] = 0x15000000; /* l.nop 0 */
|
frame -= sizeof(*regs) / sizeof(long);
|
frame -= sizeof(*regs) / sizeof(long);
|
regs_ptr = frame;
|
regs_ptr = frame;
|
memcpy(regs_ptr, regs, sizeof(*regs));
|
memcpy(regs_ptr, regs, sizeof(*regs));
|
signr = 1;
|
signr = 1;
|
sa = current->sig->action;
|
sa = current->sig->action;
|
for (mask = 1 ; mask ; sa++,signr++,mask += mask) {
|
for (mask = 1 ; mask ; sa++,signr++,mask += mask) {
|
if (mask > handler_signal)
|
if (mask > handler_signal)
|
break;
|
break;
|
if (!(mask & handler_signal))
|
if (!(mask & handler_signal))
|
continue;
|
continue;
|
frame -= sizeof(struct sigcontext_struct) / sizeof(long);
|
frame -= sizeof(struct sigcontext_struct) / sizeof(long);
|
sc = (struct sigcontext_struct *)frame;
|
sc = (struct sigcontext_struct *)frame;
|
nip = (unsigned long) sa->sa_handler;
|
nip = (unsigned long) sa->sa_handler;
|
#if 0 /* Old compiler */
|
#if 0 /* Old compiler */
|
nip = *(unsigned long *)nip;
|
nip = *(unsigned long *)nip;
|
#endif
|
#endif
|
if (sa->sa_flags & SA_ONESHOT)
|
if (sa->sa_flags & SA_ONESHOT)
|
sa->sa_handler = NULL;
|
sa->sa_handler = NULL;
|
sc->handler = nip;
|
sc->handler = nip;
|
sc->oldmask = current->blocked;
|
sc->oldmask = current->blocked;
|
sc->regs = (struct pt_regs *)regs_ptr;
|
sc->regs = (struct pt_regs *)regs_ptr;
|
sc->signal = signr;
|
sc->signal = signr;
|
current->blocked |= sa->sa_mask;
|
current->blocked |= sa->sa_mask;
|
regs->gprs[1] = signr; /* r3 = signr */
|
regs->gprs[1] = signr; /* r3 = signr */
|
regs->gprs[2] = (unsigned long)regs_ptr; /* r4 = regs_ptr */
|
regs->gprs[2] = (unsigned long)regs_ptr; /* r4 = regs_ptr */
|
}
|
}
|
regs->gprs[7] = (unsigned long)trampoline; /* r9 = trampoline (r9 is link register) */
|
regs->gprs[7] = (unsigned long)trampoline; /* r9 = trampoline (r9 is link register) */
|
regs->pc = nip;
|
regs->pc = nip;
|
regs->sp = (unsigned long)sc;
|
regs->sp = (unsigned long)sc;
|
/* The DATA cache must be flushed here to insure coherency */
|
/* The DATA cache must be flushed here to insure coherency */
|
/* between the DATA & INSTRUCTION caches. Since we just */
|
/* between the DATA & INSTRUCTION caches. Since we just */
|
/* created an instruction stream using the DATA [cache] space */
|
/* created an instruction stream using the DATA [cache] space */
|
/* and since the instruction cache will not look in the DATA */
|
/* and since the instruction cache will not look in the DATA */
|
/* cache for new data, we have to force the data to go on to */
|
/* cache for new data, we have to force the data to go on to */
|
/* memory and flush the instruction cache to force it to look */
|
/* memory and flush the instruction cache to force it to look */
|
/* there. The following function performs this magic */
|
/* there. The following function performs this magic */
|
#if ICACHE
|
#if ICACHE
|
ic_invalidate();
|
ic_invalidate();
|
#endif
|
#endif
|
restore_flags(flags);
|
restore_flags(flags);
|
return 1;
|
return 1;
|
}
|
}
|
|
|