xref: /openbmc/qemu/linux-user/xtensa/signal.c (revision ebe15582)
1 /*
2  *  Emulation of Linux signals
3  *
4  *  Copyright (c) 2003 Fabrice Bellard
5  *
6  *  This program is free software; you can redistribute it and/or modify
7  *  it under the terms of the GNU General Public License as published by
8  *  the Free Software Foundation; either version 2 of the License, or
9  *  (at your option) any later version.
10  *
11  *  This program is distributed in the hope that it will be useful,
12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  *  GNU General Public License for more details.
15  *
16  *  You should have received a copy of the GNU General Public License
17  *  along with this program; if not, see <http://www.gnu.org/licenses/>.
18  */
19 #include "qemu/osdep.h"
20 #include "qemu.h"
21 #include "signal-common.h"
22 #include "linux-user/trace.h"
23 
24 struct target_sigcontext {
25     abi_ulong sc_pc;
26     abi_ulong sc_ps;
27     abi_ulong sc_lbeg;
28     abi_ulong sc_lend;
29     abi_ulong sc_lcount;
30     abi_ulong sc_sar;
31     abi_ulong sc_acclo;
32     abi_ulong sc_acchi;
33     abi_ulong sc_a[16];
34     abi_ulong sc_xtregs;
35 };
36 
37 struct target_ucontext {
38     abi_ulong tuc_flags;
39     abi_ulong tuc_link;
40     target_stack_t tuc_stack;
41     struct target_sigcontext tuc_mcontext;
42     target_sigset_t tuc_sigmask;
43 };
44 
45 struct target_rt_sigframe {
46     target_siginfo_t info;
47     struct target_ucontext uc;
48     /* TODO: xtregs */
49     uint8_t retcode[6];
50     abi_ulong window[4];
51 };
52 
53 static abi_ulong get_sigframe(struct target_sigaction *sa,
54                               CPUXtensaState *env,
55                               unsigned long framesize)
56 {
57     abi_ulong sp;
58 
59     sp = target_sigsp(get_sp_from_cpustate(env), sa);
60 
61     return (sp - framesize) & -16;
62 }
63 
64 static int flush_window_regs(CPUXtensaState *env)
65 {
66     uint32_t wb = env->sregs[WINDOW_BASE];
67     uint32_t ws = xtensa_replicate_windowstart(env) >> (wb + 1);
68     unsigned d = ctz32(ws) + 1;
69     unsigned i;
70     int ret = 0;
71 
72     for (i = d; i < env->config->nareg / 4; i += d) {
73         uint32_t ssp, osp;
74         unsigned j;
75 
76         ws >>= d;
77         xtensa_rotate_window(env, d);
78 
79         if (ws & 0x1) {
80             ssp = env->regs[5];
81             d = 1;
82         } else if (ws & 0x2) {
83             ssp = env->regs[9];
84             ret |= get_user_ual(osp, env->regs[1] - 12);
85             osp -= 32;
86             d = 2;
87         } else if (ws & 0x4) {
88             ssp = env->regs[13];
89             ret |= get_user_ual(osp, env->regs[1] - 12);
90             osp -= 48;
91             d = 3;
92         } else {
93             g_assert_not_reached();
94         }
95 
96         for (j = 0; j < 4; ++j) {
97             ret |= put_user_ual(env->regs[j], ssp - 16 + j * 4);
98         }
99         for (j = 4; j < d * 4; ++j) {
100             ret |= put_user_ual(env->regs[j], osp - 16 + j * 4);
101         }
102     }
103     xtensa_rotate_window(env, d);
104     g_assert(env->sregs[WINDOW_BASE] == wb);
105     return ret == 0;
106 }
107 
108 static int setup_sigcontext(struct target_rt_sigframe *frame,
109                             CPUXtensaState *env)
110 {
111     struct target_sigcontext *sc = &frame->uc.tuc_mcontext;
112     int i;
113 
114     __put_user(env->pc, &sc->sc_pc);
115     __put_user(env->sregs[PS], &sc->sc_ps);
116     __put_user(env->sregs[LBEG], &sc->sc_lbeg);
117     __put_user(env->sregs[LEND], &sc->sc_lend);
118     __put_user(env->sregs[LCOUNT], &sc->sc_lcount);
119     if (!flush_window_regs(env)) {
120         return 0;
121     }
122     for (i = 0; i < 16; ++i) {
123         __put_user(env->regs[i], sc->sc_a + i);
124     }
125     __put_user(0, &sc->sc_xtregs);
126     /* TODO: xtregs */
127     return 1;
128 }
129 
130 void setup_rt_frame(int sig, struct target_sigaction *ka,
131                     target_siginfo_t *info,
132                     target_sigset_t *set, CPUXtensaState *env)
133 {
134     abi_ulong frame_addr;
135     struct target_rt_sigframe *frame;
136     uint32_t ra;
137     bool abi_call0;
138     unsigned base;
139     int i;
140 
141     frame_addr = get_sigframe(ka, env, sizeof(*frame));
142     trace_user_setup_rt_frame(env, frame_addr);
143 
144     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
145         goto give_sigsegv;
146     }
147 
148     if (ka->sa_flags & SA_SIGINFO) {
149         tswap_siginfo(&frame->info, info);
150     }
151 
152     __put_user(0, &frame->uc.tuc_flags);
153     __put_user(0, &frame->uc.tuc_link);
154     target_save_altstack(&frame->uc.tuc_stack, env);
155     if (!setup_sigcontext(frame, env)) {
156         unlock_user_struct(frame, frame_addr, 0);
157         goto give_sigsegv;
158     }
159     for (i = 0; i < TARGET_NSIG_WORDS; ++i) {
160         __put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]);
161     }
162 
163     if (ka->sa_flags & TARGET_SA_RESTORER) {
164         ra = ka->sa_restorer;
165     } else {
166         ra = frame_addr + offsetof(struct target_rt_sigframe, retcode);
167 #ifdef TARGET_WORDS_BIGENDIAN
168         /* Generate instruction:  MOVI a2, __NR_rt_sigreturn */
169         __put_user(0x22, &frame->retcode[0]);
170         __put_user(0x0a, &frame->retcode[1]);
171         __put_user(TARGET_NR_rt_sigreturn, &frame->retcode[2]);
172         /* Generate instruction:  SYSCALL */
173         __put_user(0x00, &frame->retcode[3]);
174         __put_user(0x05, &frame->retcode[4]);
175         __put_user(0x00, &frame->retcode[5]);
176 #else
177         /* Generate instruction:  MOVI a2, __NR_rt_sigreturn */
178         __put_user(0x22, &frame->retcode[0]);
179         __put_user(0xa0, &frame->retcode[1]);
180         __put_user(TARGET_NR_rt_sigreturn, &frame->retcode[2]);
181         /* Generate instruction:  SYSCALL */
182         __put_user(0x00, &frame->retcode[3]);
183         __put_user(0x50, &frame->retcode[4]);
184         __put_user(0x00, &frame->retcode[5]);
185 #endif
186     }
187     memset(env->regs, 0, sizeof(env->regs));
188     env->pc = ka->_sa_handler;
189     env->regs[1] = frame_addr;
190     env->sregs[WINDOW_BASE] = 0;
191     env->sregs[WINDOW_START] = 1;
192 
193     abi_call0 = (env->sregs[PS] & PS_WOE) == 0;
194     env->sregs[PS] = PS_UM | (3 << PS_RING_SHIFT);
195 
196     if (abi_call0) {
197         base = 0;
198         env->regs[base] = ra;
199     } else {
200         env->sregs[PS] |= PS_WOE | (1 << PS_CALLINC_SHIFT);
201         base = 4;
202         env->regs[base] = (ra & 0x3fffffff) | 0x40000000;
203     }
204     env->regs[base + 2] = sig;
205     env->regs[base + 3] = frame_addr + offsetof(struct target_rt_sigframe,
206                                                 info);
207     env->regs[base + 4] = frame_addr + offsetof(struct target_rt_sigframe, uc);
208     unlock_user_struct(frame, frame_addr, 1);
209     return;
210 
211 give_sigsegv:
212     force_sigsegv(sig);
213     return;
214 }
215 
216 static void restore_sigcontext(CPUXtensaState *env,
217                                struct target_rt_sigframe *frame)
218 {
219     struct target_sigcontext *sc = &frame->uc.tuc_mcontext;
220     uint32_t ps;
221     int i;
222 
223     __get_user(env->pc, &sc->sc_pc);
224     __get_user(ps, &sc->sc_ps);
225     __get_user(env->sregs[LBEG], &sc->sc_lbeg);
226     __get_user(env->sregs[LEND], &sc->sc_lend);
227     __get_user(env->sregs[LCOUNT], &sc->sc_lcount);
228 
229     env->sregs[WINDOW_BASE] = 0;
230     env->sregs[WINDOW_START] = 1;
231     env->sregs[PS] = deposit32(env->sregs[PS],
232                                PS_CALLINC_SHIFT,
233                                PS_CALLINC_LEN,
234                                extract32(ps, PS_CALLINC_SHIFT,
235                                          PS_CALLINC_LEN));
236     for (i = 0; i < 16; ++i) {
237         __get_user(env->regs[i], sc->sc_a + i);
238     }
239     /* TODO: xtregs */
240 }
241 
242 long do_rt_sigreturn(CPUXtensaState *env)
243 {
244     abi_ulong frame_addr = env->regs[1];
245     struct target_rt_sigframe *frame;
246     sigset_t set;
247 
248     trace_user_do_rt_sigreturn(env, frame_addr);
249     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
250         goto badframe;
251     }
252     target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
253     set_sigmask(&set);
254 
255     restore_sigcontext(env, frame);
256 
257     if (do_sigaltstack(frame_addr +
258                        offsetof(struct target_rt_sigframe, uc.tuc_stack),
259                        0, get_sp_from_cpustate(env)) == -TARGET_EFAULT) {
260         goto badframe;
261     }
262     unlock_user_struct(frame, frame_addr, 0);
263     return -TARGET_QEMU_ESIGRETURN;
264 
265 badframe:
266     unlock_user_struct(frame, frame_addr, 0);
267     force_sig(TARGET_SIGSEGV);
268     return -TARGET_QEMU_ESIGRETURN;
269 }
270