ViewVC Help
View File | Revision Log | Show Annotations | Revision Graph | Root Listing
root/cebix/BasiliskII/src/Unix/sigsegv.cpp
(Generate patch)

Comparing BasiliskII/src/Unix/sigsegv.cpp (file contents):
Revision 1.1 by gbeauche, 2001-05-20T20:31:50Z vs.
Revision 1.15 by gbeauche, 2002-05-20T16:00:07Z

# Line 4 | Line 4
4   *  Derived from Bruno Haible's work on his SIGSEGV library for clisp
5   *  <http://clisp.sourceforge.net/>
6   *
7 < *  Basilisk II (C) 1997-2001 Christian Bauer
7 > *  Basilisk II (C) 1997-2002 Christian Bauer
8   *
9   *  This program is free software; you can redistribute it and/or modify
10   *  it under the terms of the GNU General Public License as published by
# Line 40 | Line 40
40   // Type of the system signal handler
41   typedef RETSIGTYPE (*signal_handler)(int);
42  
43 + // Is the fault to be ignored?
44 + static bool sigsegv_ignore_fault = false;
45 +
46   // User's SIGSEGV handler
47 < static sigsegv_handler_t sigsegv_user_handler = 0;
47 > static sigsegv_fault_handler_t sigsegv_fault_handler = 0;
48 >
49 > // Function called to dump state if we can't handle the fault
50 > static sigsegv_state_dumper_t sigsegv_state_dumper = 0;
51  
52   // Actual SIGSEGV handler installer
53   static bool sigsegv_do_install_handler(int sig);
54  
55  
56   /*
57 + *  Instruction decoding aids
58 + */
59 +
60 + // Transfer type
61 + enum transfer_type_t {
62 +        TYPE_UNKNOWN,
63 +        TYPE_LOAD,
64 +        TYPE_STORE
65 + };
66 +
67 + // Transfer size
68 + enum transfer_size_t {
69 +        SIZE_UNKNOWN,
70 +        SIZE_BYTE,
71 +        SIZE_WORD,
72 +        SIZE_LONG
73 + };
74 +
75 + #if (defined(powerpc) || defined(__powerpc__) || defined(__ppc__))
76 + // Addressing mode
77 + enum addressing_mode_t {
78 +        MODE_UNKNOWN,
79 +        MODE_NORM,
80 +        MODE_U,
81 +        MODE_X,
82 +        MODE_UX
83 + };
84 +
85 + // Decoded instruction
86 + struct instruction_t {
87 +        transfer_type_t         transfer_type;
88 +        transfer_size_t         transfer_size;
89 +        addressing_mode_t       addr_mode;
90 +        unsigned int            addr;
91 +        char                            ra, rd;
92 + };
93 +
94 + static void powerpc_decode_instruction(instruction_t *instruction, unsigned int nip, unsigned int * gpr)
95 + {
96 +        // Get opcode and divide into fields
97 +        unsigned int opcode = *((unsigned int *)nip);
98 +        unsigned int primop = opcode >> 26;
99 +        unsigned int exop = (opcode >> 1) & 0x3ff;
100 +        unsigned int ra = (opcode >> 16) & 0x1f;
101 +        unsigned int rb = (opcode >> 11) & 0x1f;
102 +        unsigned int rd = (opcode >> 21) & 0x1f;
103 +        signed int imm = (signed short)(opcode & 0xffff);
104 +        
105 +        // Analyze opcode
106 +        transfer_type_t transfer_type = TYPE_UNKNOWN;
107 +        transfer_size_t transfer_size = SIZE_UNKNOWN;
108 +        addressing_mode_t addr_mode = MODE_UNKNOWN;
109 +        switch (primop) {
110 +        case 31:
111 +                switch (exop) {
112 +                case 23:        // lwzx
113 +                        transfer_type = TYPE_LOAD; transfer_size = SIZE_LONG; addr_mode = MODE_X; break;
114 +                case 55:        // lwzux
115 +                        transfer_type = TYPE_LOAD; transfer_size = SIZE_LONG; addr_mode = MODE_UX; break;
116 +                case 87:        // lbzx
117 +                        transfer_type = TYPE_LOAD; transfer_size = SIZE_BYTE; addr_mode = MODE_X; break;
118 +                case 119:       // lbzux
119 +                        transfer_type = TYPE_LOAD; transfer_size = SIZE_BYTE; addr_mode = MODE_UX; break;
120 +                case 151:       // stwx
121 +                        transfer_type = TYPE_STORE; transfer_size = SIZE_LONG; addr_mode = MODE_X; break;
122 +                case 183:       // stwux
123 +                        transfer_type = TYPE_STORE; transfer_size = SIZE_LONG; addr_mode = MODE_UX; break;
124 +                case 215:       // stbx
125 +                        transfer_type = TYPE_STORE; transfer_size = SIZE_BYTE; addr_mode = MODE_X; break;
126 +                case 247:       // stbux
127 +                        transfer_type = TYPE_STORE; transfer_size = SIZE_BYTE; addr_mode = MODE_UX; break;
128 +                case 279:       // lhzx
129 +                        transfer_type = TYPE_LOAD; transfer_size = SIZE_WORD; addr_mode = MODE_X; break;
130 +                case 311:       // lhzux
131 +                        transfer_type = TYPE_LOAD; transfer_size = SIZE_WORD; addr_mode = MODE_UX; break;
132 +                case 343:       // lhax
133 +                        transfer_type = TYPE_LOAD; transfer_size = SIZE_WORD; addr_mode = MODE_X; break;
134 +                case 375:       // lhaux
135 +                        transfer_type = TYPE_LOAD; transfer_size = SIZE_WORD; addr_mode = MODE_UX; break;
136 +                case 407:       // sthx
137 +                        transfer_type = TYPE_STORE; transfer_size = SIZE_WORD; addr_mode = MODE_X; break;
138 +                case 439:       // sthux
139 +                        transfer_type = TYPE_STORE; transfer_size = SIZE_WORD; addr_mode = MODE_UX; break;
140 +                }
141 +                break;
142 +        
143 +        case 32:        // lwz
144 +                transfer_type = TYPE_LOAD; transfer_size = SIZE_LONG; addr_mode = MODE_NORM; break;
145 +        case 33:        // lwzu
146 +                transfer_type = TYPE_LOAD; transfer_size = SIZE_LONG; addr_mode = MODE_U; break;
147 +        case 34:        // lbz
148 +                transfer_type = TYPE_LOAD; transfer_size = SIZE_BYTE; addr_mode = MODE_NORM; break;
149 +        case 35:        // lbzu
150 +                transfer_type = TYPE_LOAD; transfer_size = SIZE_BYTE; addr_mode = MODE_U; break;
151 +        case 36:        // stw
152 +                transfer_type = TYPE_STORE; transfer_size = SIZE_LONG; addr_mode = MODE_NORM; break;
153 +        case 37:        // stwu
154 +                transfer_type = TYPE_STORE; transfer_size = SIZE_LONG; addr_mode = MODE_U; break;
155 +        case 38:        // stb
156 +                transfer_type = TYPE_STORE; transfer_size = SIZE_BYTE; addr_mode = MODE_NORM; break;
157 +        case 39:        // stbu
158 +                transfer_type = TYPE_STORE; transfer_size = SIZE_BYTE; addr_mode = MODE_U; break;
159 +        case 40:        // lhz
160 +                transfer_type = TYPE_LOAD; transfer_size = SIZE_WORD; addr_mode = MODE_NORM; break;
161 +        case 41:        // lhzu
162 +                transfer_type = TYPE_LOAD; transfer_size = SIZE_WORD; addr_mode = MODE_U; break;
163 +        case 42:        // lha
164 +                transfer_type = TYPE_LOAD; transfer_size = SIZE_WORD; addr_mode = MODE_NORM; break;
165 +        case 43:        // lhau
166 +                transfer_type = TYPE_LOAD; transfer_size = SIZE_WORD; addr_mode = MODE_U; break;
167 +        case 44:        // sth
168 +                transfer_type = TYPE_STORE; transfer_size = SIZE_WORD; addr_mode = MODE_NORM; break;
169 +        case 45:        // sthu
170 +                transfer_type = TYPE_STORE; transfer_size = SIZE_WORD; addr_mode = MODE_U; break;
171 +        }
172 +        
173 +        // Calculate effective address
174 +        unsigned int addr = 0;
175 +        switch (addr_mode) {
176 +        case MODE_X:
177 +        case MODE_UX:
178 +                if (ra == 0)
179 +                        addr = gpr[rb];
180 +                else
181 +                        addr = gpr[ra] + gpr[rb];
182 +                break;
183 +        case MODE_NORM:
184 +        case MODE_U:
185 +                if (ra == 0)
186 +                        addr = (signed int)(signed short)imm;
187 +                else
188 +                        addr = gpr[ra] + (signed int)(signed short)imm;
189 +                break;
190 +        default:
191 +                break;
192 +        }
193 +        
194 +        // Commit decoded instruction
195 +        instruction->addr = addr;
196 +        instruction->addr_mode = addr_mode;
197 +        instruction->transfer_type = transfer_type;
198 +        instruction->transfer_size = transfer_size;
199 +        instruction->ra = ra;
200 +        instruction->rd = rd;
201 + }
202 + #endif
203 +
204 +
205 + /*
206   *  OS-dependant SIGSEGV signals support section
207   */
208  
209   #if HAVE_SIGINFO_T
210   // Generic extended signal handler
211 + #if defined(__NetBSD__) || defined(__FreeBSD__)
212 + #define SIGSEGV_ALL_SIGNALS                             FAULT_HANDLER(SIGBUS)
213 + #else
214   #define SIGSEGV_ALL_SIGNALS                             FAULT_HANDLER(SIGSEGV)
215 < #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, siginfo_t *sip, void *
215 > #endif
216 > #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, siginfo_t *sip, void *scp
217   #define SIGSEGV_FAULT_ADDRESS                   sip->si_addr
218 + #if defined(__linux__)
219 + #if (defined(i386) || defined(__i386__))
220 + #include <sys/ucontext.h>
221 + #define SIGSEGV_CONTEXT_REGS                    (((ucontext_t *)scp)->uc_mcontext.gregs)
222 + #define SIGSEGV_FAULT_INSTRUCTION               SIGSEGV_CONTEXT_REGS[14] /* should use REG_EIP instead */
223 + #define SIGSEGV_REGISTER_FILE                   (unsigned int *)SIGSEGV_CONTEXT_REGS
224 + #define SIGSEGV_SKIP_INSTRUCTION                ix86_skip_instruction
225 + #endif
226 + #if (defined(ia64) || defined(__ia64__))
227 + #define SIGSEGV_FAULT_INSTRUCTION               (((struct sigcontext *)scp)->sc_ip & ~0x3ULL) /* slot number is in bits 0 and 1 */
228 + #endif
229 + #if (defined(powerpc) || defined(__powerpc__))
230 + #include <sys/ucontext.h>
231 + #define SIGSEGV_CONTEXT_REGS                    (((ucontext_t *)scp)->uc_mcontext.regs)
232 + #define SIGSEGV_FAULT_INSTRUCTION               (SIGSEGV_CONTEXT_REGS->nip)
233 + #define SIGSEGV_REGISTER_FILE                   (unsigned int *)&SIGSEGV_CONTEXT_REGS->nip, (unsigned int *)(SIGSEGV_CONTEXT_REGS->gpr)
234 + #define SIGSEGV_SKIP_INSTRUCTION                powerpc_skip_instruction
235 + #endif
236 + #endif
237   #endif
238  
239   #if HAVE_SIGCONTEXT_SUBTERFUGE
# Line 67 | Line 245 | static bool sigsegv_do_install_handler(i
245   #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, struct sigcontext scs
246   #define SIGSEGV_FAULT_ADDRESS                   scs.cr2
247   #define SIGSEGV_FAULT_INSTRUCTION               scs.eip
248 + #define SIGSEGV_REGISTER_FILE                   (unsigned long *)(&scs)
249 + #define SIGSEGV_SKIP_INSTRUCTION                ix86_skip_instruction
250   #endif
251   #if (defined(sparc) || defined(__sparc__))
252   #include <asm/sigcontext.h>
253 < #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, int code, struct sigcontext* scp, char* addr
253 > #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, int code, struct sigcontext *scp, char *addr
254   #define SIGSEGV_FAULT_ADDRESS                   addr
255   #endif
256   #if (defined(powerpc) || defined(__powerpc__))
257   #include <asm/sigcontext.h>
258 < #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, struct sigcontext* scp
258 > #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, struct sigcontext *scp
259   #define SIGSEGV_FAULT_ADDRESS                   scp->regs->dar
260   #define SIGSEGV_FAULT_INSTRUCTION               scp->regs->nip
261 + #define SIGSEGV_REGISTER_FILE                   (unsigned int *)&scp->regs->nip, (unsigned int *)(scp->regs->gpr)
262 + #define SIGSEGV_SKIP_INSTRUCTION                powerpc_skip_instruction
263 + #endif
264 + #if (defined(alpha) || defined(__alpha__))
265 + #include <asm/sigcontext.h>
266 + #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, int code, struct sigcontext *scp
267 + #define SIGSEGV_FAULT_ADDRESS                   get_fault_address(scp)
268 + #define SIGSEGV_FAULT_INSTRUCTION               scp->sc_pc
269 +
270 + // From Boehm's GC 6.0alpha8
271 + static sigsegv_address_t get_fault_address(struct sigcontext *scp)
272 + {
273 +        unsigned int instruction = *((unsigned int *)(scp->sc_pc));
274 +        unsigned long fault_address = scp->sc_regs[(instruction >> 16) & 0x1f];
275 +        fault_address += (signed long)(signed short)(instruction & 0xffff);
276 +        return (sigsegv_address_t)fault_address;
277 + }
278   #endif
279   #endif
280  
281   // Irix 5 or 6 on MIPS
282   #if (defined(sgi) || defined(__sgi)) && (defined(SYSTYPE_SVR4) || defined(__SYSTYPE_SVR4))
283 + #include <ucontext.h>
284   #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, int code, struct sigcontext *scp
285   #define SIGSEGV_FAULT_ADDRESS                   scp->sc_badvaddr
286   #define SIGSEGV_ALL_SIGNALS                             FAULT_HANDLER(SIGSEGV)
287   #endif
288  
289 + // HP-UX
290 + #if (defined(hpux) || defined(__hpux__))
291 + #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, int code, struct sigcontext *scp
292 + #define SIGSEGV_FAULT_ADDRESS                   scp->sc_sl.sl_ss.ss_narrow.ss_cr21
293 + #define SIGSEGV_ALL_SIGNALS                             FAULT_HANDLER(SIGSEGV) FAULT_HANDLER(SIGBUS)
294 + #endif
295 +
296   // OSF/1 on Alpha
297   #if defined(__osf__)
298 + #include <ucontext.h>
299   #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, int code, struct sigcontext *scp
300   #define SIGSEGV_FAULT_ADDRESS                   scp->sc_traparg_a0
301   #define SIGSEGV_ALL_SIGNALS                             FAULT_HANDLER(SIGSEGV)
# Line 107 | Line 313 | static bool sigsegv_do_install_handler(i
313   #if (defined(m68k) || defined(__m68k__))
314   #include <m68k/frame.h>
315   #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, int code, struct sigcontext *scp
316 < #define SIGSEGV_FAULT_ADDRESS                   ({                                                                                                                              \
111 <        struct sigstate {                                                                                                                                                                       \
112 <                int ss_flags;                                                                                                                                                                   \
113 <                struct frame ss_frame;                                                                                                                                                  \
114 <        };                                                                                                                                                                                                      \
115 <        struct sigstate *state = (struct sigstate *)scp->sc_ap;                                                                                         \
116 <        char *fault_addr;                                                                                                                                                                       \
117 <        switch (state->ss_frame.f_format) {                                                                                                                                     \
118 <        case 7:         /* 68040 access error */                                                                                                                                \
119 <                /* "code" is sometimes unreliable (i.e. contains NULL or a bogus address), reason unknown */    \
120 <                fault_addr = state->ss_frame.f_fmt7.f_fa;                                                                                                               \
121 <                break;                                                                                                                                                                                  \
122 <        default:                                                                                                                                                                                        \
123 <                fault_addr = (char *)code;                                                                                                                                              \
124 <                break;                                                                                                                                                                                  \
125 <        }                                                                                                                                                                                                       \
126 <        fault_addr;                                                                                                                                                                                     \
127 < })
316 > #define SIGSEGV_FAULT_ADDRESS                   get_fault_address(scp)
317   #define SIGSEGV_ALL_SIGNALS                             FAULT_HANDLER(SIGSEGV)
318 +
319 + // Use decoding scheme from BasiliskII/m68k native
320 + static sigsegv_address_t get_fault_address(struct sigcontext *scp)
321 + {
322 +        struct sigstate {
323 +                int ss_flags;
324 +                struct frame ss_frame;
325 +        };
326 +        struct sigstate *state = (struct sigstate *)scp->sc_ap;
327 +        char *fault_addr;
328 +        switch (state->ss_frame.f_format) {
329 +        case 7:         /* 68040 access error */
330 +                /* "code" is sometimes unreliable (i.e. contains NULL or a bogus address), reason unknown */
331 +                fault_addr = state->ss_frame.f_fmt7.f_fa;
332 +                break;
333 +        default:
334 +                fault_addr = (char *)code;
335 +                break;
336 +        }
337 +        return (sigsegv_address_t)fault_addr;
338 + }
339   #else
340   #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, int code, void *scp, char *addr
341   #define SIGSEGV_FAULT_ADDRESS                   addr
342   #define SIGSEGV_ALL_SIGNALS                             FAULT_HANDLER(SIGBUS)
343   #endif
344   #endif
345 +
346 + // MacOS X
347 + #if defined(__APPLE__) && defined(__MACH__)
348 + #if (defined(ppc) || defined(__ppc__))
349 + #define SIGSEGV_FAULT_HANDLER_ARGLIST   int sig, int code, struct sigcontext *scp
350 + #define SIGSEGV_FAULT_ADDRESS                   get_fault_address(scp)
351 + #define SIGSEGV_FAULT_INSTRUCTION               scp->sc_ir
352 + #define SIGSEGV_ALL_SIGNALS                             FAULT_HANDLER(SIGBUS)
353 + #define SIGSEGV_REGISTER_FILE                   (unsigned int *)&scp->sc_ir, &((unsigned int *) scp->sc_regs)[2]
354 + #define SIGSEGV_SKIP_INSTRUCTION                powerpc_skip_instruction
355 +
356 + // Use decoding scheme from SheepShaver
357 + static sigsegv_address_t get_fault_address(struct sigcontext *scp)
358 + {
359 +        unsigned int   nip = (unsigned int) scp->sc_ir;
360 +        unsigned int * gpr = &((unsigned int *) scp->sc_regs)[2];
361 +        instruction_t  instr;
362 +
363 +        powerpc_decode_instruction(&instr, nip, gpr);
364 +        return (sigsegv_address_t)instr.addr;
365 + }
366 + #endif
367 + #endif
368 + #endif
369 +
370 +
371 + /*
372 + *  Instruction skipping
373 + */
374 +
375 + #ifdef HAVE_SIGSEGV_SKIP_INSTRUCTION
376 + // Decode and skip X86 instruction
377 + #if (defined(i386) || defined(__i386__))
378 + #if defined(__linux__)
379 + enum {
380 +        X86_REG_EIP = 14,
381 +        X86_REG_EAX = 11,
382 +        X86_REG_ECX = 10,
383 +        X86_REG_EDX = 9,
384 +        X86_REG_EBX = 8,
385 +        X86_REG_ESP = 7,
386 +        X86_REG_EBP = 6,
387 +        X86_REG_ESI = 5,
388 +        X86_REG_EDI = 4
389 + };
390 + #endif
391 + // FIXME: this is partly redundant with the instruction decoding phase
392 + // to discover transfer type and register number
393 + static inline int ix86_step_over_modrm(unsigned char * p)
394 + {
395 +        int mod = (p[0] >> 6) & 3;
396 +        int rm = p[0] & 7;
397 +        int offset = 0;
398 +
399 +        // ModR/M Byte
400 +        switch (mod) {
401 +        case 0: // [reg]
402 +                if (rm == 5) return 4; // disp32
403 +                break;
404 +        case 1: // disp8[reg]
405 +                offset = 1;
406 +                break;
407 +        case 2: // disp32[reg]
408 +                offset = 4;
409 +                break;
410 +        case 3: // register
411 +                return 0;
412 +        }
413 +        
414 +        // SIB Byte
415 +        if (rm == 4) {
416 +                if (mod == 0 && (p[1] & 7) == 5)
417 +                        offset = 5; // disp32[index]
418 +                else
419 +                        offset++;
420 +        }
421 +
422 +        return offset;
423 + }
424 +
425 + static bool ix86_skip_instruction(unsigned int * regs)
426 + {
427 +        unsigned char * eip = (unsigned char *)regs[X86_REG_EIP];
428 +
429 +        if (eip == 0)
430 +                return false;
431 +        
432 +        transfer_type_t transfer_type = TYPE_UNKNOWN;
433 +        transfer_size_t transfer_size = SIZE_LONG;
434 +        
435 +        int reg = -1;
436 +        int len = 0;
437 +        
438 +        // Operand size prefix
439 +        if (*eip == 0x66) {
440 +                eip++;
441 +                len++;
442 +                transfer_size = SIZE_WORD;
443 +        }
444 +
445 +        // Decode instruction
446 +        switch (eip[0]) {
447 +        case 0x8a: // MOV r8, r/m8
448 +                transfer_size = SIZE_BYTE;
449 +        case 0x8b: // MOV r32, r/m32 (or 16-bit operation)
450 +                switch (eip[1] & 0xc0) {
451 +                case 0x80:
452 +                        reg = (eip[1] >> 3) & 7;
453 +                        transfer_type = TYPE_LOAD;
454 +                        break;
455 +                case 0x40:
456 +                        reg = (eip[1] >> 3) & 7;
457 +                        transfer_type = TYPE_LOAD;
458 +                        break;
459 +                case 0x00:
460 +                        reg = (eip[1] >> 3) & 7;
461 +                        transfer_type = TYPE_LOAD;
462 +                        break;
463 +                }
464 +                len += 2 + ix86_step_over_modrm(eip + 1);
465 +                break;
466 +        case 0x88: // MOV r/m8, r8
467 +                transfer_size = SIZE_BYTE;
468 +        case 0x89: // MOV r/m32, r32 (or 16-bit operation)
469 +                switch (eip[1] & 0xc0) {
470 +                case 0x80:
471 +                        reg = (eip[1] >> 3) & 7;
472 +                        transfer_type = TYPE_STORE;
473 +                        break;
474 +                case 0x40:
475 +                        reg = (eip[1] >> 3) & 7;
476 +                        transfer_type = TYPE_STORE;
477 +                        break;
478 +                case 0x00:
479 +                        reg = (eip[1] >> 3) & 7;
480 +                        transfer_type = TYPE_STORE;
481 +                        break;
482 +                }
483 +                len += 2 + ix86_step_over_modrm(eip + 1);
484 +                break;
485 +        }
486 +
487 +        if (transfer_type == TYPE_UNKNOWN) {
488 +                // Unknown machine code, let it crash. Then patch the decoder
489 +                return false;
490 +        }
491 +
492 +        if (transfer_type == TYPE_LOAD && reg != -1) {
493 +                static const int x86_reg_map[8] = {
494 +                        X86_REG_EAX, X86_REG_ECX, X86_REG_EDX, X86_REG_EBX,
495 +                        X86_REG_ESP, X86_REG_EBP, X86_REG_ESI, X86_REG_EDI
496 +                };
497 +                
498 +                if (reg < 0 || reg >= 8)
499 +                        return false;
500 +
501 +                int rloc = x86_reg_map[reg];
502 +                switch (transfer_size) {
503 +                case SIZE_BYTE:
504 +                        regs[rloc] = (regs[rloc] & ~0xff);
505 +                        break;
506 +                case SIZE_WORD:
507 +                        regs[rloc] = (regs[rloc] & ~0xffff);
508 +                        break;
509 +                case SIZE_LONG:
510 +                        regs[rloc] = 0;
511 +                        break;
512 +                }
513 +        }
514 +
515 + #if DEBUG
516 +        printf("%08x: %s %s access", regs[X86_REG_EIP],
517 +                   transfer_size == SIZE_BYTE ? "byte" : transfer_size == SIZE_WORD ? "word" : "long",
518 +                   transfer_type == TYPE_LOAD ? "read" : "write");
519 +        
520 +        if (reg != -1) {
521 +                static const char * x86_reg_str_map[8] = {
522 +                        "eax", "ecx", "edx", "ebx",
523 +                        "esp", "ebp", "esi", "edi"
524 +                };
525 +                printf(" %s register %%%s", transfer_type == TYPE_LOAD ? "to" : "from", x86_reg_str_map[reg]);
526 +        }
527 +        printf(", %d bytes instruction\n", len);
528 + #endif
529 +        
530 +        regs[X86_REG_EIP] += len;
531 +        return true;
532 + }
533 + #endif
534 +
535 + // Decode and skip PPC instruction
536 + #if (defined(powerpc) || defined(__powerpc__) || defined(__ppc__))
537 + static bool powerpc_skip_instruction(unsigned int * nip_p, unsigned int * regs)
538 + {
539 +        instruction_t instr;
540 +        powerpc_decode_instruction(&instr, *nip_p, regs);
541 +        
542 +        if (instr.transfer_type == TYPE_UNKNOWN) {
543 +                // Unknown machine code, let it crash. Then patch the decoder
544 +                return false;
545 +        }
546 +
547 + #if DEBUG
548 +        printf("%08x: %s %s access", *nip_p,
549 +                   instr.transfer_size == SIZE_BYTE ? "byte" : instr.transfer_size == SIZE_WORD ? "word" : "long",
550 +                   instr.transfer_type == TYPE_LOAD ? "read" : "write");
551 +        
552 +        if (instr.addr_mode == MODE_U || instr.addr_mode == MODE_UX)
553 +                printf(" r%d (ra = %08x)\n", instr.ra, instr.addr);
554 +        if (instr.transfer_type == TYPE_LOAD)
555 +                printf(" r%d (rd = 0)\n", instr.rd);
556 + #endif
557 +        
558 +        if (instr.addr_mode == MODE_U || instr.addr_mode == MODE_UX)
559 +                regs[instr.ra] = instr.addr;
560 +        if (instr.transfer_type == TYPE_LOAD)
561 +                regs[instr.rd] = 0;
562 +        
563 +        *nip_p += 4;
564 +        return true;
565 + }
566 + #endif
567   #endif
568  
569   // Fallbacks
# Line 139 | Line 571 | static bool sigsegv_do_install_handler(i
571   #define SIGSEGV_FAULT_INSTRUCTION               SIGSEGV_INVALID_PC
572   #endif
573  
574 + // SIGSEGV recovery supported ?
575 + #if defined(SIGSEGV_ALL_SIGNALS) && defined(SIGSEGV_FAULT_HANDLER_ARGLIST) && defined(SIGSEGV_FAULT_ADDRESS)
576 + #define HAVE_SIGSEGV_RECOVERY
577 + #endif
578 +
579  
580   /*
581   *  SIGSEGV global handler
582   */
583  
584 + #ifdef HAVE_SIGSEGV_RECOVERY
585   static void sigsegv_handler(SIGSEGV_FAULT_HANDLER_ARGLIST)
586   {
587 +        sigsegv_address_t fault_address = (sigsegv_address_t)SIGSEGV_FAULT_ADDRESS;
588 +        sigsegv_address_t fault_instruction = (sigsegv_address_t)SIGSEGV_FAULT_INSTRUCTION;
589 +        bool fault_recovered = false;
590 +        
591          // Call user's handler and reinstall the global handler, if required
592 <        if (sigsegv_user_handler((sigsegv_address_t)SIGSEGV_FAULT_ADDRESS, (sigsegv_address_t)SIGSEGV_FAULT_INSTRUCTION)) {
592 >        if (sigsegv_fault_handler(fault_address, fault_instruction)) {
593   #if (defined(HAVE_SIGACTION) ? defined(SIGACTION_NEED_REINSTALL) : defined(SIGNAL_NEED_REINSTALL))
594                  sigsegv_do_install_handler(sig);
595   #endif
596 +                fault_recovered = true;
597          }
598 <        else {
598 > #if HAVE_SIGSEGV_SKIP_INSTRUCTION
599 >        else if (sigsegv_ignore_fault) {
600 >                // Call the instruction skipper with the register file available
601 >                if (SIGSEGV_SKIP_INSTRUCTION(SIGSEGV_REGISTER_FILE))
602 >                        fault_recovered = true;
603 >        }
604 > #endif
605 >
606 >        if (!fault_recovered) {
607                  // FAIL: reinstall default handler for "safe" crash
608   #define FAULT_HANDLER(sig) signal(sig, SIG_DFL);
609                  SIGSEGV_ALL_SIGNALS
610   #undef FAULT_HANDLER
611 +                
612 +                // We can't do anything with the fault_address, dump state?
613 +                if (sigsegv_state_dumper != 0)
614 +                        sigsegv_state_dumper(fault_address, fault_instruction);
615          }
616   }
617 + #endif
618  
619  
620   /*
# Line 179 | Line 635 | static bool sigsegv_do_install_handler(i
635          return (signal(sig, (signal_handler)sigsegv_handler) != SIG_ERR);
636   #endif
637   }
638 < #elif defined(HAVE_SIGCONTEXT_SUBTERFUGE)
638 > #endif
639 >
640 > #if defined(HAVE_SIGCONTEXT_SUBTERFUGE)
641   static bool sigsegv_do_install_handler(int sig)
642   {
643          // Setup SIGSEGV handler to process writes to frame buffer
# Line 200 | Line 658 | static bool sigsegv_do_install_handler(i
658   }
659   #endif
660  
661 < bool sigsegv_install_handler(sigsegv_handler_t handler)
661 > bool sigsegv_install_handler(sigsegv_fault_handler_t handler)
662   {
663 < #if defined(HAVE_SIGINFO_T) || defined(HAVE_SIGCONTEXT_SUBTERFUGE)
664 <        sigsegv_user_handler = handler;
663 > #ifdef HAVE_SIGSEGV_RECOVERY
664 >        sigsegv_fault_handler = handler;
665          bool success = true;
666   #define FAULT_HANDLER(sig) success = success && sigsegv_do_install_handler(sig);
667          SIGSEGV_ALL_SIGNALS
# Line 222 | Line 680 | bool sigsegv_install_handler(sigsegv_han
680  
681   void sigsegv_deinstall_handler(void)
682   {
683 <        sigsegv_user_handler = 0;
683 > #ifdef HAVE_SIGSEGV_RECOVERY
684 >        sigsegv_fault_handler = 0;
685   #define FAULT_HANDLER(sig) signal(sig, SIG_DFL);
686          SIGSEGV_ALL_SIGNALS
687   #undef FAULT_HANDLER
688 + #endif
689 + }
690 +
691 +
692 + /*
693 + *  SIGSEGV ignore state modifier
694 + */
695 +
696 + void sigsegv_set_ignore_state(bool ignore_fault)
697 + {
698 +        sigsegv_ignore_fault = ignore_fault;
699 + }
700 +
701 +
702 + /*
703 + *  Set callback function when we cannot handle the fault
704 + */
705 +
706 + void sigsegv_set_dump_state(sigsegv_state_dumper_t handler)
707 + {
708 +        sigsegv_state_dumper = handler;
709   }
710  
711 +
712   /*
713   *  Test program used for configure/test
714   */
715  
716 < #ifdef CONFIGURE_TEST
716 > #ifdef CONFIGURE_TEST_SIGSEGV_RECOVERY
717   #include <stdio.h>
718   #include <stdlib.h>
238 #include <unistd.h>
719   #include <fcntl.h>
720   #include <sys/mman.h>
721 + #include "vm_alloc.h"
722  
242 static caddr_t page = 0;
723   static int page_size;
724 < static int handler_called = 0;
724 > static volatile char * page = 0;
725 > static volatile int handler_called = 0;
726  
727   static bool sigsegv_test_handler(sigsegv_address_t fault_address, sigsegv_address_t instruction_address)
728   {
729          handler_called++;
730          if ((fault_address - 123) != page)
731                  exit(1);
732 <        if (mprotect((caddr_t)((unsigned long)fault_address & -page_size), page_size, PROT_READ | PROT_WRITE) != 0)
732 >        if (vm_protect((char *)((unsigned long)fault_address & -page_size), page_size, VM_PAGE_READ | VM_PAGE_WRITE) != 0)
733                  exit(1);
734          return true;
735   }
736  
737 + #ifdef HAVE_SIGSEGV_SKIP_INSTRUCTION
738 + static bool sigsegv_insn_handler(sigsegv_address_t fault_address, sigsegv_address_t instruction_address)
739 + {
740 +        return false;
741 + }
742 + #endif
743 +
744   int main(void)
745   {
746 <        int zero_fd = open("/dev/zero", O_RDWR);
259 <        if (zero_fd < 0)
746 >        if (vm_init() < 0)
747                  return 1;
748  
749          page_size = getpagesize();
750 <        page = (caddr_t)mmap(0, page_size, PROT_READ, MAP_PRIVATE, zero_fd, 0);
751 <        if (page == MAP_FAILED)
750 >        if ((page = (char *)vm_acquire(page_size)) == VM_MAP_FAILED)
751 >                return 1;
752 >        
753 >        if (vm_protect((char *)page, page_size, VM_PAGE_READ) < 0)
754                  return 1;
755          
756          if (!sigsegv_install_handler(sigsegv_test_handler))
# Line 273 | Line 762 | int main(void)
762          if (handler_called != 1)
763                  return 1;
764  
765 + #ifdef HAVE_SIGSEGV_SKIP_INSTRUCTION
766 +        if (!sigsegv_install_handler(sigsegv_insn_handler))
767 +                return 1;
768 +        
769 +        if (vm_protect((char *)page, page_size, VM_PAGE_WRITE) < 0)
770 +                return 1;
771 +        
772 +        for (int i = 0; i < page_size; i++)
773 +                page[i] = (i + 1) % page_size;
774 +        
775 +        if (vm_protect((char *)page, page_size, VM_PAGE_NOACCESS) < 0)
776 +                return 1;
777 +        
778 +        sigsegv_set_ignore_state(true);
779 +
780 + #define TEST_SKIP_INSTRUCTION(TYPE) do {                                \
781 +                const unsigned int TAG = 0x12345678;                    \
782 +                TYPE data = *((TYPE *)(page + sizeof(TYPE)));   \
783 +                volatile unsigned int effect = data + TAG;              \
784 +                if (effect != TAG)                                                              \
785 +                        return 1;                                                                       \
786 +        } while (0)
787 +        
788 +        TEST_SKIP_INSTRUCTION(unsigned char);
789 +        TEST_SKIP_INSTRUCTION(unsigned short);
790 +        TEST_SKIP_INSTRUCTION(unsigned int);
791 + #endif
792 +
793 +        vm_exit();
794          return 0;
795   }
796   #endif

Diff Legend

Removed lines
+ Added lines
< Changed lines
> Changed lines