longjmp.c revision 1.4 1 1.4 martin /* $NetBSD: longjmp.c,v 1.4 2011/04/30 19:39:38 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.3 martin
60 1.1 christos void
61 1.1 christos __longjmp14(jmp_buf env, int val)
62 1.1 christos {
63 1.1 christos struct sigcontext *sc = (void *)env;
64 1.1 christos __jmp_buf_regs_t *r = (void *)&sc[1];
65 1.1 christos ucontext_t uc;
66 1.1 christos
67 1.1 christos /* Ensure non-zero SP */
68 1.1 christos if (sc->sc_sp == 0)
69 1.1 christos goto err;
70 1.1 christos
71 1.1 christos /*
72 1.1 christos * Set _UC_CPU. No FPU data saved, so we can't restore
73 1.1 christos * that. Set _UC_{SET,CLR}STACK according to SS_ONSTACK
74 1.1 christos */
75 1.1 christos memset(&uc, 0, sizeof(uc));
76 1.1 christos uc.uc_flags = _UC_CPU | (sc->sc_onstack ? _UC_SETSTACK : _UC_CLRSTACK);
77 1.1 christos
78 1.1 christos /*
79 1.1 christos * Set the signal mask - this is a weak symbol, so don't use
80 1.1 christos * _UC_SIGMASK in the mcontext, libpthread might override sigprocmask.
81 1.1 christos */
82 1.1 christos sigprocmask(SIG_SETMASK, &sc->sc_mask, NULL);
83 1.1 christos
84 1.1 christos /* Fill other registers */
85 1.1 christos uc.uc_mcontext.__gregs[_REG_CCR] = sc->sc_tstate;
86 1.1 christos uc.uc_mcontext.__gregs[_REG_PC] = sc->sc_pc;
87 1.3 martin uc.uc_mcontext.__gregs[_REG_nPC] = sc->sc_pc+4;
88 1.1 christos uc.uc_mcontext.__gregs[_REG_G1] = sc->sc_g1;
89 1.1 christos uc.uc_mcontext.__gregs[_REG_G2] = sc->sc_o0;
90 1.4 martin uc.uc_mcontext.__gregs[_REG_G3] = r->g3;
91 1.4 martin uc.uc_mcontext.__gregs[_REG_G4] = 0;
92 1.4 martin uc.uc_mcontext.__gregs[_REG_G5] = 0;
93 1.4 martin uc.uc_mcontext.__gregs[_REG_G6] = r->g6;
94 1.4 martin uc.uc_mcontext.__gregs[_REG_G7] = r->g7;
95 1.1 christos uc.uc_mcontext.__gregs[_REG_O6] = sc->sc_sp;
96 1.1 christos
97 1.3 martin
98 1.1 christos /* Make return value non-zero */
99 1.1 christos if (val == 0)
100 1.1 christos val = 1;
101 1.1 christos
102 1.1 christos /* Save return value in context */
103 1.1 christos uc.uc_mcontext.__gregs[_REG_O0] = val;
104 1.1 christos
105 1.1 christos setcontext(&uc);
106 1.1 christos
107 1.1 christos err:
108 1.1 christos longjmperror();
109 1.1 christos abort();
110 1.1 christos /* NOTREACHED */
111 1.1 christos }
112