OpenCores
URL https://opencores.org/ocsvn/or1k_old/or1k_old/trunk

Subversion Repositories or1k_old

[/] [or1k_old/] [trunk/] [rc203soc/] [sw/] [uClinux/] [arch/] [i386/] [kernel/] [signal.c] - Diff between revs 1623 and 1765

Go to most recent revision | Only display areas with differences | Details | Blame | View Log

Rev 1623 Rev 1765
/*
/*
 *  linux/arch/i386/kernel/signal.c
 *  linux/arch/i386/kernel/signal.c
 *
 *
 *  Copyright (C) 1991, 1992  Linus Torvalds
 *  Copyright (C) 1991, 1992  Linus Torvalds
 */
 */
 
 
#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>
 
 
#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(int restart, unsigned long oldmask, unsigned long set)
asmlinkage int sys_sigsuspend(int restart, unsigned long oldmask, unsigned long set)
{
{
        unsigned long mask;
        unsigned long mask;
        struct pt_regs * regs = (struct pt_regs *) &restart;
        struct pt_regs * regs = (struct pt_regs *) &restart;
 
 
        mask = current->blocked;
        mask = current->blocked;
        current->blocked = set & _BLOCKABLE;
        current->blocked = set & _BLOCKABLE;
        regs->eax = -EINTR;
        regs->eax = -EINTR;
        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;
        }
        }
}
}
 
 
static inline void restore_i387_hard(struct _fpstate *buf)
static inline void restore_i387_hard(struct _fpstate *buf)
{
{
#ifdef __SMP__
#ifdef __SMP__
        if (current->flags & PF_USEDFPU) {
        if (current->flags & PF_USEDFPU) {
                stts();
                stts();
        }
        }
#else
#else
        if (current == last_task_used_math) {
        if (current == last_task_used_math) {
                last_task_used_math = NULL;
                last_task_used_math = NULL;
                stts();
                stts();
        }
        }
#endif
#endif
        current->used_math = 1;
        current->used_math = 1;
        current->flags &= ~PF_USEDFPU;
        current->flags &= ~PF_USEDFPU;
        memcpy_fromfs(&current->tss.i387.hard, buf, sizeof(*buf));
        memcpy_fromfs(&current->tss.i387.hard, buf, sizeof(*buf));
}
}
 
 
static void restore_i387(struct _fpstate *buf)
static void restore_i387(struct _fpstate *buf)
{
{
#ifndef CONFIG_MATH_EMULATION
#ifndef CONFIG_MATH_EMULATION
        restore_i387_hard(buf);
        restore_i387_hard(buf);
#else
#else
        if (hard_math) {
        if (hard_math) {
                restore_i387_hard(buf);
                restore_i387_hard(buf);
                return;
                return;
        }
        }
        restore_i387_soft(buf);
        restore_i387_soft(buf);
#endif  
#endif  
}
}
 
 
 
 
/*
/*
 * 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(unsigned long __unused)
asmlinkage int sys_sigreturn(unsigned long __unused)
{
{
#define COPY(x) regs->x = context.x
#define COPY(x) regs->x = context.x
#define COPY_SEG(x) \
#define COPY_SEG(x) \
if (   (context.x & 0xfffc)     /* not a NULL selectors */ \
if (   (context.x & 0xfffc)     /* not a NULL selectors */ \
    && (context.x & 0x4) != 0x4 /* not a LDT selector */ \
    && (context.x & 0x4) != 0x4 /* not a LDT selector */ \
    && (context.x & 3) != 3     /* not a RPL3 GDT selector */ \
    && (context.x & 3) != 3     /* not a RPL3 GDT selector */ \
   ) goto badframe; COPY(x);
   ) goto badframe; COPY(x);
#define COPY_SEG_STRICT(x) \
#define COPY_SEG_STRICT(x) \
if (!(context.x & 0xfffc) || (context.x & 3) != 3) goto badframe; COPY(x);
if (!(context.x & 0xfffc) || (context.x & 3) != 3) goto badframe; COPY(x);
        struct sigcontext_struct context;
        struct sigcontext_struct context;
        struct pt_regs * regs;
        struct pt_regs * regs;
 
 
        regs = (struct pt_regs *) &__unused;
        regs = (struct pt_regs *) &__unused;
        if (verify_area(VERIFY_READ, (void *) regs->esp, sizeof(context)))
        if (verify_area(VERIFY_READ, (void *) regs->esp, sizeof(context)))
                goto badframe;
                goto badframe;
        memcpy_fromfs(&context,(void *) regs->esp, sizeof(context));
        memcpy_fromfs(&context,(void *) regs->esp, sizeof(context));
        current->blocked = context.oldmask & _BLOCKABLE;
        current->blocked = context.oldmask & _BLOCKABLE;
        COPY_SEG(ds);
        COPY_SEG(ds);
        COPY_SEG(es);
        COPY_SEG(es);
        COPY_SEG(fs);
        COPY_SEG(fs);
        COPY_SEG(gs);
        COPY_SEG(gs);
        COPY_SEG_STRICT(ss);
        COPY_SEG_STRICT(ss);
        COPY_SEG_STRICT(cs);
        COPY_SEG_STRICT(cs);
        COPY(eip);
        COPY(eip);
        COPY(ecx); COPY(edx);
        COPY(ecx); COPY(edx);
        COPY(ebx);
        COPY(ebx);
        COPY(esp); COPY(ebp);
        COPY(esp); COPY(ebp);
        COPY(edi); COPY(esi);
        COPY(edi); COPY(esi);
        regs->eflags &= ~0x40DD5;
        regs->eflags &= ~0x40DD5;
        regs->eflags |= context.eflags & 0x40DD5;
        regs->eflags |= context.eflags & 0x40DD5;
        regs->orig_eax = -1;            /* disable syscall checks */
        regs->orig_eax = -1;            /* disable syscall checks */
        if (context.fpstate) {
        if (context.fpstate) {
                struct _fpstate * buf = context.fpstate;
                struct _fpstate * buf = context.fpstate;
                if (verify_area(VERIFY_READ, buf, sizeof(*buf)))
                if (verify_area(VERIFY_READ, buf, sizeof(*buf)))
                        goto badframe;
                        goto badframe;
                restore_i387(buf);
                restore_i387(buf);
        }
        }
        return context.eax;
        return context.eax;
badframe:
badframe:
        do_exit(SIGSEGV);
        do_exit(SIGSEGV);
}
}
 
 
static inline struct _fpstate * save_i387_hard(struct _fpstate * buf)
static inline struct _fpstate * save_i387_hard(struct _fpstate * buf)
{
{
#ifdef __SMP__
#ifdef __SMP__
        if (current->flags & PF_USEDFPU) {
        if (current->flags & PF_USEDFPU) {
                __asm__ __volatile__("fnsave %0":"=m" (current->tss.i387.hard));
                __asm__ __volatile__("fnsave %0":"=m" (current->tss.i387.hard));
                stts();
                stts();
                current->flags &= ~PF_USEDFPU;
                current->flags &= ~PF_USEDFPU;
        }
        }
#else
#else
        if (current == last_task_used_math) {
        if (current == last_task_used_math) {
                __asm__ __volatile__("fnsave %0":"=m" (current->tss.i387.hard));
                __asm__ __volatile__("fnsave %0":"=m" (current->tss.i387.hard));
                last_task_used_math = NULL;
                last_task_used_math = NULL;
                __asm__ __volatile__("fwait");  /* not needed on 486+ */
                __asm__ __volatile__("fwait");  /* not needed on 486+ */
                stts();
                stts();
        }
        }
#endif
#endif
        current->tss.i387.hard.status = current->tss.i387.hard.swd;
        current->tss.i387.hard.status = current->tss.i387.hard.swd;
        memcpy_tofs(buf, &current->tss.i387.hard, sizeof(*buf));
        memcpy_tofs(buf, &current->tss.i387.hard, sizeof(*buf));
        current->used_math = 0;
        current->used_math = 0;
        return buf;
        return buf;
}
}
 
 
static struct _fpstate * save_i387(struct _fpstate * buf)
static struct _fpstate * save_i387(struct _fpstate * buf)
{
{
        if (!current->used_math)
        if (!current->used_math)
                return NULL;
                return NULL;
 
 
#ifndef CONFIG_MATH_EMULATION
#ifndef CONFIG_MATH_EMULATION
        return save_i387_hard(buf);
        return save_i387_hard(buf);
#else
#else
        if (hard_math)
        if (hard_math)
                return save_i387_hard(buf);
                return save_i387_hard(buf);
        return save_i387_soft(buf);
        return save_i387_soft(buf);
#endif
#endif
}
}
 
 
/*
/*
 * Set up a signal frame... Make the stack look the way iBCS2 expects
 * Set up a signal frame... Make the stack look the way iBCS2 expects
 * it to look.
 * it to look.
 */
 */
static void setup_frame(struct sigaction * sa,
static void setup_frame(struct sigaction * sa,
        struct pt_regs * regs, int signr,
        struct pt_regs * regs, int signr,
        unsigned long oldmask)
        unsigned long oldmask)
{
{
        unsigned long * frame;
        unsigned long * frame;
 
 
        frame = (unsigned long *) regs->esp;
        frame = (unsigned long *) regs->esp;
        if (regs->ss != USER_DS && sa->sa_restorer)
        if (regs->ss != USER_DS && sa->sa_restorer)
                frame = (unsigned long *) sa->sa_restorer;
                frame = (unsigned long *) sa->sa_restorer;
        frame -= 64;
        frame -= 64;
        if (verify_area(VERIFY_WRITE,frame,64*4))
        if (verify_area(VERIFY_WRITE,frame,64*4))
                do_exit(SIGSEGV);
                do_exit(SIGSEGV);
 
 
/* set up the "normal" stack seen by the signal handler (iBCS2) */
/* set up the "normal" stack seen by the signal handler (iBCS2) */
#define __CODE ((unsigned long)(frame+24))
#define __CODE ((unsigned long)(frame+24))
#define CODE(x) ((unsigned long *) ((x)+__CODE))
#define CODE(x) ((unsigned long *) ((x)+__CODE))
        put_user(__CODE,frame);
        put_user(__CODE,frame);
        if (current->exec_domain && current->exec_domain->signal_invmap)
        if (current->exec_domain && current->exec_domain->signal_invmap)
                put_user(current->exec_domain->signal_invmap[signr], frame+1);
                put_user(current->exec_domain->signal_invmap[signr], frame+1);
        else
        else
                put_user(signr, frame+1);
                put_user(signr, frame+1);
        put_user(regs->gs, frame+2);
        put_user(regs->gs, frame+2);
        put_user(regs->fs, frame+3);
        put_user(regs->fs, frame+3);
        put_user(regs->es, frame+4);
        put_user(regs->es, frame+4);
        put_user(regs->ds, frame+5);
        put_user(regs->ds, frame+5);
        put_user(regs->edi, frame+6);
        put_user(regs->edi, frame+6);
        put_user(regs->esi, frame+7);
        put_user(regs->esi, frame+7);
        put_user(regs->ebp, frame+8);
        put_user(regs->ebp, frame+8);
        put_user(regs->esp, frame+9);
        put_user(regs->esp, frame+9);
        put_user(regs->ebx, frame+10);
        put_user(regs->ebx, frame+10);
        put_user(regs->edx, frame+11);
        put_user(regs->edx, frame+11);
        put_user(regs->ecx, frame+12);
        put_user(regs->ecx, frame+12);
        put_user(regs->eax, frame+13);
        put_user(regs->eax, frame+13);
        put_user(current->tss.trap_no, frame+14);
        put_user(current->tss.trap_no, frame+14);
        put_user(current->tss.error_code, frame+15);
        put_user(current->tss.error_code, frame+15);
        put_user(regs->eip, frame+16);
        put_user(regs->eip, frame+16);
        put_user(regs->cs, frame+17);
        put_user(regs->cs, frame+17);
        put_user(regs->eflags, frame+18);
        put_user(regs->eflags, frame+18);
        put_user(regs->esp, frame+19);
        put_user(regs->esp, frame+19);
        put_user(regs->ss, frame+20);
        put_user(regs->ss, frame+20);
        put_user(save_i387((struct _fpstate *)(frame+32)),frame+21);
        put_user(save_i387((struct _fpstate *)(frame+32)),frame+21);
/* non-iBCS2 extensions.. */
/* non-iBCS2 extensions.. */
        put_user(oldmask, frame+22);
        put_user(oldmask, frame+22);
        put_user(current->tss.cr2, frame+23);
        put_user(current->tss.cr2, frame+23);
/* set up the return code... */
/* set up the return code... */
        put_user(0x0000b858, CODE(0));   /* popl %eax ; movl $,%eax */
        put_user(0x0000b858, CODE(0));   /* popl %eax ; movl $,%eax */
        put_user(0x80cd0000, CODE(4));  /* int $0x80 */
        put_user(0x80cd0000, CODE(4));  /* int $0x80 */
        put_user(__NR_sigreturn, CODE(2));
        put_user(__NR_sigreturn, CODE(2));
#undef __CODE
#undef __CODE
#undef CODE
#undef CODE
 
 
        /* Set up registers for signal handler */
        /* Set up registers for signal handler */
        regs->esp = (unsigned long) frame;
        regs->esp = (unsigned long) frame;
        regs->eip = (unsigned long) sa->sa_handler;
        regs->eip = (unsigned long) sa->sa_handler;
        regs->cs = USER_CS; regs->ss = USER_DS;
        regs->cs = USER_CS; regs->ss = USER_DS;
        regs->ds = USER_DS; regs->es = USER_DS;
        regs->ds = USER_DS; regs->es = USER_DS;
        regs->gs = USER_DS; regs->fs = USER_DS;
        regs->gs = USER_DS; regs->fs = USER_DS;
        regs->eflags &= ~TF_MASK;
        regs->eflags &= ~TF_MASK;
}
}
 
 
/*
/*
 * OK, we're invoking a handler
 * OK, we're invoking a handler
 */
 */
static void handle_signal(unsigned long signr, struct sigaction *sa,
static void handle_signal(unsigned long signr, struct sigaction *sa,
        unsigned long oldmask, struct pt_regs * regs)
        unsigned long oldmask, struct pt_regs * regs)
{
{
        /* are we from a system call? */
        /* are we from a system call? */
        if (regs->orig_eax >= 0) {
        if (regs->orig_eax >= 0) {
                /* If so, check system call restarting.. */
                /* If so, check system call restarting.. */
                switch (regs->eax) {
                switch (regs->eax) {
                        case -ERESTARTNOHAND:
                        case -ERESTARTNOHAND:
                                regs->eax = -EINTR;
                                regs->eax = -EINTR;
                                break;
                                break;
 
 
                        case -ERESTARTSYS:
                        case -ERESTARTSYS:
                                if (!(sa->sa_flags & SA_RESTART)) {
                                if (!(sa->sa_flags & SA_RESTART)) {
                                        regs->eax = -EINTR;
                                        regs->eax = -EINTR;
                                        break;
                                        break;
                                }
                                }
                        /* fallthrough */
                        /* fallthrough */
                        case -ERESTARTNOINTR:
                        case -ERESTARTNOINTR:
                                regs->eax = regs->orig_eax;
                                regs->eax = regs->orig_eax;
                                regs->eip -= 2;
                                regs->eip -= 2;
                }
                }
        }
        }
 
 
        /* set up the stack frame */
        /* set up the stack frame */
        setup_frame(sa, regs, signr, oldmask);
        setup_frame(sa, regs, signr, oldmask);
 
 
        if (sa->sa_flags & SA_ONESHOT)
        if (sa->sa_flags & SA_ONESHOT)
                sa->sa_handler = NULL;
                sa->sa_handler = NULL;
        if (!(sa->sa_flags & SA_NOMASK))
        if (!(sa->sa_flags & SA_NOMASK))
                current->blocked |= (sa->sa_mask | _S(signr)) & _BLOCKABLE;
                current->blocked |= (sa->sa_mask | _S(signr)) & _BLOCKABLE;
}
}
 
 
/*
/*
 * 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 signr;
        unsigned long signr;
        struct sigaction * sa;
        struct sigaction * sa;
 
 
        while ((signr = current->signal & mask)) {
        while ((signr = current->signal & mask)) {
                /*
                /*
                 *      This stops gcc flipping out. Otherwise the assembler
                 *      This stops gcc flipping out. Otherwise the assembler
                 *      including volatiles for the inline function to get
                 *      including volatiles for the inline function to get
                 *      current combined with this gets it confused.
                 *      current combined with this gets it confused.
                 */
                 */
                struct task_struct *t=current;
                struct task_struct *t=current;
                __asm__("bsf %3,%1\n\t"
                __asm__("bsf %3,%1\n\t"
                        "btrl %1,%0"
                        "btrl %1,%0"
                        :"=m" (t->signal),"=r" (signr)
                        :"=m" (t->signal),"=r" (signr)
                        :"0" (t->signal), "1" (signr));
                        :"0" (t->signal), "1" (signr));
                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 SIGTSTP: case SIGTTIN: case SIGTTOU:
                        case SIGTSTP: case SIGTTIN: case SIGTTOU:
                                if (is_orphaned_pgrp(current->pgrp))
                                if (is_orphaned_pgrp(current->pgrp))
                                        continue;
                                        continue;
                        case SIGSTOP:
                        case SIGSTOP:
                                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 SIGABRT: case SIGFPE: case SIGSEGV:
                        case SIGABRT: 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);
                                current->flags |= PF_SIGNALED;
                                current->flags |= PF_SIGNALED;
                                do_exit(signr);
                                do_exit(signr);
                        }
                        }
                }
                }
                handle_signal(signr, sa, oldmask, regs);
                handle_signal(signr, sa, oldmask, regs);
                return 1;
                return 1;
        }
        }
 
 
        /* Did we come from a system call? */
        /* Did we come from a system call? */
        if (regs->orig_eax >= 0) {
        if (regs->orig_eax >= 0) {
                /* Restart the system call - no handlers present */
                /* Restart the system call - no handlers present */
                if (regs->eax == -ERESTARTNOHAND ||
                if (regs->eax == -ERESTARTNOHAND ||
                    regs->eax == -ERESTARTSYS ||
                    regs->eax == -ERESTARTSYS ||
                    regs->eax == -ERESTARTNOINTR) {
                    regs->eax == -ERESTARTNOINTR) {
                        regs->eax = regs->orig_eax;
                        regs->eax = regs->orig_eax;
                        regs->eip -= 2;
                        regs->eip -= 2;
                }
                }
        }
        }
        return 0;
        return 0;
}
}
 
 

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.