longjmp.c revision 1.2 1 1.2 martin /* $NetBSD: longjmp.c,v 1.2 2008/04/28 20:22:57 martin Exp $ */
2 1.1 christos
3 1.1 christos /*-
4 1.1 christos * Copyright (c) 2003 The NetBSD Foundation, Inc.
5 1.1 christos * All rights reserved.
6 1.1 christos *
7 1.1 christos * This code is derived from software contributed to The NetBSD Foundation
8 1.1 christos * by Christian Limpach.
9 1.1 christos *
10 1.1 christos * Redistribution and use in source and binary forms, with or without
11 1.1 christos * modification, are permitted provided that the following conditions
12 1.1 christos * are met:
13 1.1 christos * 1. Redistributions of source code must retain the above copyright
14 1.1 christos * notice, this list of conditions and the following disclaimer.
15 1.1 christos * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 christos * notice, this list of conditions and the following disclaimer in the
17 1.1 christos * documentation and/or other materials provided with the distribution.
18 1.1 christos *
19 1.1 christos * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 christos * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 christos * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 christos * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 christos * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 christos * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 christos * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 christos * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 christos * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 christos * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 christos * POSSIBILITY OF SUCH DAMAGE.
30 1.1 christos */
31 1.1 christos
32 1.1 christos #include "namespace.h"
33 1.1 christos #include <sys/types.h>
34 1.1 christos #include <ucontext.h>
35 1.1 christos #include <signal.h>
36 1.1 christos #include <stdlib.h>
37 1.1 christos #include <string.h>
38 1.1 christos #include <stdio.h>
39 1.1 christos
40 1.1 christos #define __LIBC12_SOURCE__
41 1.1 christos #include <setjmp.h>
42 1.1 christos #include <compat/include/setjmp.h>
43 1.1 christos
44 1.1 christos typedef struct {
45 1.1 christos __greg_t __glob[5];
46 1.1 christos } __jmp_buf_regs_t;
47 1.1 christos
48 1.1 christos void
49 1.1 christos __longjmp14(jmp_buf env, int val)
50 1.1 christos {
51 1.1 christos struct sigcontext *sc = (void *)env;
52 1.1 christos __jmp_buf_regs_t *r = (void *)&sc[1];
53 1.1 christos ucontext_t uc;
54 1.1 christos
55 1.1 christos /* Ensure non-zero SP */
56 1.1 christos if (sc->sc_sp == 0)
57 1.1 christos goto err;
58 1.1 christos
59 1.1 christos /*
60 1.1 christos * Set _UC_CPU. No FPU data saved, so we can't restore
61 1.1 christos * that. Set _UC_{SET,CLR}STACK according to SS_ONSTACK
62 1.1 christos */
63 1.1 christos memset(&uc, 0, sizeof(uc));
64 1.1 christos uc.uc_flags = _UC_CPU | (sc->sc_onstack ? _UC_SETSTACK : _UC_CLRSTACK);
65 1.1 christos
66 1.1 christos /*
67 1.1 christos * Set the signal mask - this is a weak symbol, so don't use
68 1.1 christos * _UC_SIGMASK in the mcontext, libpthread might override sigprocmask.
69 1.1 christos */
70 1.1 christos sigprocmask(SIG_SETMASK, &sc->sc_mask, NULL);
71 1.1 christos
72 1.1 christos /* Fill other registers */
73 1.1 christos uc.uc_mcontext.__gregs[_REG_CCR] = sc->sc_tstate;
74 1.1 christos uc.uc_mcontext.__gregs[_REG_PC] = sc->sc_pc;
75 1.1 christos uc.uc_mcontext.__gregs[_REG_nPC] = sc->sc_npc;
76 1.1 christos uc.uc_mcontext.__gregs[_REG_G1] = sc->sc_g1;
77 1.1 christos uc.uc_mcontext.__gregs[_REG_G2] = sc->sc_o0;
78 1.1 christos uc.uc_mcontext.__gregs[_REG_G3] = r->__glob[0];
79 1.1 christos uc.uc_mcontext.__gregs[_REG_G4] = r->__glob[1];
80 1.1 christos uc.uc_mcontext.__gregs[_REG_G5] = r->__glob[2];
81 1.1 christos uc.uc_mcontext.__gregs[_REG_G6] = r->__glob[3];
82 1.1 christos uc.uc_mcontext.__gregs[_REG_G7] = r->__glob[4];
83 1.1 christos uc.uc_mcontext.__gregs[_REG_O6] = sc->sc_sp;
84 1.1 christos
85 1.1 christos /* Make return value non-zero */
86 1.1 christos if (val == 0)
87 1.1 christos val = 1;
88 1.1 christos
89 1.1 christos /* Save return value in context */
90 1.1 christos uc.uc_mcontext.__gregs[_REG_O0] = val;
91 1.1 christos
92 1.1 christos setcontext(&uc);
93 1.1 christos
94 1.1 christos err:
95 1.1 christos longjmperror();
96 1.1 christos abort();
97 1.1 christos /* NOTREACHED */
98 1.1 christos }
99