longjmp.c revision 1.6 1 1.6 martin /* $NetBSD: longjmp.c,v 1.6 2011/04/30 23:39:08 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.3 martin #include <stddef.h>
40 1.1 christos
41 1.1 christos #define __LIBC12_SOURCE__
42 1.1 christos #include <setjmp.h>
43 1.1 christos #include <compat/include/setjmp.h>
44 1.1 christos
45 1.1 christos typedef struct {
46 1.4 martin __greg_t g3;
47 1.4 martin __greg_t g6;
48 1.4 martin __greg_t g7;
49 1.4 martin __greg_t dummy;
50 1.4 martin __greg_t save_mask;
51 1.1 christos } __jmp_buf_regs_t;
52 1.1 christos
53 1.3 martin /*
54 1.3 martin * setjmp.S uses hard coded offsets into the jump_buf,
55 1.3 martin * make sure any changes cause a compile failure here
56 1.3 martin */
57 1.4 martin __CTASSERT(0x68 == offsetof(__jmp_buf_regs_t,save_mask)+
58 1.3 martin sizeof(struct sigcontext));
59 1.6 martin __CTASSERT(sizeof(sigjmp_buf) >= sizeof(__jmp_buf_regs_t) +
60 1.5 martin sizeof(struct sigcontext));
61 1.3 martin
62 1.1 christos void
63 1.1 christos __longjmp14(jmp_buf env, int val)
64 1.1 christos {
65 1.1 christos struct sigcontext *sc = (void *)env;
66 1.1 christos __jmp_buf_regs_t *r = (void *)&sc[1];
67 1.1 christos ucontext_t uc;
68 1.1 christos
69 1.1 christos /* Ensure non-zero SP */
70 1.1 christos if (sc->sc_sp == 0)
71 1.1 christos goto err;
72 1.1 christos
73 1.1 christos /*
74 1.1 christos * Set _UC_CPU. No FPU data saved, so we can't restore
75 1.1 christos * that. Set _UC_{SET,CLR}STACK according to SS_ONSTACK
76 1.1 christos */
77 1.1 christos memset(&uc, 0, sizeof(uc));
78 1.1 christos uc.uc_flags = _UC_CPU | (sc->sc_onstack ? _UC_SETSTACK : _UC_CLRSTACK);
79 1.1 christos
80 1.1 christos /*
81 1.1 christos * Set the signal mask - this is a weak symbol, so don't use
82 1.1 christos * _UC_SIGMASK in the mcontext, libpthread might override sigprocmask.
83 1.1 christos */
84 1.1 christos sigprocmask(SIG_SETMASK, &sc->sc_mask, NULL);
85 1.1 christos
86 1.1 christos /* Fill other registers */
87 1.1 christos uc.uc_mcontext.__gregs[_REG_CCR] = sc->sc_tstate;
88 1.1 christos uc.uc_mcontext.__gregs[_REG_PC] = sc->sc_pc;
89 1.3 martin uc.uc_mcontext.__gregs[_REG_nPC] = sc->sc_pc+4;
90 1.1 christos uc.uc_mcontext.__gregs[_REG_G1] = sc->sc_g1;
91 1.1 christos uc.uc_mcontext.__gregs[_REG_G2] = sc->sc_o0;
92 1.4 martin uc.uc_mcontext.__gregs[_REG_G3] = r->g3;
93 1.4 martin uc.uc_mcontext.__gregs[_REG_G4] = 0;
94 1.4 martin uc.uc_mcontext.__gregs[_REG_G5] = 0;
95 1.4 martin uc.uc_mcontext.__gregs[_REG_G6] = r->g6;
96 1.4 martin uc.uc_mcontext.__gregs[_REG_G7] = r->g7;
97 1.1 christos uc.uc_mcontext.__gregs[_REG_O6] = sc->sc_sp;
98 1.1 christos
99 1.3 martin
100 1.1 christos /* Make return value non-zero */
101 1.1 christos if (val == 0)
102 1.1 christos val = 1;
103 1.1 christos
104 1.1 christos /* Save return value in context */
105 1.1 christos uc.uc_mcontext.__gregs[_REG_O0] = val;
106 1.1 christos
107 1.1 christos setcontext(&uc);
108 1.1 christos
109 1.1 christos err:
110 1.1 christos longjmperror();
111 1.1 christos abort();
112 1.1 christos /* NOTREACHED */
113 1.1 christos }
114