git.oblomov.eu Git - wine/blob - dlls/ntdll/signal_x86_64.c

   1 /*
   2  * x86-64 signal handling routines
   3  *
   4  * Copyright 1999, 2005 Alexandre Julliard
   5  *
   6  * This library is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU Lesser General Public
   8  * License as published by the Free Software Foundation; either
   9  * version 2.1 of the License, or (at your option) any later version.
  10  *
  11  * This library 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 GNU
  14  * Lesser General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU Lesser General Public
  17  * License along with this library; if not, write to the Free Software
  18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
  19  */
  20
  21 #ifdef __x86_64__
  22
  23 #include "config.h"
  24 #include "wine/port.h"
  25
  26 #include <assert.h>
  27 #include <signal.h>
  28 #include <stdlib.h>
  29 #include <stdarg.h>
  30 #include <stdio.h>
  31 #ifdef HAVE_UNISTD_H
  32 # include <unistd.h>
  33 #endif
  34
  35 #ifdef HAVE_SYS_PARAM_H
  36 # include <sys/param.h>
  37 #endif
  38 #ifdef HAVE_SYS_SIGNAL_H
  39 # include <sys/signal.h>
  40 #endif
  41
  42 #define NONAMELESSUNION
  43 #define NONAMELESSSTRUCT
  44 #include "ntstatus.h"
  45 #define WIN32_NO_STATUS
  46 #include "windef.h"
  47 #include "winternl.h"
  48 #include "wine/library.h"
  49 #include "wine/exception.h"
  50 #include "ntdll_misc.h"
  51 #include "wine/debug.h"
  52
  53 #ifdef HAVE_VALGRIND_MEMCHECK_H
  54 #include <valgrind/memcheck.h>
  55 #endif
  56
  57 WINE_DEFAULT_DEBUG_CHANNEL(seh);
  58
  59 struct _DISPATCHER_CONTEXT;
  60
  61 typedef LONG (WINAPI *PC_LANGUAGE_EXCEPTION_HANDLER)( EXCEPTION_POINTERS *ptrs, ULONG64 frame );
  62 typedef EXCEPTION_DISPOSITION (WINAPI *PEXCEPTION_ROUTINE)( EXCEPTION_RECORD *rec,
  63                                                             ULONG64 frame,
  64                                                             CONTEXT *context,
  65                                                             struct _DISPATCHER_CONTEXT *dispatch );
  66
  67 typedef struct _DISPATCHER_CONTEXT
  68 {
  69     ULONG64               ControlPc;
  70     ULONG64               ImageBase;
  71     PRUNTIME_FUNCTION     FunctionEntry;
  72     ULONG64               EstablisherFrame;
  73     ULONG64               TargetIp;
  74     PCONTEXT              ContextRecord;
  75     PEXCEPTION_ROUTINE    LanguageHandler;
  76     PVOID                 HandlerData;
  77     PUNWIND_HISTORY_TABLE HistoryTable;
  78     ULONG                 ScopeIndex;
  79 } DISPATCHER_CONTEXT, *PDISPATCHER_CONTEXT;
  80
  81 typedef struct _SCOPE_TABLE
  82 {
  83     ULONG Count;
  84     struct
  85     {
  86         ULONG BeginAddress;
  87         ULONG EndAddress;
  88         ULONG HandlerAddress;
  89         ULONG JumpTarget;
  90     } ScopeRecord[1];
  91 } SCOPE_TABLE, *PSCOPE_TABLE;
  92
  93
  94 /***********************************************************************
  95  * signal context platform-specific definitions
  96  */
  97 #ifdef linux
  98
  99 #include <asm/prctl.h>
 100 extern int arch_prctl(int func, void *ptr);
 101
 102 #define RAX_sig(context)     ((context)->uc_mcontext.gregs[REG_RAX])
 103 #define RBX_sig(context)     ((context)->uc_mcontext.gregs[REG_RBX])
 104 #define RCX_sig(context)     ((context)->uc_mcontext.gregs[REG_RCX])
 105 #define RDX_sig(context)     ((context)->uc_mcontext.gregs[REG_RDX])
 106 #define RSI_sig(context)     ((context)->uc_mcontext.gregs[REG_RSI])
 107 #define RDI_sig(context)     ((context)->uc_mcontext.gregs[REG_RDI])
 108 #define RBP_sig(context)     ((context)->uc_mcontext.gregs[REG_RBP])
 109 #define R8_sig(context)      ((context)->uc_mcontext.gregs[REG_R8])
 110 #define R9_sig(context)      ((context)->uc_mcontext.gregs[REG_R9])
 111 #define R10_sig(context)     ((context)->uc_mcontext.gregs[REG_R10])
 112 #define R11_sig(context)     ((context)->uc_mcontext.gregs[REG_R11])
 113 #define R12_sig(context)     ((context)->uc_mcontext.gregs[REG_R12])
 114 #define R13_sig(context)     ((context)->uc_mcontext.gregs[REG_R13])
 115 #define R14_sig(context)     ((context)->uc_mcontext.gregs[REG_R14])
 116 #define R15_sig(context)     ((context)->uc_mcontext.gregs[REG_R15])
 117
 118 #define CS_sig(context)      (*((WORD *)&(context)->uc_mcontext.gregs[REG_CSGSFS] + 0))
 119 #define GS_sig(context)      (*((WORD *)&(context)->uc_mcontext.gregs[REG_CSGSFS] + 1))
 120 #define FS_sig(context)      (*((WORD *)&(context)->uc_mcontext.gregs[REG_CSGSFS] + 2))
 121
 122 #define RSP_sig(context)     ((context)->uc_mcontext.gregs[REG_RSP])
 123 #define RIP_sig(context)     ((context)->uc_mcontext.gregs[REG_RIP])
 124 #define EFL_sig(context)     ((context)->uc_mcontext.gregs[REG_EFL])
 125 #define TRAP_sig(context)    ((context)->uc_mcontext.gregs[REG_TRAPNO])
 126 #define ERROR_sig(context)   ((context)->uc_mcontext.gregs[REG_ERR])
 127
 128 #define FPU_sig(context)     ((XMM_SAVE_AREA32 *)((context)->uc_mcontext.fpregs))
 129
 130 #endif /* linux */
 131
 132 #if defined(__NetBSD__)
 133 # include <sys/ucontext.h>
 134 # include <sys/types.h>
 135 # include <signal.h>
 136
 137 #define RAX_sig(context)    ((context)->uc_mcontext.__gregs[_REG_RAX])
 138 #define RBX_sig(context)    ((context)->uc_mcontext.__gregs[_REG_RBX])
 139 #define RCX_sig(context)    ((context)->uc_mcontext.__gregs[_REG_RCX])
 140 #define RDX_sig(context)    ((context)->uc_mcontext.__gregs[_REG_RDX])
 141 #define RSI_sig(context)    ((context)->uc_mcontext.__gregs[_REG_RSI])
 142 #define RDI_sig(context)    ((context)->uc_mcontext.__gregs[_REG_RDI])
 143 #define RBP_sig(context)    ((context)->uc_mcontext.__gregs[_REG_RBP])
 144 #define R8_sig(context)     ((context)->uc_mcontext.__gregs[_REG_R8])
 145 #define R9_sig(context)     ((context)->uc_mcontext.__gregs[_REG_R9])
 146 #define R10_sig(context)    ((context)->uc_mcontext.__gregs[_REG_R10])
 147 #define R11_sig(context)    ((context)->uc_mcontext.__gregs[_REG_R11])
 148 #define R12_sig(context)    ((context)->uc_mcontext.__gregs[_REG_R12])
 149 #define R13_sig(context)    ((context)->uc_mcontext.__gregs[_REG_R13])
 150 #define R14_sig(context)    ((context)->uc_mcontext.__gregs[_REG_R14])
 151 #define R15_sig(context)    ((context)->uc_mcontext.__gregs[_REG_R15])
 152
 153 #define CS_sig(context)     ((context)->uc_mcontext.__gregs[_REG_CS])
 154 #define DS_sig(context)     ((context)->uc_mcontext.__gregs[_REG_DS])
 155 #define ES_sig(context)     ((context)->uc_mcontext.__gregs[_REG_ES])
 156 #define FS_sig(context)     ((context)->uc_mcontext.__gregs[_REG_FS])
 157 #define GS_sig(context)     ((context)->uc_mcontext.__gregs[_REG_GS])
 158 #define SS_sig(context)     ((context)->uc_mcontext.__gregs[_REG_SS])
 159
 160 #define EFL_sig(context)    ((context)->uc_mcontext.__gregs[_REG_RFL])
 161
 162 #define RIP_sig(context)    (*((unsigned long*)&(context)->uc_mcontext.__gregs[_REG_RIP]))
 163 #define RSP_sig(context)    (*((unsigned long*)&(context)->uc_mcontext.__gregs[_REG_URSP]))
 164
 165 #define TRAP_sig(context)   ((context)->uc_mcontext.__gregs[_REG_TRAPNO])
 166 #define ERROR_sig(context)  ((context)->uc_mcontext.__gregs[_REG_ERR])
 167
 168 #define FPU_sig(context)   ((XMM_SAVE_AREA32 *)((context)->uc_mcontext.__fpregs))
 169 #endif /* __NetBSD__ */
 170
 171 enum i386_trap_code
 172 {
 173     TRAP_x86_UNKNOWN    = -1,  /* Unknown fault (TRAP_sig not defined) */
 174     TRAP_x86_DIVIDE     = 0,   /* Division by zero exception */
 175     TRAP_x86_TRCTRAP    = 1,   /* Single-step exception */
 176     TRAP_x86_NMI        = 2,   /* NMI interrupt */
 177     TRAP_x86_BPTFLT     = 3,   /* Breakpoint exception */
 178     TRAP_x86_OFLOW      = 4,   /* Overflow exception */
 179     TRAP_x86_BOUND      = 5,   /* Bound range exception */
 180     TRAP_x86_PRIVINFLT  = 6,   /* Invalid opcode exception */
 181     TRAP_x86_DNA        = 7,   /* Device not available exception */
 182     TRAP_x86_DOUBLEFLT  = 8,   /* Double fault exception */
 183     TRAP_x86_FPOPFLT    = 9,   /* Coprocessor segment overrun */
 184     TRAP_x86_TSSFLT     = 10,  /* Invalid TSS exception */
 185     TRAP_x86_SEGNPFLT   = 11,  /* Segment not present exception */
 186     TRAP_x86_STKFLT     = 12,  /* Stack fault */
 187     TRAP_x86_PROTFLT    = 13,  /* General protection fault */
 188     TRAP_x86_PAGEFLT    = 14,  /* Page fault */
 189     TRAP_x86_ARITHTRAP  = 16,  /* Floating point exception */
 190     TRAP_x86_ALIGNFLT   = 17,  /* Alignment check exception */
 191     TRAP_x86_MCHK       = 18,  /* Machine check exception */
 192     TRAP_x86_CACHEFLT   = 19   /* Cache flush exception */
 193 };
 194
 195 static const size_t teb_size = 0x2000;  /* we reserve two pages for the TEB */
 196 static size_t signal_stack_size;
 197
 198 typedef void (*raise_func)( EXCEPTION_RECORD *rec, CONTEXT *context );
 199 typedef int (*wine_signal_handler)(unsigned int sig);
 200
 201 static wine_signal_handler handlers[256];
 202
 203
 204 /***********************************************************************
 205  * Definitions for Win32 unwind tables
 206  */
 207
 208 union handler_data
 209 {
 210     RUNTIME_FUNCTION chain;
 211     ULONG handler;
 212 };
 213
 214 struct opcode
 215 {
 216     BYTE offset;
 217     BYTE code : 4;
 218     BYTE info : 4;
 219 };
 220
 221 struct UNWIND_INFO
 222 {
 223     BYTE version : 3;
 224     BYTE flags : 5;
 225     BYTE prolog;
 226     BYTE count;
 227     BYTE frame_reg : 4;
 228     BYTE frame_offset : 4;
 229     struct opcode opcodes[1];  /* info->count entries */
 230     /* followed by handler_data */
 231 };
 232
 233 #define UWOP_PUSH_NONVOL     0
 234 #define UWOP_ALLOC_LARGE     1
 235 #define UWOP_ALLOC_SMALL     2
 236 #define UWOP_SET_FPREG       3
 237 #define UWOP_SAVE_NONVOL     4
 238 #define UWOP_SAVE_NONVOL_FAR 5
 239 #define UWOP_SAVE_XMM128     8
 240 #define UWOP_SAVE_XMM128_FAR 9
 241 #define UWOP_PUSH_MACHFRAME  10
 242
 243 static void dump_unwind_info( ULONG64 base, RUNTIME_FUNCTION *function )
 244 {
 245     static const char * const reg_names[16] =
 246         { "rax", "rcx", "rdx", "rbx", "rsp", "rbp", "rsi", "rdi",
 247           "r8",  "r9",  "r10", "r11", "r12", "r13", "r14", "r15" };
 248
 249     union handler_data *handler_data;
 250     struct UNWIND_INFO *info;
 251     unsigned int i, count;
 252
 253     TRACE( "**** func %x-%x\n", function->BeginAddress, function->EndAddress );
 254     for (;;)
 255     {
 256         if (function->UnwindData & 1)
 257         {
 258             RUNTIME_FUNCTION *next = (RUNTIME_FUNCTION *)((char *)base + (function->UnwindData & ~1));
 259             TRACE( "unwind info for function %p-%p chained to function %p-%p\n",
 260                    (char *)base + function->BeginAddress, (char *)base + function->EndAddress,
 261                    (char *)base + next->BeginAddress, (char *)base + next->EndAddress );
 262             function = next;
 263             continue;
 264         }
 265         info = (struct UNWIND_INFO *)((char *)base + function->UnwindData);
 266
 267         TRACE( "unwind info at %p flags %x prolog 0x%x bytes function %p-%p\n",
 268                info, info->flags, info->prolog,
 269                (char *)base + function->BeginAddress, (char *)base + function->EndAddress );
 270
 271         if (info->frame_reg)
 272             TRACE( "    frame register %s offset 0x%x(%%rsp)\n",
 273                    reg_names[info->frame_reg], info->frame_offset * 16 );
 274
 275         for (i = 0; i < info->count; i++)
 276         {
 277             TRACE( "    0x%x: ", info->opcodes[i].offset );
 278             switch (info->opcodes[i].code)
 279             {
 280             case UWOP_PUSH_NONVOL:
 281                 TRACE( "pushq %%%s\n", reg_names[info->opcodes[i].info] );
 282                 break;
 283             case UWOP_ALLOC_LARGE:
 284                 if (info->opcodes[i].info)
 285                 {
 286                     count = *(DWORD *)&info->opcodes[i+1];
 287                     i += 2;
 288                 }
 289                 else
 290                 {
 291                     count = *(USHORT *)&info->opcodes[i+1] * 8;
 292                     i++;
 293                 }
 294                 TRACE( "subq $0x%x,%%rsp\n", count );
 295                 break;
 296             case UWOP_ALLOC_SMALL:
 297                 count = (info->opcodes[i].info + 1) * 8;
 298                 TRACE( "subq $0x%x,%%rsp\n", count );
 299                 break;
 300             case UWOP_SET_FPREG:
 301                 TRACE( "leaq 0x%x(%%rsp),%s\n",
 302                      info->frame_offset * 16, reg_names[info->frame_reg] );
 303                 break;
 304             case UWOP_SAVE_NONVOL:
 305                 count = *(USHORT *)&info->opcodes[i+1] * 8;
 306                 TRACE( "movq %%%s,0x%x(%%rsp)\n", reg_names[info->opcodes[i].info], count );
 307                 i++;
 308                 break;
 309             case UWOP_SAVE_NONVOL_FAR:
 310                 count = *(DWORD *)&info->opcodes[i+1];
 311                 TRACE( "movq %%%s,0x%x(%%rsp)\n", reg_names[info->opcodes[i].info], count );
 312                 i += 2;
 313                 break;
 314             case UWOP_SAVE_XMM128:
 315                 count = *(USHORT *)&info->opcodes[i+1] * 16;
 316                 TRACE( "movaps %%xmm%u,0x%x(%%rsp)\n", info->opcodes[i].info, count );
 317                 i++;
 318                 break;
 319             case UWOP_SAVE_XMM128_FAR:
 320                 count = *(DWORD *)&info->opcodes[i+1];
 321                 TRACE( "movaps %%xmm%u,0x%x(%%rsp)\n", info->opcodes[i].info, count );
 322                 i += 2;
 323                 break;
 324             case UWOP_PUSH_MACHFRAME:
 325                 TRACE( "PUSH_MACHFRAME %u\n", info->opcodes[i].info );
 326                 break;
 327             default:
 328                 FIXME( "unknown code %u\n", info->opcodes[i].code );
 329                 break;
 330             }
 331         }
 332
 333         handler_data = (union handler_data *)&info->opcodes[(info->count + 1) & ~1];
 334         if (info->flags & UNW_FLAG_CHAININFO)
 335         {
 336             TRACE( "    chained to function %p-%p\n",
 337                    (char *)base + handler_data->chain.BeginAddress,
 338                    (char *)base + handler_data->chain.EndAddress );
 339             function = &handler_data->chain;
 340             continue;
 341         }
 342         if (info->flags & (UNW_FLAG_EHANDLER | UNW_FLAG_UHANDLER))
 343             TRACE( "    handler %p data at %p\n",
 344                    (char *)base + handler_data->handler, &handler_data->handler + 1 );
 345         break;
 346     }
 347 }
 348
 349 static void dump_scope_table( ULONG64 base, const SCOPE_TABLE *table )
 350 {
 351     unsigned int i;
 352
 353     TRACE( "scope table at %p\n", table );
 354     for (i = 0; i < table->Count; i++)
 355         TRACE( "  %u: %lx-%lx handler %lx target %lx\n", i,
 356                base + table->ScopeRecord[i].BeginAddress,
 357                base + table->ScopeRecord[i].EndAddress,
 358                base + table->ScopeRecord[i].HandlerAddress,
 359                base + table->ScopeRecord[i].JumpTarget );
 360 }
 361
 362
 363 /***********************************************************************
 364  * Definitions for Dwarf unwind tables
 365  */
 366
 367 enum dwarf_call_frame_info
 368 {
 369     DW_CFA_advance_loc = 0x40,
 370     DW_CFA_offset = 0x80,
 371     DW_CFA_restore = 0xc0,
 372     DW_CFA_nop = 0x00,
 373     DW_CFA_set_loc = 0x01,
 374     DW_CFA_advance_loc1 = 0x02,
 375     DW_CFA_advance_loc2 = 0x03,
 376     DW_CFA_advance_loc4 = 0x04,
 377     DW_CFA_offset_extended = 0x05,
 378     DW_CFA_restore_extended = 0x06,
 379     DW_CFA_undefined = 0x07,
 380     DW_CFA_same_value = 0x08,
 381     DW_CFA_register = 0x09,
 382     DW_CFA_remember_state = 0x0a,
 383     DW_CFA_restore_state = 0x0b,
 384     DW_CFA_def_cfa = 0x0c,
 385     DW_CFA_def_cfa_register = 0x0d,
 386     DW_CFA_def_cfa_offset = 0x0e,
 387     DW_CFA_def_cfa_expression = 0x0f,
 388     DW_CFA_expression = 0x10,
 389     DW_CFA_offset_extended_sf = 0x11,
 390     DW_CFA_def_cfa_sf = 0x12,
 391     DW_CFA_def_cfa_offset_sf = 0x13,
 392     DW_CFA_val_offset = 0x14,
 393     DW_CFA_val_offset_sf = 0x15,
 394     DW_CFA_val_expression = 0x16,
 395 };
 396
 397 enum dwarf_operation
 398 {
 399     DW_OP_addr                 = 0x03,
 400     DW_OP_deref                = 0x06,
 401     DW_OP_const1u              = 0x08,
 402     DW_OP_const1s              = 0x09,
 403     DW_OP_const2u              = 0x0a,
 404     DW_OP_const2s              = 0x0b,
 405     DW_OP_const4u              = 0x0c,
 406     DW_OP_const4s              = 0x0d,
 407     DW_OP_const8u              = 0x0e,
 408     DW_OP_const8s              = 0x0f,
 409     DW_OP_constu               = 0x10,
 410     DW_OP_consts               = 0x11,
 411     DW_OP_dup                  = 0x12,
 412     DW_OP_drop                 = 0x13,
 413     DW_OP_over                 = 0x14,
 414     DW_OP_pick                 = 0x15,
 415     DW_OP_swap                 = 0x16,
 416     DW_OP_rot                  = 0x17,
 417     DW_OP_xderef               = 0x18,
 418     DW_OP_abs                  = 0x19,
 419     DW_OP_and                  = 0x1a,
 420     DW_OP_div                  = 0x1b,
 421     DW_OP_minus                = 0x1c,
 422     DW_OP_mod                  = 0x1d,
 423     DW_OP_mul                  = 0x1e,
 424     DW_OP_neg                  = 0x1f,
 425     DW_OP_not                  = 0x20,
 426     DW_OP_or                   = 0x21,
 427     DW_OP_plus                 = 0x22,
 428     DW_OP_plus_uconst          = 0x23,
 429     DW_OP_shl                  = 0x24,
 430     DW_OP_shr                  = 0x25,
 431     DW_OP_shra                 = 0x26,
 432     DW_OP_xor                  = 0x27,
 433     DW_OP_bra                  = 0x28,
 434     DW_OP_eq                   = 0x29,
 435     DW_OP_ge                   = 0x2a,
 436     DW_OP_gt                   = 0x2b,
 437     DW_OP_le                   = 0x2c,
 438     DW_OP_lt                   = 0x2d,
 439     DW_OP_ne                   = 0x2e,
 440     DW_OP_skip                 = 0x2f,
 441     DW_OP_lit0                 = 0x30,
 442     DW_OP_lit1                 = 0x31,
 443     DW_OP_lit2                 = 0x32,
 444     DW_OP_lit3                 = 0x33,
 445     DW_OP_lit4                 = 0x34,
 446     DW_OP_lit5                 = 0x35,
 447     DW_OP_lit6                 = 0x36,
 448     DW_OP_lit7                 = 0x37,
 449     DW_OP_lit8                 = 0x38,
 450     DW_OP_lit9                 = 0x39,
 451     DW_OP_lit10                = 0x3a,
 452     DW_OP_lit11                = 0x3b,
 453     DW_OP_lit12                = 0x3c,
 454     DW_OP_lit13                = 0x3d,
 455     DW_OP_lit14                = 0x3e,
 456     DW_OP_lit15                = 0x3f,
 457     DW_OP_lit16                = 0x40,
 458     DW_OP_lit17                = 0x41,
 459     DW_OP_lit18                = 0x42,
 460     DW_OP_lit19                = 0x43,
 461     DW_OP_lit20                = 0x44,
 462     DW_OP_lit21                = 0x45,
 463     DW_OP_lit22                = 0x46,
 464     DW_OP_lit23                = 0x47,
 465     DW_OP_lit24                = 0x48,
 466     DW_OP_lit25                = 0x49,
 467     DW_OP_lit26                = 0x4a,
 468     DW_OP_lit27                = 0x4b,
 469     DW_OP_lit28                = 0x4c,
 470     DW_OP_lit29                = 0x4d,
 471     DW_OP_lit30                = 0x4e,
 472     DW_OP_lit31                = 0x4f,
 473     DW_OP_reg0                 = 0x50,
 474     DW_OP_reg1                 = 0x51,
 475     DW_OP_reg2                 = 0x52,
 476     DW_OP_reg3                 = 0x53,
 477     DW_OP_reg4                 = 0x54,
 478     DW_OP_reg5                 = 0x55,
 479     DW_OP_reg6                 = 0x56,
 480     DW_OP_reg7                 = 0x57,
 481     DW_OP_reg8                 = 0x58,
 482     DW_OP_reg9                 = 0x59,
 483     DW_OP_reg10                = 0x5a,
 484     DW_OP_reg11                = 0x5b,
 485     DW_OP_reg12                = 0x5c,
 486     DW_OP_reg13                = 0x5d,
 487     DW_OP_reg14                = 0x5e,
 488     DW_OP_reg15                = 0x5f,
 489     DW_OP_reg16                = 0x60,
 490     DW_OP_reg17                = 0x61,
 491     DW_OP_reg18                = 0x62,
 492     DW_OP_reg19                = 0x63,
 493     DW_OP_reg20                = 0x64,
 494     DW_OP_reg21                = 0x65,
 495     DW_OP_reg22                = 0x66,
 496     DW_OP_reg23                = 0x67,
 497     DW_OP_reg24                = 0x68,
 498     DW_OP_reg25                = 0x69,
 499     DW_OP_reg26                = 0x6a,
 500     DW_OP_reg27                = 0x6b,
 501     DW_OP_reg28                = 0x6c,
 502     DW_OP_reg29                = 0x6d,
 503     DW_OP_reg30                = 0x6e,
 504     DW_OP_reg31                = 0x6f,
 505     DW_OP_breg0                = 0x70,
 506     DW_OP_breg1                = 0x71,
 507     DW_OP_breg2                = 0x72,
 508     DW_OP_breg3                = 0x73,
 509     DW_OP_breg4                = 0x74,
 510     DW_OP_breg5                = 0x75,
 511     DW_OP_breg6                = 0x76,
 512     DW_OP_breg7                = 0x77,
 513     DW_OP_breg8                = 0x78,
 514     DW_OP_breg9                = 0x79,
 515     DW_OP_breg10               = 0x7a,
 516     DW_OP_breg11               = 0x7b,
 517     DW_OP_breg12               = 0x7c,
 518     DW_OP_breg13               = 0x7d,
 519     DW_OP_breg14               = 0x7e,
 520     DW_OP_breg15               = 0x7f,
 521     DW_OP_breg16               = 0x80,
 522     DW_OP_breg17               = 0x81,
 523     DW_OP_breg18               = 0x82,
 524     DW_OP_breg19               = 0x83,
 525     DW_OP_breg20               = 0x84,
 526     DW_OP_breg21               = 0x85,
 527     DW_OP_breg22               = 0x86,
 528     DW_OP_breg23               = 0x87,
 529     DW_OP_breg24               = 0x88,
 530     DW_OP_breg25               = 0x89,
 531     DW_OP_breg26               = 0x8a,
 532     DW_OP_breg27               = 0x8b,
 533     DW_OP_breg28               = 0x8c,
 534     DW_OP_breg29               = 0x8d,
 535     DW_OP_breg30               = 0x8e,
 536     DW_OP_breg31               = 0x8f,
 537     DW_OP_regx                 = 0x90,
 538     DW_OP_fbreg                = 0x91,
 539     DW_OP_bregx                = 0x92,
 540     DW_OP_piece                = 0x93,
 541     DW_OP_deref_size           = 0x94,
 542     DW_OP_xderef_size          = 0x95,
 543     DW_OP_nop                  = 0x96,
 544     DW_OP_push_object_address  = 0x97,
 545     DW_OP_call2                = 0x98,
 546     DW_OP_call4                = 0x99,
 547     DW_OP_call_ref             = 0x9a,
 548     DW_OP_form_tls_address     = 0x9b,
 549     DW_OP_call_frame_cfa       = 0x9c,
 550     DW_OP_bit_piece            = 0x9d,
 551     DW_OP_lo_user              = 0xe0,
 552     DW_OP_hi_user              = 0xff,
 553     DW_OP_GNU_push_tls_address = 0xe0,
 554     DW_OP_GNU_uninit           = 0xf0,
 555     DW_OP_GNU_encoded_addr     = 0xf1,
 556 };
 557
 558 #define DW_EH_PE_native   0x00
 559 #define DW_EH_PE_leb128   0x01
 560 #define DW_EH_PE_data2    0x02
 561 #define DW_EH_PE_data4    0x03
 562 #define DW_EH_PE_data8    0x04
 563 #define DW_EH_PE_signed   0x08
 564 #define DW_EH_PE_abs      0x00
 565 #define DW_EH_PE_pcrel    0x10
 566 #define DW_EH_PE_textrel  0x20
 567 #define DW_EH_PE_datarel  0x30
 568 #define DW_EH_PE_funcrel  0x40
 569 #define DW_EH_PE_aligned  0x50
 570 #define DW_EH_PE_indirect 0x80
 571 #define DW_EH_PE_omit     0xff
 572
 573 struct dwarf_eh_bases
 574 {
 575     void *tbase;
 576     void *dbase;
 577     void *func;
 578 };
 579
 580 struct dwarf_cie
 581 {
 582     unsigned int  length;
 583     int           id;
 584     unsigned char version;
 585     unsigned char augmentation[1];
 586 };
 587
 588 struct dwarf_fde
 589 {
 590     unsigned int length;
 591     unsigned int cie_offset;
 592 };
 593
 594 extern const struct dwarf_fde *_Unwind_Find_FDE (void *, struct dwarf_eh_bases *);
 595
 596 static unsigned char dwarf_get_u1( const unsigned char **p )
 597 {
 598     return *(*p)++;
 599 }
 600
 601 static unsigned short dwarf_get_u2( const unsigned char **p )
 602 {
 603     unsigned int ret = (*p)[0] | ((*p)[1] << 8);
 604     (*p) += 2;
 605     return ret;
 606 }
 607
 608 static unsigned int dwarf_get_u4( const unsigned char **p )
 609 {
 610     unsigned int ret = (*p)[0] | ((*p)[1] << 8) | ((*p)[2] << 16) | ((*p)[3] << 24);
 611     (*p) += 4;
 612     return ret;
 613 }
 614
 615 static ULONG64 dwarf_get_u8( const unsigned char **p )
 616 {
 617     ULONG64 low  = dwarf_get_u4( p );
 618     ULONG64 high = dwarf_get_u4( p );
 619     return low | (high << 32);
 620 }
 621
 622 static ULONG_PTR dwarf_get_uleb128( const unsigned char **p )
 623 {
 624     ULONG_PTR ret = 0;
 625     unsigned int shift = 0;
 626     unsigned char byte;
 627
 628     do
 629     {
 630         byte = **p;
 631         ret |= (ULONG_PTR)(byte & 0x7f) << shift;
 632         shift += 7;
 633         (*p)++;
 634     } while (byte & 0x80);
 635     return ret;
 636 }
 637
 638 static LONG_PTR dwarf_get_sleb128( const unsigned char **p )
 639 {
 640     ULONG_PTR ret = 0;
 641     unsigned int shift = 0;
 642     unsigned char byte;
 643
 644     do
 645     {
 646         byte = **p;
 647         ret |= (ULONG_PTR)(byte & 0x7f) << shift;
 648         shift += 7;
 649         (*p)++;
 650     } while (byte & 0x80);
 651
 652     if ((shift < 8 * sizeof(ret)) && (byte & 0x40)) ret |= -((ULONG_PTR)1 << shift);
 653     return ret;
 654 }
 655
 656 static ULONG_PTR dwarf_get_ptr( const unsigned char **p, unsigned char encoding )
 657 {
 658     ULONG_PTR base;
 659
 660     if (encoding == DW_EH_PE_omit) return 0;
 661
 662     switch (encoding & 0xf0)
 663     {
 664     case DW_EH_PE_abs:
 665         base = 0;
 666         break;
 667     case DW_EH_PE_pcrel:
 668         base = (ULONG_PTR)*p;
 669         break;
 670     default:
 671         FIXME( "unsupported encoding %02x\n", encoding );
 672         return 0;
 673     }
 674
 675     switch (encoding & 0x0f)
 676     {
 677     case DW_EH_PE_native:
 678         return base + dwarf_get_u8( p );
 679     case DW_EH_PE_leb128:
 680         return base + dwarf_get_uleb128( p );
 681     case DW_EH_PE_data2:
 682         return base + dwarf_get_u2( p );
 683     case DW_EH_PE_data4:
 684         return base + dwarf_get_u4( p );
 685     case DW_EH_PE_data8:
 686         return base + dwarf_get_u8( p );
 687     case DW_EH_PE_signed|DW_EH_PE_leb128:
 688         return base + dwarf_get_sleb128( p );
 689     case DW_EH_PE_signed|DW_EH_PE_data2:
 690         return base + (signed short)dwarf_get_u2( p );
 691     case DW_EH_PE_signed|DW_EH_PE_data4:
 692         return base + (signed int)dwarf_get_u4( p );
 693     case DW_EH_PE_signed|DW_EH_PE_data8:
 694         return base + (LONG64)dwarf_get_u8( p );
 695     default:
 696         FIXME( "unsupported encoding %02x\n", encoding );
 697         return 0;
 698     }
 699 }
 700
 701 enum reg_rule
 702 {
 703     RULE_UNSET,          /* not set at all */
 704     RULE_UNDEFINED,      /* undefined value */
 705     RULE_SAME,           /* same value as previous frame */
 706     RULE_CFA_OFFSET,     /* stored at cfa offset */
 707     RULE_OTHER_REG,      /* stored in other register */
 708     RULE_EXPRESSION,     /* address specified by expression */
 709     RULE_VAL_EXPRESSION  /* value specified by expression */
 710 };
 711
 712 #define NB_FRAME_REGS 41
 713
 714 struct frame_info
 715 {
 716     ULONG_PTR     ip;
 717     ULONG_PTR     code_align;
 718     LONG_PTR      data_align;
 719     ULONG_PTR     cfa_offset;
 720     enum reg_rule cfa_rule;
 721     unsigned char cfa_reg;
 722     unsigned char retaddr_reg;
 723     unsigned char fde_encoding;
 724     unsigned char signal_frame;
 725     enum reg_rule rules[NB_FRAME_REGS];
 726     ULONG64       regs[NB_FRAME_REGS];
 727 };
 728
 729 static const char *dwarf_reg_names[NB_FRAME_REGS] =
 730 {
 731 /*  0-7  */ "%rax", "%rdx", "%rcx", "%rbx", "%rsi", "%rdi", "%rbp", "%rsp",
 732 /*  8-16 */ "%r8", "%r9", "%r10", "%r11", "%r12", "%r13", "%r14", "%r15", "%rip",
 733 /* 17-24 */ "%xmm0", "%xmm1", "%xmm2", "%xmm3", "%xmm4", "%xmm5", "%xmm6", "%xmm7",
 734 /* 25-32 */ "%xmm8", "%xmm9", "%xmm10", "%xmm11", "%xmm12", "%xmm13", "%xmm14", "%xmm15",
 735 /* 33-40 */ "%st0", "%st1", "%st2", "%st3", "%st4", "%st5", "%st6", "%st7"
 736 };
 737
 738 static int valid_reg( ULONG_PTR reg )
 739 {
 740     if (reg >= NB_FRAME_REGS) FIXME( "unsupported reg %lx\n", reg );
 741     return (reg < NB_FRAME_REGS);
 742 }
 743
 744 static void execute_cfa_instructions( const unsigned char *ptr, const unsigned char *end,
 745                                       ULONG_PTR last_ip, struct frame_info *info )
 746 {
 747     while (ptr < end && info->ip < last_ip + info->signal_frame)
 748     {
 749         enum dwarf_call_frame_info op = *ptr++;
 750
 751         if (op & 0xc0)
 752         {
 753             switch (op & 0xc0)
 754             {
 755             case DW_CFA_advance_loc:
 756             {
 757                 ULONG_PTR offset = (op & 0x3f) * info->code_align;
 758                 TRACE( "%lx: DW_CFA_advance_loc %lu\n", info->ip, offset );
 759                 info->ip += offset;
 760                 break;
 761             }
 762             case DW_CFA_offset:
 763             {
 764                 ULONG_PTR reg = op & 0x3f;
 765                 LONG_PTR offset = dwarf_get_uleb128( &ptr ) * info->data_align;
 766                 if (!valid_reg( reg )) break;
 767                 TRACE( "%lx: DW_CFA_offset %s, %ld\n", info->ip, dwarf_reg_names[reg], offset );
 768                 info->regs[reg]  = offset;
 769                 info->rules[reg] = RULE_CFA_OFFSET;
 770                 break;
 771             }
 772             case DW_CFA_restore:
 773             {
 774                 ULONG_PTR reg = op & 0x3f;
 775                 if (!valid_reg( reg )) break;
 776                 TRACE( "%lx: DW_CFA_restore %s\n", info->ip, dwarf_reg_names[reg] );
 777                 info->rules[reg] = RULE_UNSET;
 778                 break;
 779             }
 780             }
 781         }
 782         else switch (op)
 783         {
 784         case DW_CFA_nop:
 785             break;
 786         case DW_CFA_set_loc:
 787         {
 788             ULONG_PTR loc = dwarf_get_ptr( &ptr, info->fde_encoding );
 789             TRACE( "%lx: DW_CFA_set_loc %lx\n", info->ip, loc );
 790             info->ip = loc;
 791             break;
 792         }
 793         case DW_CFA_advance_loc1:
 794         {
 795             ULONG_PTR offset = *ptr++ * info->code_align;
 796             TRACE( "%lx: DW_CFA_advance_loc1 %lu\n", info->ip, offset );
 797             info->ip += offset;
 798             break;
 799         }
 800         case DW_CFA_advance_loc2:
 801         {
 802             ULONG_PTR offset = dwarf_get_u2( &ptr ) * info->code_align;
 803             TRACE( "%lx: DW_CFA_advance_loc2 %lu\n", info->ip, offset );
 804             info->ip += offset;
 805             break;
 806         }
 807         case DW_CFA_advance_loc4:
 808         {
 809             ULONG_PTR offset = dwarf_get_u4( &ptr ) * info->code_align;
 810             TRACE( "%lx: DW_CFA_advance_loc4 %lu\n", info->ip, offset );
 811             info->ip += offset;
 812             break;
 813         }
 814         case DW_CFA_offset_extended:
 815         case DW_CFA_offset_extended_sf:
 816         {
 817             ULONG_PTR reg = dwarf_get_uleb128( &ptr );
 818             LONG_PTR offset = (op == DW_CFA_offset_extended) ? dwarf_get_uleb128( &ptr ) * info->data_align
 819                                                              : dwarf_get_sleb128( &ptr ) * info->data_align;
 820             if (!valid_reg( reg )) break;
 821             TRACE( "%lx: DW_CFA_offset_extended %s, %ld\n", info->ip, dwarf_reg_names[reg], offset );
 822             info->regs[reg]  = offset;
 823             info->rules[reg] = RULE_CFA_OFFSET;
 824             break;
 825         }
 826         case DW_CFA_restore_extended:
 827         {
 828             ULONG_PTR reg = dwarf_get_uleb128( &ptr );
 829             if (!valid_reg( reg )) break;
 830             TRACE( "%lx: DW_CFA_restore_extended %s\n", info->ip, dwarf_reg_names[reg] );
 831             info->rules[reg] = RULE_UNSET;
 832             break;
 833         }
 834         case DW_CFA_undefined:
 835         {
 836             ULONG_PTR reg = dwarf_get_uleb128( &ptr );
 837             if (!valid_reg( reg )) break;
 838             TRACE( "%lx: DW_CFA_undefined %s\n", info->ip, dwarf_reg_names[reg] );
 839             info->rules[reg] = RULE_UNDEFINED;
 840             break;
 841         }
 842         case DW_CFA_same_value:
 843         {
 844             ULONG_PTR reg = dwarf_get_uleb128( &ptr );
 845             if (!valid_reg( reg )) break;
 846             TRACE( "%lx: DW_CFA_same_value %s\n", info->ip, dwarf_reg_names[reg] );
 847             info->regs[reg]  = reg;
 848             info->rules[reg] = RULE_SAME;
 849             break;
 850         }
 851         case DW_CFA_register:
 852         {
 853             ULONG_PTR reg = dwarf_get_uleb128( &ptr );
 854             ULONG_PTR reg2 = dwarf_get_uleb128( &ptr );
 855             if (!valid_reg( reg ) || !valid_reg( reg2 )) break;
 856             TRACE( "%lx: DW_CFA_register %s == %s\n", info->ip, dwarf_reg_names[reg], dwarf_reg_names[reg2] );
 857             info->regs[reg]  = reg2;
 858             info->rules[reg] = RULE_OTHER_REG;
 859             break;
 860         }
 861         case DW_CFA_remember_state:
 862             FIXME( "%lx: DW_CFA_remember_state not implemented\n", info->ip );
 863             break;
 864         case DW_CFA_restore_state:
 865             FIXME( "%lx: DW_CFA_restore_state not implemented\n", info->ip );
 866             break;
 867         case DW_CFA_def_cfa:
 868         case DW_CFA_def_cfa_sf:
 869         {
 870             ULONG_PTR reg = dwarf_get_uleb128( &ptr );
 871             ULONG_PTR offset = (op == DW_CFA_def_cfa) ? dwarf_get_uleb128( &ptr )
 872                                                       : dwarf_get_sleb128( &ptr ) * info->data_align;
 873             if (!valid_reg( reg )) break;
 874             TRACE( "%lx: DW_CFA_def_cfa %s, %lu\n", info->ip, dwarf_reg_names[reg], offset );
 875             info->cfa_reg    = reg;
 876             info->cfa_offset = offset;
 877             info->cfa_rule   = RULE_CFA_OFFSET;
 878             break;
 879         }
 880         case DW_CFA_def_cfa_register:
 881         {
 882             ULONG_PTR reg = dwarf_get_uleb128( &ptr );
 883             if (!valid_reg( reg )) break;
 884             TRACE( "%lx: DW_CFA_def_cfa_register %s\n", info->ip, dwarf_reg_names[reg] );
 885             info->cfa_reg = reg;
 886             info->cfa_rule = RULE_CFA_OFFSET;
 887             break;
 888         }
 889         case DW_CFA_def_cfa_offset:
 890         case DW_CFA_def_cfa_offset_sf:
 891         {
 892             ULONG_PTR offset = (op == DW_CFA_def_cfa_offset) ? dwarf_get_uleb128( &ptr )
 893                                                              : dwarf_get_sleb128( &ptr ) * info->data_align;
 894             TRACE( "%lx: DW_CFA_def_cfa_offset %lu\n", info->ip, offset );
 895             info->cfa_offset = offset;
 896             info->cfa_rule = RULE_CFA_OFFSET;
 897             break;
 898         }
 899         case DW_CFA_def_cfa_expression:
 900         {
 901             ULONG_PTR expr = (ULONG_PTR)ptr;
 902             ULONG_PTR len = dwarf_get_uleb128( &ptr );
 903             TRACE( "%lx: DW_CFA_def_cfa_expression %lx-%lx\n", info->ip, expr, expr+len );
 904             info->cfa_offset = expr;
 905             info->cfa_rule = RULE_VAL_EXPRESSION;
 906             ptr += len;
 907             break;
 908         }
 909         case DW_CFA_expression:
 910         case DW_CFA_val_expression:
 911         {
 912             ULONG_PTR reg = dwarf_get_uleb128( &ptr );
 913             ULONG_PTR expr = (ULONG_PTR)ptr;
 914             ULONG_PTR len = dwarf_get_uleb128( &ptr );
 915             if (!valid_reg( reg )) break;
 916             TRACE( "%lx: DW_CFA_%sexpression %s %lx-%lx\n",
 917                    info->ip, (op == DW_CFA_expression) ? "" : "val_", dwarf_reg_names[reg], expr, expr+len );
 918             info->regs[reg]  = expr;
 919             info->rules[reg] = (op == DW_CFA_expression) ? RULE_EXPRESSION : RULE_VAL_EXPRESSION;
 920             ptr += len;
 921             break;
 922         }
 923         default:
 924             FIXME( "%lx: unknown CFA opcode %02x\n", info->ip, op );
 925             break;
 926         }
 927     }
 928 }
 929
 930 /* retrieve a context register from its dwarf number */
 931 static void *get_context_reg( CONTEXT *context, ULONG_PTR dw_reg )
 932 {
 933     switch (dw_reg)
 934     {
 935     case 0:  return &context->Rax;
 936     case 1:  return &context->Rdx;
 937     case 2:  return &context->Rcx;
 938     case 3:  return &context->Rbx;
 939     case 4:  return &context->Rsi;
 940     case 5:  return &context->Rdi;
 941     case 6:  return &context->Rbp;
 942     case 7:  return &context->Rsp;
 943     case 8:  return &context->R8;
 944     case 9:  return &context->R9;
 945     case 10: return &context->R10;
 946     case 11: return &context->R11;
 947     case 12: return &context->R12;
 948     case 13: return &context->R13;
 949     case 14: return &context->R14;
 950     case 15: return &context->R15;
 951     case 16: return &context->Rip;
 952     case 17: return &context->u.s.Xmm0;
 953     case 18: return &context->u.s.Xmm1;
 954     case 19: return &context->u.s.Xmm2;
 955     case 20: return &context->u.s.Xmm3;
 956     case 21: return &context->u.s.Xmm4;
 957     case 22: return &context->u.s.Xmm5;
 958     case 23: return &context->u.s.Xmm6;
 959     case 24: return &context->u.s.Xmm7;
 960     case 25: return &context->u.s.Xmm8;
 961     case 26: return &context->u.s.Xmm9;
 962     case 27: return &context->u.s.Xmm10;
 963     case 28: return &context->u.s.Xmm11;
 964     case 29: return &context->u.s.Xmm12;
 965     case 30: return &context->u.s.Xmm13;
 966     case 31: return &context->u.s.Xmm14;
 967     case 32: return &context->u.s.Xmm15;
 968     case 33: return &context->u.s.Legacy[0];
 969     case 34: return &context->u.s.Legacy[1];
 970     case 35: return &context->u.s.Legacy[2];
 971     case 36: return &context->u.s.Legacy[3];
 972     case 37: return &context->u.s.Legacy[4];
 973     case 38: return &context->u.s.Legacy[5];
 974     case 39: return &context->u.s.Legacy[6];
 975     case 40: return &context->u.s.Legacy[7];
 976     default: return NULL;
 977     }
 978 }
 979
 980 /* set a context register from its dwarf number */
 981 static void set_context_reg( CONTEXT *context, ULONG_PTR dw_reg, void *val )
 982 {
 983     switch (dw_reg)
 984     {
 985     case 0:  context->Rax = *(ULONG64 *)val; break;
 986     case 1:  context->Rdx = *(ULONG64 *)val; break;
 987     case 2:  context->Rcx = *(ULONG64 *)val; break;
 988     case 3:  context->Rbx = *(ULONG64 *)val; break;
 989     case 4:  context->Rsi = *(ULONG64 *)val; break;
 990     case 5:  context->Rdi = *(ULONG64 *)val; break;
 991     case 6:  context->Rbp = *(ULONG64 *)val; break;
 992     case 7:  context->Rsp = *(ULONG64 *)val; break;
 993     case 8:  context->R8  = *(ULONG64 *)val; break;
 994     case 9:  context->R9  = *(ULONG64 *)val; break;
 995     case 10: context->R10 = *(ULONG64 *)val; break;
 996     case 11: context->R11 = *(ULONG64 *)val; break;
 997     case 12: context->R12 = *(ULONG64 *)val; break;
 998     case 13: context->R13 = *(ULONG64 *)val; break;
 999     case 14: context->R14 = *(ULONG64 *)val; break;
1000     case 15: context->R15 = *(ULONG64 *)val; break;
1001     case 16: context->Rip = *(ULONG64 *)val; break;
1002     case 17: context->u.s.Xmm0  = *(M128A *)val; break;
1003     case 18: context->u.s.Xmm1  = *(M128A *)val; break;
1004     case 19: context->u.s.Xmm2  = *(M128A *)val; break;
1005     case 20: context->u.s.Xmm3  = *(M128A *)val; break;
1006     case 21: context->u.s.Xmm4  = *(M128A *)val; break;
1007     case 22: context->u.s.Xmm5  = *(M128A *)val; break;
1008     case 23: context->u.s.Xmm6  = *(M128A *)val; break;
1009     case 24: context->u.s.Xmm7  = *(M128A *)val; break;
1010     case 25: context->u.s.Xmm8  = *(M128A *)val; break;
1011     case 26: context->u.s.Xmm9  = *(M128A *)val; break;
1012     case 27: context->u.s.Xmm10 = *(M128A *)val; break;
1013     case 28: context->u.s.Xmm11 = *(M128A *)val; break;
1014     case 29: context->u.s.Xmm12 = *(M128A *)val; break;
1015     case 30: context->u.s.Xmm13 = *(M128A *)val; break;
1016     case 31: context->u.s.Xmm14 = *(M128A *)val; break;
1017     case 32: context->u.s.Xmm15 = *(M128A *)val; break;
1018     case 33: context->u.s.Legacy[0] = *(M128A *)val; break;
1019     case 34: context->u.s.Legacy[1] = *(M128A *)val; break;
1020     case 35: context->u.s.Legacy[2] = *(M128A *)val; break;
1021     case 36: context->u.s.Legacy[3] = *(M128A *)val; break;
1022     case 37: context->u.s.Legacy[4] = *(M128A *)val; break;
1023     case 38: context->u.s.Legacy[5] = *(M128A *)val; break;
1024     case 39: context->u.s.Legacy[6] = *(M128A *)val; break;
1025     case 40: context->u.s.Legacy[7] = *(M128A *)val; break;
1026     }
1027 }
1028
1029 static ULONG_PTR eval_expression( const unsigned char *p, CONTEXT *context )
1030 {
1031     ULONG_PTR reg, tmp, stack[64];
1032     int sp = -1;
1033     ULONG_PTR len = dwarf_get_uleb128(&p);
1034     const unsigned char *end = p + len;
1035
1036     while (p < end)
1037     {
1038         unsigned char opcode = dwarf_get_u1(&p);
1039
1040         if (opcode >= DW_OP_lit0 && opcode <= DW_OP_lit31)
1041             stack[++sp] = opcode - DW_OP_lit0;
1042         else if (opcode >= DW_OP_reg0 && opcode <= DW_OP_reg31)
1043             stack[++sp] = *(ULONG_PTR *)get_context_reg( context, opcode - DW_OP_reg0 );
1044         else if (opcode >= DW_OP_breg0 && opcode <= DW_OP_breg31)
1045             stack[++sp] = *(ULONG_PTR *)get_context_reg( context, opcode - DW_OP_breg0 ) + dwarf_get_sleb128(&p);
1046         else switch (opcode)
1047         {
1048         case DW_OP_nop:         break;
1049         case DW_OP_addr:        stack[++sp] = dwarf_get_u8(&p); break;
1050         case DW_OP_const1u:     stack[++sp] = dwarf_get_u1(&p); break;
1051         case DW_OP_const1s:     stack[++sp] = (signed char)dwarf_get_u1(&p); break;
1052         case DW_OP_const2u:     stack[++sp] = dwarf_get_u2(&p); break;
1053         case DW_OP_const2s:     stack[++sp] = (short)dwarf_get_u2(&p); break;
1054         case DW_OP_const4u:     stack[++sp] = dwarf_get_u4(&p); break;
1055         case DW_OP_const4s:     stack[++sp] = (signed int)dwarf_get_u4(&p); break;
1056         case DW_OP_const8u:     stack[++sp] = dwarf_get_u8(&p); break;
1057         case DW_OP_const8s:     stack[++sp] = (LONG_PTR)dwarf_get_u8(&p); break;
1058         case DW_OP_constu:      stack[++sp] = dwarf_get_uleb128(&p); break;
1059         case DW_OP_consts:      stack[++sp] = dwarf_get_sleb128(&p); break;
1060         case DW_OP_deref:       stack[sp] = *(ULONG_PTR *)stack[sp]; break;
1061         case DW_OP_dup:         stack[sp + 1] = stack[sp]; sp++; break;
1062         case DW_OP_drop:        sp--; break;
1063         case DW_OP_over:        stack[sp + 1] = stack[sp - 1]; sp++; break;
1064         case DW_OP_pick:        stack[sp + 1] = stack[sp - dwarf_get_u1(&p)]; sp++; break;
1065         case DW_OP_swap:        tmp = stack[sp]; stack[sp] = stack[sp-1]; stack[sp-1] = tmp; break;
1066         case DW_OP_rot:         tmp = stack[sp]; stack[sp] = stack[sp-1]; stack[sp-1] = stack[sp-2]; stack[sp-2] = tmp; break;
1067         case DW_OP_abs:         stack[sp] = labs(stack[sp]); break;
1068         case DW_OP_neg:         stack[sp] = -stack[sp]; break;
1069         case DW_OP_not:         stack[sp] = ~stack[sp]; break;
1070         case DW_OP_and:         stack[sp-1] &= stack[sp]; sp--; break;
1071         case DW_OP_or:          stack[sp-1] |= stack[sp]; sp--; break;
1072         case DW_OP_minus:       stack[sp-1] -= stack[sp]; sp--; break;
1073         case DW_OP_mul:         stack[sp-1] *= stack[sp]; sp--; break;
1074         case DW_OP_plus:        stack[sp-1] += stack[sp]; sp--; break;
1075         case DW_OP_xor:         stack[sp-1] ^= stack[sp]; sp--; break;
1076         case DW_OP_shl:         stack[sp-1] <<= stack[sp]; sp--; break;
1077         case DW_OP_shr:         stack[sp-1] >>= stack[sp]; sp--; break;
1078         case DW_OP_plus_uconst: stack[sp] += dwarf_get_uleb128(&p); break;
1079         case DW_OP_shra:        stack[sp-1] = (LONG_PTR)stack[sp-1] / (1 << stack[sp]); sp--; break;
1080         case DW_OP_div:         stack[sp-1] = (LONG_PTR)stack[sp-1] / (LONG_PTR)stack[sp]; sp--; break;
1081         case DW_OP_mod:         stack[sp-1] = (LONG_PTR)stack[sp-1] % (LONG_PTR)stack[sp]; sp--; break;
1082         case DW_OP_ge:          stack[sp-1] = ((LONG_PTR)stack[sp-1] >= (LONG_PTR)stack[sp]); sp--; break;
1083         case DW_OP_gt:          stack[sp-1] = ((LONG_PTR)stack[sp-1] >  (LONG_PTR)stack[sp]); sp--; break;
1084         case DW_OP_le:          stack[sp-1] = ((LONG_PTR)stack[sp-1] <= (LONG_PTR)stack[sp]); sp--; break;
1085         case DW_OP_lt:          stack[sp-1] = ((LONG_PTR)stack[sp-1] <  (LONG_PTR)stack[sp]); sp--; break;
1086         case DW_OP_eq:          stack[sp-1] = (stack[sp-1] == stack[sp]); sp--; break;
1087         case DW_OP_ne:          stack[sp-1] = (stack[sp-1] != stack[sp]); sp--; break;
1088         case DW_OP_skip:        tmp = (short)dwarf_get_u2(&p); p += tmp; break;
1089         case DW_OP_bra:         tmp = (short)dwarf_get_u2(&p); if (!stack[sp--]) p += tmp; break;
1090         case DW_OP_GNU_encoded_addr: tmp = *p++; stack[++sp] = dwarf_get_ptr( &p, tmp ); break;
1091         case DW_OP_regx:        stack[++sp] = *(ULONG_PTR *)get_context_reg( context, dwarf_get_uleb128(&p) ); break;
1092         case DW_OP_bregx:
1093             reg = dwarf_get_uleb128(&p);
1094             tmp = dwarf_get_sleb128(&p);
1095             stack[++sp] = *(ULONG_PTR *)get_context_reg( context, reg ) + tmp;
1096             break;
1097         case DW_OP_deref_size:
1098             switch (*p++)
1099             {
1100             case 1: stack[sp] = *(unsigned char *)stack[sp]; break;
1101             case 2: stack[sp] = *(unsigned short *)stack[sp]; break;
1102             case 4: stack[sp] = *(unsigned int *)stack[sp]; break;
1103             case 8: stack[sp] = *(ULONG_PTR *)stack[sp]; break;
1104             }
1105             break;
1106         default:
1107             FIXME( "unhandled opcode %02x\n", opcode );
1108         }
1109     }
1110     return stack[sp];
1111 }
1112
1113 /* apply the computed frame info to the actual context */
1114 static void apply_frame_info( CONTEXT *context, struct frame_info *info )
1115 {
1116     unsigned int i;
1117     ULONG_PTR cfa, value;
1118     CONTEXT new_context = *context;
1119
1120     switch (info->cfa_rule)
1121     {
1122     case RULE_EXPRESSION:
1123         cfa = *(ULONG_PTR *)eval_expression( (const unsigned char *)info->cfa_offset, context );
1124         break;
1125     case RULE_VAL_EXPRESSION:
1126         cfa = eval_expression( (const unsigned char *)info->cfa_offset, context );
1127         break;
1128     default:
1129         cfa = *(ULONG_PTR *)get_context_reg( context, info->cfa_reg ) + info->cfa_offset;
1130         break;
1131     }
1132     if (!cfa) return;
1133
1134     for (i = 0; i < NB_FRAME_REGS; i++)
1135     {
1136         switch (info->rules[i])
1137         {
1138         case RULE_UNSET:
1139         case RULE_UNDEFINED:
1140         case RULE_SAME:
1141             break;
1142         case RULE_CFA_OFFSET:
1143             set_context_reg( &new_context, i, (char *)cfa + info->regs[i] );
1144             break;
1145         case RULE_OTHER_REG:
1146             set_context_reg( &new_context, i, get_context_reg( context, info->regs[i] ));
1147             break;
1148         case RULE_EXPRESSION:
1149             value = eval_expression( (const unsigned char *)info->regs[i], context );
1150             set_context_reg( &new_context, i, (void *)value );
1151             break;
1152         case RULE_VAL_EXPRESSION:
1153             value = eval_expression( (const unsigned char *)info->regs[i], context );
1154             set_context_reg( &new_context, i, &value );
1155             break;
1156         }
1157     }
1158     new_context.Rsp = cfa;
1159     *context = new_context;
1160 }
1161
1162
1163 /***********************************************************************
1164  *           dwarf_virtual_unwind
1165  *
1166  * Equivalent of RtlVirtualUnwind for builtin modules.
1167  */
1168 static NTSTATUS dwarf_virtual_unwind( ULONG64 ip, ULONG64 *frame,CONTEXT *context,
1169                                       const struct dwarf_fde *fde, const struct dwarf_eh_bases *bases,
1170                                       PEXCEPTION_ROUTINE *handler, void **handler_data )
1171 {
1172     const struct dwarf_cie *cie;
1173     const unsigned char *ptr, *augmentation, *end;
1174     ULONG_PTR len, code_end;
1175     struct frame_info info;
1176     int aug_z_format = 0;
1177     unsigned char lsda_encoding = DW_EH_PE_omit;
1178
1179     memset( &info, 0, sizeof(info) );
1180     info.ip = (ULONG_PTR)bases->func;
1181     *handler = NULL;
1182
1183     cie = (const struct dwarf_cie *)((const char *)&fde->cie_offset - fde->cie_offset);
1184
1185     /* parse the CIE first */
1186
1187     if (cie->version != 1)
1188     {
1189         FIXME( "unknown CIE version %u at %p\n", cie->version, cie );
1190         return STATUS_INVALID_DISPOSITION;
1191     }
1192     ptr = cie->augmentation + strlen((const char *)cie->augmentation) + 1;
1193
1194     info.code_align = dwarf_get_uleb128( &ptr );
1195     info.data_align = dwarf_get_sleb128( &ptr );
1196     info.retaddr_reg = *ptr++;
1197     info.cfa_rule = RULE_CFA_OFFSET;
1198
1199     TRACE( "function %lx base %p cie %p len %x id %x version %x aug '%s' code_align %lu data_align %ld retaddr %s\n",
1200            ip, bases->func, cie, cie->length, cie->id, cie->version, cie->augmentation,
1201            info.code_align, info.data_align, dwarf_reg_names[info.retaddr_reg] );
1202
1203     end = NULL;
1204     for (augmentation = cie->augmentation; *augmentation; augmentation++)
1205     {
1206         switch (*augmentation)
1207         {
1208         case 'z':
1209             len = dwarf_get_uleb128( &ptr );
1210             end = ptr + len;
1211             aug_z_format = 1;
1212             continue;
1213         case 'L':
1214             lsda_encoding = *ptr++;
1215             continue;
1216         case 'P':
1217         {
1218             unsigned char encoding = *ptr++;
1219             *handler = (void *)dwarf_get_ptr( &ptr, encoding );
1220             continue;
1221         }
1222         case 'R':
1223             info.fde_encoding = *ptr++;
1224             continue;
1225         case 'S':
1226             info.signal_frame = 1;
1227             continue;
1228         }
1229         FIXME( "unknown augmentation '%c'\n", *augmentation );
1230         if (!end) return STATUS_INVALID_DISPOSITION;  /* cannot continue */
1231         break;
1232     }
1233     if (end) ptr = end;
1234
1235     end = (const unsigned char *)(&cie->length + 1) + cie->length;
1236     execute_cfa_instructions( ptr, end, ip, &info );
1237
1238     ptr = (const unsigned char *)(fde + 1);
1239     info.ip = dwarf_get_ptr( &ptr, info.fde_encoding );  /* fde code start */
1240     code_end = info.ip + dwarf_get_ptr( &ptr, info.fde_encoding & 0x0f );  /* fde code length */
1241
1242     if (aug_z_format)  /* get length of augmentation data */
1243     {
1244         len = dwarf_get_uleb128( &ptr );
1245         end = ptr + len;
1246     }
1247     else end = NULL;
1248
1249     *handler_data = (void *)dwarf_get_ptr( &ptr, lsda_encoding );
1250     if (end) ptr = end;
1251
1252     end = (const unsigned char *)(&fde->length + 1) + fde->length;
1253     TRACE( "fde %p len %x personality %p lsda %p code %lx-%lx\n",
1254            fde, fde->length, *handler, *handler_data, info.ip, code_end );
1255     execute_cfa_instructions( ptr, end, ip, &info );
1256     apply_frame_info( context, &info );
1257     *frame = context->Rsp;
1258
1259     TRACE( "next function rip=%016lx\n", context->Rip );
1260     TRACE( "  rax=%016lx rbx=%016lx rcx=%016lx rdx=%016lx\n",
1261            context->Rax, context->Rbx, context->Rcx, context->Rdx );
1262     TRACE( "  rsi=%016lx rdi=%016lx rbp=%016lx rsp=%016lx\n",
1263            context->Rsi, context->Rdi, context->Rbp, context->Rsp );
1264     TRACE( "   r8=%016lx  r9=%016lx r10=%016lx r11=%016lx\n",
1265            context->R8, context->R9, context->R10, context->R11 );
1266     TRACE( "  r12=%016lx r13=%016lx r14=%016lx r15=%016lx\n",
1267            context->R12, context->R13, context->R14, context->R15 );
1268
1269     return STATUS_SUCCESS;
1270 }
1271
1272
1273 /***********************************************************************
1274  *           dispatch_signal
1275  */
1276 static inline int dispatch_signal(unsigned int sig)
1277 {
1278     if (handlers[sig] == NULL) return 0;
1279     return handlers[sig](sig);
1280 }
1281
1282 /***********************************************************************
1283  *           get_signal_stack
1284  *
1285  * Get the base of the signal stack for the current thread.
1286  */
1287 static inline void *get_signal_stack(void)
1288 {
1289     return (char *)NtCurrentTeb() + teb_size;
1290 }
1291
1292 /***********************************************************************
1293  *           is_inside_signal_stack
1294  *
1295  * Check if pointer is inside the signal stack.
1296  */
1297 static inline int is_inside_signal_stack( void *ptr )
1298 {
1299     return ((char *)ptr >= (char *)get_signal_stack() &&
1300             (char *)ptr < (char *)get_signal_stack() + signal_stack_size);
1301 }
1302
1303 /***********************************************************************
1304  *           save_context
1305  *
1306  * Set the register values from a sigcontext.
1307  */
1308 static void save_context( CONTEXT *context, const ucontext_t *sigcontext )
1309 {
1310     context->ContextFlags = CONTEXT_CONTROL | CONTEXT_INTEGER | CONTEXT_SEGMENTS;
1311     context->Rax    = RAX_sig(sigcontext);
1312     context->Rcx    = RCX_sig(sigcontext);
1313     context->Rdx    = RDX_sig(sigcontext);
1314     context->Rbx    = RBX_sig(sigcontext);
1315     context->Rsp    = RSP_sig(sigcontext);
1316     context->Rbp    = RBP_sig(sigcontext);
1317     context->Rsi    = RSI_sig(sigcontext);
1318     context->Rdi    = RDI_sig(sigcontext);
1319     context->R8     = R8_sig(sigcontext);
1320     context->R9     = R9_sig(sigcontext);
1321     context->R10    = R10_sig(sigcontext);
1322     context->R11    = R11_sig(sigcontext);
1323     context->R12    = R12_sig(sigcontext);
1324     context->R13    = R13_sig(sigcontext);
1325     context->R14    = R14_sig(sigcontext);
1326     context->R15    = R15_sig(sigcontext);
1327     context->Rip    = RIP_sig(sigcontext);
1328     context->SegCs  = CS_sig(sigcontext);
1329     context->SegFs  = FS_sig(sigcontext);
1330     context->SegGs  = GS_sig(sigcontext);
1331     context->EFlags = EFL_sig(sigcontext);
1332 #ifdef DS_sig
1333     context->SegDs  = DS_sig(sigcontext);
1334 #else
1335     __asm__("movw %%ds,%0" : "=m" (context->SegDs));
1336 #endif
1337 #ifdef ES_sig
1338     context->SegEs  = ES_sig(sigcontext);
1339 #else
1340     __asm__("movw %%es,%0" : "=m" (context->SegEs));
1341 #endif
1342 #ifdef SS_sig
1343     context->SegSs  = SS_sig(sigcontext);
1344 #else
1345     __asm__("movw %%ss,%0" : "=m" (context->SegSs));
1346 #endif
1347     if (FPU_sig(sigcontext))
1348     {
1349         context->ContextFlags |= CONTEXT_FLOATING_POINT;
1350         context->u.FltSave = *FPU_sig(sigcontext);
1351         context->MxCsr = context->u.FltSave.MxCsr;
1352     }
1353 }
1354
1355
1356 /***********************************************************************
1357  *           restore_context
1358  *
1359  * Build a sigcontext from the register values.
1360  */
1361 static void restore_context( const CONTEXT *context, ucontext_t *sigcontext )
1362 {
1363     RAX_sig(sigcontext) = context->Rax;
1364     RCX_sig(sigcontext) = context->Rcx;
1365     RDX_sig(sigcontext) = context->Rdx;
1366     RBX_sig(sigcontext) = context->Rbx;
1367     RSP_sig(sigcontext) = context->Rsp;
1368     RBP_sig(sigcontext) = context->Rbp;
1369     RSI_sig(sigcontext) = context->Rsi;
1370     RDI_sig(sigcontext) = context->Rdi;
1371     R8_sig(sigcontext)  = context->R8;
1372     R9_sig(sigcontext)  = context->R9;
1373     R10_sig(sigcontext) = context->R10;
1374     R11_sig(sigcontext) = context->R11;
1375     R12_sig(sigcontext) = context->R12;
1376     R13_sig(sigcontext) = context->R13;
1377     R14_sig(sigcontext) = context->R14;
1378     R15_sig(sigcontext) = context->R15;
1379     RIP_sig(sigcontext) = context->Rip;
1380     CS_sig(sigcontext)  = context->SegCs;
1381     FS_sig(sigcontext)  = context->SegFs;
1382     GS_sig(sigcontext)  = context->SegGs;
1383     EFL_sig(sigcontext) = context->EFlags;
1384 #ifdef DS_sig
1385     DS_sig(sigcontext) = context->SegDs;
1386 #endif
1387 #ifdef ES_sig
1388     ES_sig(sigcontext) = context->SegEs;
1389 #endif
1390 #ifdef SS_sig
1391     SS_sig(sigcontext) = context->SegSs;
1392 #endif
1393     if (FPU_sig(sigcontext)) *FPU_sig(sigcontext) = context->u.FltSave;
1394 }
1395
1396
1397 /***********************************************************************
1398  *              RtlCaptureContext (NTDLL.@)
1399  */
1400 void WINAPI __regs_RtlCaptureContext( CONTEXT *context, CONTEXT *regs )
1401 {
1402     *context = *regs;
1403 }
1404 DEFINE_REGS_ENTRYPOINT( RtlCaptureContext, 1 )
1405
1406
1407 /***********************************************************************
1408  *           set_cpu_context
1409  *
1410  * Set the new CPU context.
1411  */
1412 void set_cpu_context( const CONTEXT *context )
1413 {
1414     extern void CDECL __wine_restore_regs( const CONTEXT * ) DECLSPEC_NORETURN;
1415     __wine_restore_regs( context );
1416 }
1417
1418
1419 /***********************************************************************
1420  *           copy_context
1421  *
1422  * Copy a register context according to the flags.
1423  */
1424 void copy_context( CONTEXT *to, const CONTEXT *from, DWORD flags )
1425 {
1426     flags &= ~CONTEXT_AMD64;  /* get rid of CPU id */
1427     if (flags & CONTEXT_CONTROL)
1428     {
1429         to->Rbp    = from->Rbp;
1430         to->Rip    = from->Rip;
1431         to->Rsp    = from->Rsp;
1432         to->SegCs  = from->SegCs;
1433         to->SegSs  = from->SegSs;
1434         to->EFlags = from->EFlags;
1435     }
1436     if (flags & CONTEXT_INTEGER)
1437     {
1438         to->Rax = from->Rax;
1439         to->Rcx = from->Rcx;
1440         to->Rdx = from->Rdx;
1441         to->Rbx = from->Rbx;
1442         to->Rsi = from->Rsi;
1443         to->Rdi = from->Rdi;
1444         to->R8  = from->R8;
1445         to->R9  = from->R9;
1446         to->R10 = from->R10;
1447         to->R11 = from->R11;
1448         to->R12 = from->R12;
1449         to->R13 = from->R13;
1450         to->R14 = from->R14;
1451         to->R15 = from->R15;
1452     }
1453     if (flags & CONTEXT_SEGMENTS)
1454     {
1455         to->SegDs = from->SegDs;
1456         to->SegEs = from->SegEs;
1457         to->SegFs = from->SegFs;
1458         to->SegGs = from->SegGs;
1459     }
1460     if (flags & CONTEXT_FLOATING_POINT)
1461     {
1462         to->MxCsr = from->MxCsr;
1463         to->u.FltSave = from->u.FltSave;
1464     }
1465     if (flags & CONTEXT_DEBUG_REGISTERS)
1466     {
1467         to->Dr0 = from->Dr0;
1468         to->Dr1 = from->Dr1;
1469         to->Dr2 = from->Dr2;
1470         to->Dr3 = from->Dr3;
1471         to->Dr6 = from->Dr6;
1472         to->Dr7 = from->Dr7;
1473     }
1474 }
1475
1476
1477 /***********************************************************************
1478  *           context_to_server
1479  *
1480  * Convert a register context to the server format.
1481  */
1482 NTSTATUS context_to_server( context_t *to, const CONTEXT *from )
1483 {
1484     DWORD flags = from->ContextFlags & ~CONTEXT_AMD64;  /* get rid of CPU id */
1485
1486     memset( to, 0, sizeof(*to) );
1487     to->cpu = CPU_x86_64;
1488
1489     if (flags & CONTEXT_CONTROL)
1490     {
1491         to->flags |= SERVER_CTX_CONTROL;
1492         to->ctl.x86_64_regs.rbp   = from->Rbp;
1493         to->ctl.x86_64_regs.rip   = from->Rip;
1494         to->ctl.x86_64_regs.rsp   = from->Rsp;
1495         to->ctl.x86_64_regs.cs    = from->SegCs;
1496         to->ctl.x86_64_regs.ss    = from->SegSs;
1497         to->ctl.x86_64_regs.flags = from->EFlags;
1498     }
1499     if (flags & CONTEXT_INTEGER)
1500     {
1501         to->flags |= SERVER_CTX_INTEGER;
1502         to->integer.x86_64_regs.rax = from->Rax;
1503         to->integer.x86_64_regs.rcx = from->Rcx;
1504         to->integer.x86_64_regs.rdx = from->Rdx;
1505         to->integer.x86_64_regs.rbx = from->Rbx;
1506         to->integer.x86_64_regs.rsi = from->Rsi;
1507         to->integer.x86_64_regs.rdi = from->Rdi;
1508         to->integer.x86_64_regs.r8  = from->R8;
1509         to->integer.x86_64_regs.r9  = from->R9;
1510         to->integer.x86_64_regs.r10 = from->R10;
1511         to->integer.x86_64_regs.r11 = from->R11;
1512         to->integer.x86_64_regs.r12 = from->R12;
1513         to->integer.x86_64_regs.r13 = from->R13;
1514         to->integer.x86_64_regs.r14 = from->R14;
1515         to->integer.x86_64_regs.r15 = from->R15;
1516     }
1517     if (flags & CONTEXT_SEGMENTS)
1518     {
1519         to->flags |= SERVER_CTX_SEGMENTS;
1520         to->seg.x86_64_regs.ds = from->SegDs;
1521         to->seg.x86_64_regs.es = from->SegEs;
1522         to->seg.x86_64_regs.fs = from->SegFs;
1523         to->seg.x86_64_regs.gs = from->SegGs;
1524     }
1525     if (flags & CONTEXT_FLOATING_POINT)
1526     {
1527         to->flags |= SERVER_CTX_FLOATING_POINT;
1528         memcpy( to->fp.x86_64_regs.fpregs, &from->u.FltSave, sizeof(to->fp.x86_64_regs.fpregs) );
1529     }
1530     if (flags & CONTEXT_DEBUG_REGISTERS)
1531     {
1532         to->flags |= SERVER_CTX_DEBUG_REGISTERS;
1533         to->debug.x86_64_regs.dr0 = from->Dr0;
1534         to->debug.x86_64_regs.dr1 = from->Dr1;
1535         to->debug.x86_64_regs.dr2 = from->Dr2;
1536         to->debug.x86_64_regs.dr3 = from->Dr3;
1537         to->debug.x86_64_regs.dr6 = from->Dr6;
1538         to->debug.x86_64_regs.dr7 = from->Dr7;
1539     }
1540     return STATUS_SUCCESS;
1541 }
1542
1543
1544 /***********************************************************************
1545  *           context_from_server
1546  *
1547  * Convert a register context from the server format.
1548  */
1549 NTSTATUS context_from_server( CONTEXT *to, const context_t *from )
1550 {
1551     if (from->cpu != CPU_x86_64) return STATUS_INVALID_PARAMETER;
1552
1553     to->ContextFlags = CONTEXT_AMD64;
1554     if (from->flags & SERVER_CTX_CONTROL)
1555     {
1556         to->ContextFlags |= CONTEXT_CONTROL;
1557         to->Rbp    = from->ctl.x86_64_regs.rbp;
1558         to->Rip    = from->ctl.x86_64_regs.rip;
1559         to->Rsp    = from->ctl.x86_64_regs.rsp;
1560         to->SegCs  = from->ctl.x86_64_regs.cs;
1561         to->SegSs  = from->ctl.x86_64_regs.ss;
1562         to->EFlags = from->ctl.x86_64_regs.flags;
1563     }
1564
1565     if (from->flags & SERVER_CTX_INTEGER)
1566     {
1567         to->ContextFlags |= CONTEXT_INTEGER;
1568         to->Rax = from->integer.x86_64_regs.rax;
1569         to->Rcx = from->integer.x86_64_regs.rcx;
1570         to->Rdx = from->integer.x86_64_regs.rdx;
1571         to->Rbx = from->integer.x86_64_regs.rbx;
1572         to->Rsi = from->integer.x86_64_regs.rsi;
1573         to->Rdi = from->integer.x86_64_regs.rdi;
1574         to->R8  = from->integer.x86_64_regs.r8;
1575         to->R9  = from->integer.x86_64_regs.r9;
1576         to->R10 = from->integer.x86_64_regs.r10;
1577         to->R11 = from->integer.x86_64_regs.r11;
1578         to->R12 = from->integer.x86_64_regs.r12;
1579         to->R13 = from->integer.x86_64_regs.r13;
1580         to->R14 = from->integer.x86_64_regs.r14;
1581         to->R15 = from->integer.x86_64_regs.r15;
1582     }
1583     if (from->flags & SERVER_CTX_SEGMENTS)
1584     {
1585         to->ContextFlags |= CONTEXT_SEGMENTS;
1586         to->SegDs = from->seg.x86_64_regs.ds;
1587         to->SegEs = from->seg.x86_64_regs.es;
1588         to->SegFs = from->seg.x86_64_regs.fs;
1589         to->SegGs = from->seg.x86_64_regs.gs;
1590     }
1591     if (from->flags & SERVER_CTX_FLOATING_POINT)
1592     {
1593         to->ContextFlags |= CONTEXT_FLOATING_POINT;
1594         memcpy( &to->u.FltSave, from->fp.x86_64_regs.fpregs, sizeof(from->fp.x86_64_regs.fpregs) );
1595         to->MxCsr = to->u.FltSave.MxCsr;
1596     }
1597     if (from->flags & SERVER_CTX_DEBUG_REGISTERS)
1598     {
1599         to->ContextFlags |= CONTEXT_DEBUG_REGISTERS;
1600         to->Dr0 = from->debug.x86_64_regs.dr0;
1601         to->Dr1 = from->debug.x86_64_regs.dr1;
1602         to->Dr2 = from->debug.x86_64_regs.dr2;
1603         to->Dr3 = from->debug.x86_64_regs.dr3;
1604         to->Dr6 = from->debug.x86_64_regs.dr6;
1605         to->Dr7 = from->debug.x86_64_regs.dr7;
1606     }
1607     return STATUS_SUCCESS;
1608 }
1609
1610
1611 extern void raise_func_trampoline( EXCEPTION_RECORD *rec, CONTEXT *context, raise_func func );
1612 __ASM_GLOBAL_FUNC( raise_func_trampoline,
1613                    __ASM_CFI(".cfi_signal_frame\n\t")
1614                    __ASM_CFI(".cfi_def_cfa %rbp,144\n\t")  /* red zone + rip + rbp */
1615                    __ASM_CFI(".cfi_rel_offset %rip,8\n\t")
1616                    __ASM_CFI(".cfi_rel_offset %rbp,0\n\t")
1617                    "call *%rdx\n\t"
1618                    "int $3")
1619
1620 /***********************************************************************
1621  *           setup_exception
1622  *
1623  * Setup a proper stack frame for the raise function, and modify the
1624  * sigcontext so that the return from the signal handler will call
1625  * the raise function.
1626  */
1627 static EXCEPTION_RECORD *setup_exception( ucontext_t *sigcontext, raise_func func )
1628 {
1629     struct stack_layout
1630     {
1631         CONTEXT           context;
1632         EXCEPTION_RECORD  rec;
1633         ULONG64           rbp;
1634         ULONG64           rip;
1635         ULONG64           red_zone[16];
1636     } *stack;
1637     ULONG64 *rsp_ptr;
1638     DWORD exception_code = 0;
1639
1640     stack = (struct stack_layout *)(RSP_sig(sigcontext) & ~15);
1641
1642     /* stack sanity checks */
1643
1644     if (is_inside_signal_stack( stack ))
1645     {
1646         ERR( "nested exception on signal stack in thread %04x eip %016lx esp %016lx stack %p-%p\n",
1647              GetCurrentThreadId(), RIP_sig(sigcontext), RSP_sig(sigcontext),
1648              NtCurrentTeb()->Tib.StackLimit, NtCurrentTeb()->Tib.StackBase );
1649         abort_thread(1);
1650     }
1651
1652     if (stack - 1 > stack || /* check for overflow in subtraction */
1653         (char *)stack <= (char *)NtCurrentTeb()->DeallocationStack ||
1654         (char *)stack > (char *)NtCurrentTeb()->Tib.StackBase)
1655     {
1656         WARN( "exception outside of stack limits in thread %04x eip %016lx esp %016lx stack %p-%p\n",
1657               GetCurrentThreadId(), RIP_sig(sigcontext), RSP_sig(sigcontext),
1658               NtCurrentTeb()->Tib.StackLimit, NtCurrentTeb()->Tib.StackBase );
1659     }
1660     else if ((char *)(stack - 1) < (char *)NtCurrentTeb()->DeallocationStack + 4096)
1661     {
1662         /* stack overflow on last page, unrecoverable */
1663         UINT diff = (char *)NtCurrentTeb()->DeallocationStack + 4096 - (char *)(stack - 1);
1664         ERR( "stack overflow %u bytes in thread %04x eip %016lx esp %016lx stack %p-%p-%p\n",
1665              diff, GetCurrentThreadId(), RIP_sig(sigcontext),
1666              RSP_sig(sigcontext), NtCurrentTeb()->DeallocationStack,
1667              NtCurrentTeb()->Tib.StackLimit, NtCurrentTeb()->Tib.StackBase );
1668         abort_thread(1);
1669     }
1670     else if ((char *)(stack - 1) < (char *)NtCurrentTeb()->Tib.StackLimit)
1671     {
1672         /* stack access below stack limit, may be recoverable */
1673         if (virtual_handle_stack_fault( stack - 1 )) exception_code = EXCEPTION_STACK_OVERFLOW;
1674         else
1675         {
1676             UINT diff = (char *)NtCurrentTeb()->Tib.StackLimit - (char *)(stack - 1);
1677             ERR( "stack overflow %u bytes in thread %04x eip %016lx esp %016lx stack %p-%p-%p\n",
1678                  diff, GetCurrentThreadId(), RIP_sig(sigcontext),
1679                  RSP_sig(sigcontext), NtCurrentTeb()->DeallocationStack,
1680                  NtCurrentTeb()->Tib.StackLimit, NtCurrentTeb()->Tib.StackBase );
1681             abort_thread(1);
1682         }
1683     }
1684
1685     stack--;  /* push the stack_layout structure */
1686 #if defined(VALGRIND_MAKE_MEM_UNDEFINED)
1687     VALGRIND_MAKE_MEM_UNDEFINED(stack, sizeof(*stack));
1688 #elif defined(VALGRIND_MAKE_WRITABLE)
1689     VALGRIND_MAKE_WRITABLE(stack, sizeof(*stack));
1690 #endif
1691     stack->rec.ExceptionRecord  = NULL;
1692     stack->rec.ExceptionCode    = exception_code;
1693     stack->rec.ExceptionFlags   = EXCEPTION_CONTINUABLE;
1694     stack->rec.ExceptionAddress = (void *)RIP_sig(sigcontext);
1695     stack->rec.NumberParameters = 0;
1696     save_context( &stack->context, sigcontext );
1697
1698     /* store return address and %rbp without aligning, so that the offset is fixed */
1699     rsp_ptr = (ULONG64 *)RSP_sig(sigcontext) - 16;
1700     *(--rsp_ptr) = RIP_sig(sigcontext);
1701     *(--rsp_ptr) = RBP_sig(sigcontext);
1702
1703     /* now modify the sigcontext to return to the raise function */
1704     RIP_sig(sigcontext) = (ULONG_PTR)raise_func_trampoline;
1705     RDI_sig(sigcontext) = (ULONG_PTR)&stack->rec;
1706     RSI_sig(sigcontext) = (ULONG_PTR)&stack->context;
1707     RDX_sig(sigcontext) = (ULONG_PTR)func;
1708     RBP_sig(sigcontext) = (ULONG_PTR)rsp_ptr;
1709     RSP_sig(sigcontext) = (ULONG_PTR)stack;
1710     /* clear single-step, direction, and align check flag */
1711     EFL_sig(sigcontext) &= ~(0x100|0x400|0x40000);
1712
1713     return &stack->rec;
1714 }
1715
1716
1717 /**********************************************************************
1718  *           find_function_info
1719  */
1720 static RUNTIME_FUNCTION *find_function_info( ULONG64 pc, HMODULE module,
1721                                              RUNTIME_FUNCTION *func, ULONG size )
1722 {
1723     int min = 0;
1724     int max = size/sizeof(*func) - 1;
1725
1726     while (min <= max)
1727     {
1728         int pos = (min + max) / 2;
1729         if ((char *)pc < (char *)module + func[pos].BeginAddress) max = pos - 1;
1730         else if ((char *)pc >= (char *)module + func[pos].EndAddress) min = pos + 1;
1731         else
1732         {
1733             func += pos;
1734             while (func->UnwindData & 1)  /* follow chained entry */
1735                 func = (RUNTIME_FUNCTION *)((char *)module + (func->UnwindData & ~1));
1736             return func;
1737         }
1738     }
1739     return NULL;
1740 }
1741
1742
1743 /**********************************************************************
1744  *           call_handler
1745  *
1746  * Call a single exception handler.
1747  * FIXME: Handle nested exceptions.
1748  */
1749 static NTSTATUS call_handler( EXCEPTION_RECORD *rec, DISPATCHER_CONTEXT *dispatch, CONTEXT *orig_context )
1750 {
1751     DWORD res;
1752
1753     dispatch->ControlPc = dispatch->ContextRecord->Rip;
1754
1755     TRACE( "calling handler %p (rec=%p, frame=0x%lx context=%p, dispatch=%p)\n",
1756            dispatch->LanguageHandler, rec, dispatch->EstablisherFrame, dispatch->ContextRecord, dispatch );
1757     res = dispatch->LanguageHandler( rec, dispatch->EstablisherFrame, dispatch->ContextRecord, dispatch );
1758     TRACE( "handler at %p returned %u\n", dispatch->LanguageHandler, res );
1759
1760     switch (res)
1761     {
1762     case ExceptionContinueExecution:
1763         if (rec->ExceptionFlags & EH_NONCONTINUABLE) return STATUS_NONCONTINUABLE_EXCEPTION;
1764         *orig_context = *dispatch->ContextRecord;
1765         return STATUS_SUCCESS;
1766     case ExceptionContinueSearch:
1767         break;
1768     case ExceptionNestedException:
1769         break;
1770     default:
1771         return STATUS_INVALID_DISPOSITION;
1772     }
1773     return STATUS_UNHANDLED_EXCEPTION;
1774 }
1775
1776
1777 /**********************************************************************
1778  *           call_teb_handler
1779  *
1780  * Call a single exception handler from the TEB chain.
1781  * FIXME: Handle nested exceptions.
1782  */
1783 static NTSTATUS call_teb_handler( EXCEPTION_RECORD *rec, DISPATCHER_CONTEXT *dispatch,
1784                                   EXCEPTION_REGISTRATION_RECORD *teb_frame, CONTEXT *orig_context )
1785 {
1786     EXCEPTION_REGISTRATION_RECORD *dispatcher;
1787     DWORD res;
1788
1789     TRACE( "calling TEB handler %p (rec=%p, frame=%p context=%p, dispatcher=%p)\n",
1790            teb_frame->Handler, rec, teb_frame, dispatch->ContextRecord, &dispatcher );
1791     res = teb_frame->Handler( rec, teb_frame, dispatch->ContextRecord, &dispatcher );
1792     TRACE( "handler at %p returned %u\n", teb_frame->Handler, res );
1793
1794     switch (res)
1795     {
1796     case ExceptionContinueExecution:
1797         if (rec->ExceptionFlags & EH_NONCONTINUABLE) return STATUS_NONCONTINUABLE_EXCEPTION;
1798         *orig_context = *dispatch->ContextRecord;
1799         return STATUS_SUCCESS;
1800     case ExceptionContinueSearch:
1801         break;
1802     case ExceptionNestedException:
1803         break;
1804     default:
1805         return STATUS_INVALID_DISPOSITION;
1806     }
1807     return STATUS_UNHANDLED_EXCEPTION;
1808 }
1809
1810
1811 /**********************************************************************
1812  *           call_stack_handlers
1813  *
1814  * Call the stack handlers chain.
1815  */
1816 static NTSTATUS call_stack_handlers( EXCEPTION_RECORD *rec, CONTEXT *orig_context )
1817 {
1818     EXCEPTION_REGISTRATION_RECORD *teb_frame = NtCurrentTeb()->Tib.ExceptionList;
1819     UNWIND_HISTORY_TABLE table;
1820     DISPATCHER_CONTEXT dispatch;
1821     CONTEXT context, new_context;
1822     LDR_MODULE *module;
1823     DWORD size;
1824     NTSTATUS status;
1825
1826     context = *orig_context;
1827     dispatch.TargetIp      = 0;
1828     dispatch.ContextRecord = &context;
1829     dispatch.HistoryTable  = &table;
1830     dispatch.ScopeIndex    = 0; /* FIXME */
1831     for (;;)
1832     {
1833         new_context = context;
1834
1835         /* FIXME: should use the history table to make things faster */
1836
1837         module = NULL;
1838         dispatch.ImageBase = 0;
1839
1840         /* first look for PE exception information */
1841
1842         if (!LdrFindEntryForAddress( (void *)context.Rip, &module ))
1843         {
1844             RUNTIME_FUNCTION *dir;
1845
1846             dispatch.ImageBase = (ULONG64)module->BaseAddress;
1847             if ((dir = RtlImageDirectoryEntryToData( module->BaseAddress, TRUE,
1848                                                      IMAGE_DIRECTORY_ENTRY_EXCEPTION, &size )))
1849             {
1850                 if ((dispatch.FunctionEntry = find_function_info( context.Rip, module->BaseAddress,
1851                                                                   dir, size )))
1852                 {
1853                     dispatch.LanguageHandler = RtlVirtualUnwind( UNW_FLAG_EHANDLER, dispatch.ImageBase,
1854                                                                  context.Rip, dispatch.FunctionEntry,
1855                                                                  &new_context, &dispatch.HandlerData,
1856                                                                  &dispatch.EstablisherFrame, NULL );
1857                     goto unwind_done;
1858                 }
1859             }
1860             else if (!(module->Flags & LDR_WINE_INTERNAL))
1861                 WARN( "exception data not found in %s\n", debugstr_w(module->BaseDllName.Buffer) );
1862         }
1863
1864         /* then look for host system exception information */
1865
1866         if (!module || (module->Flags & LDR_WINE_INTERNAL))
1867         {
1868             struct dwarf_eh_bases bases;
1869             const struct dwarf_fde *fde = _Unwind_Find_FDE( (void *)(context.Rip - 1), &bases );
1870
1871             if (fde)
1872             {
1873                 status = dwarf_virtual_unwind( context.Rip, &dispatch.EstablisherFrame, &new_context,
1874                                                fde, &bases, &dispatch.LanguageHandler, &dispatch.HandlerData );
1875                 if (status != STATUS_SUCCESS) return status;
1876                 dispatch.FunctionEntry = NULL;
1877                 if (dispatch.LanguageHandler && !module)
1878                 {
1879                     FIXME( "calling personality routine in system library not supported yet\n" );
1880                     dispatch.LanguageHandler = NULL;
1881                 }
1882                 goto unwind_done;
1883             }
1884         }
1885
1886         /* no exception information, treat as a leaf function */
1887
1888         new_context.Rip = *(ULONG64 *)context.Rsp;
1889         new_context.Rsp = context.Rsp + sizeof(ULONG64);
1890         dispatch.EstablisherFrame = new_context.Rsp;
1891         dispatch.LanguageHandler = NULL;
1892
1893     unwind_done:
1894         if (!dispatch.EstablisherFrame) break;
1895
1896         if ((dispatch.EstablisherFrame & 7) ||
1897             dispatch.EstablisherFrame < (ULONG64)NtCurrentTeb()->Tib.StackLimit ||
1898             dispatch.EstablisherFrame > (ULONG64)NtCurrentTeb()->Tib.StackBase)
1899         {
1900             ERR( "invalid frame %lx (%p-%p)\n", dispatch.EstablisherFrame,
1901                  NtCurrentTeb()->Tib.StackLimit, NtCurrentTeb()->Tib.StackBase );
1902             rec->ExceptionFlags |= EH_STACK_INVALID;
1903             break;
1904         }
1905
1906         if (dispatch.LanguageHandler)
1907         {
1908             status = call_handler( rec, &dispatch, orig_context );
1909             if (status != STATUS_UNHANDLED_EXCEPTION) return status;
1910         }
1911         /* hack: call wine handlers registered in the tib list */
1912         else while ((ULONG64)teb_frame < new_context.Rsp)
1913         {
1914             TRACE( "found wine frame %p rsp %lx handler %p\n",
1915                    teb_frame, new_context.Rsp, teb_frame->Handler );
1916             dispatch.EstablisherFrame = (ULONG64)teb_frame;
1917             context = *orig_context;
1918             status = call_teb_handler( rec, &dispatch, teb_frame, orig_context );
1919             if (status != STATUS_UNHANDLED_EXCEPTION) return status;
1920             teb_frame = teb_frame->Prev;
1921         }
1922
1923         if (new_context.Rsp == (ULONG64)NtCurrentTeb()->Tib.StackBase) break;
1924         context = new_context;
1925     }
1926     return STATUS_UNHANDLED_EXCEPTION;
1927 }
1928
1929
1930 /*******************************************************************
1931  *              raise_exception
1932  *
1933  * Implementation of NtRaiseException.
1934  */
1935 static NTSTATUS raise_exception( EXCEPTION_RECORD *rec, CONTEXT *context, BOOL first_chance )
1936 {
1937     NTSTATUS status;
1938
1939     if (first_chance)
1940     {
1941         DWORD c;
1942
1943         TRACE( "code=%x flags=%x addr=%p ip=%lx tid=%04x\n",
1944                rec->ExceptionCode, rec->ExceptionFlags, rec->ExceptionAddress,
1945                context->Rip, GetCurrentThreadId() );
1946         for (c = 0; c < min( EXCEPTION_MAXIMUM_PARAMETERS, rec->NumberParameters ); c++)
1947             TRACE( " info[%d]=%08lx\n", c, rec->ExceptionInformation[c] );
1948         if (rec->ExceptionCode == EXCEPTION_WINE_STUB)
1949         {
1950             if (rec->ExceptionInformation[1] >> 16)
1951                 MESSAGE( "wine: Call from %p to unimplemented function %s.%s, aborting\n",
1952                          rec->ExceptionAddress,
1953                          (char*)rec->ExceptionInformation[0], (char*)rec->ExceptionInformation[1] );
1954             else
1955                 MESSAGE( "wine: Call from %p to unimplemented function %s.%ld, aborting\n",
1956                          rec->ExceptionAddress,
1957                          (char*)rec->ExceptionInformation[0], rec->ExceptionInformation[1] );
1958         }
1959         else
1960         {
1961             TRACE(" rax=%016lx rbx=%016lx rcx=%016lx rdx=%016lx\n",
1962                   context->Rax, context->Rbx, context->Rcx, context->Rdx );
1963             TRACE(" rsi=%016lx rdi=%016lx rbp=%016lx rsp=%016lx\n",
1964                   context->Rsi, context->Rdi, context->Rbp, context->Rsp );
1965             TRACE("  r8=%016lx  r9=%016lx r10=%016lx r11=%016lx\n",
1966                   context->R8, context->R9, context->R10, context->R11 );
1967             TRACE(" r12=%016lx r13=%016lx r14=%016lx r15=%016lx\n",
1968                   context->R12, context->R13, context->R14, context->R15 );
1969         }
1970         status = send_debug_event( rec, TRUE, context );
1971         if (status == DBG_CONTINUE || status == DBG_EXCEPTION_HANDLED)
1972             return STATUS_SUCCESS;
1973
1974         if (call_vectored_handlers( rec, context ) == EXCEPTION_CONTINUE_EXECUTION)
1975             return STATUS_SUCCESS;
1976
1977         if ((status = call_stack_handlers( rec, context )) != STATUS_UNHANDLED_EXCEPTION)
1978             return status;
1979     }
1980
1981     /* last chance exception */
1982
1983     status = send_debug_event( rec, FALSE, context );
1984     if (status != DBG_CONTINUE)
1985     {
1986         if (rec->ExceptionFlags & EH_STACK_INVALID)
1987             ERR("Exception frame is not in stack limits => unable to dispatch exception.\n");
1988         else if (rec->ExceptionCode == STATUS_NONCONTINUABLE_EXCEPTION)
1989             ERR("Process attempted to continue execution after noncontinuable exception.\n");
1990         else
1991             ERR("Unhandled exception code %x flags %x addr %p\n",
1992                 rec->ExceptionCode, rec->ExceptionFlags, rec->ExceptionAddress );
1993         NtTerminateProcess( NtCurrentProcess(), rec->ExceptionCode );
1994     }
1995     return STATUS_SUCCESS;
1996 }
1997
1998
1999 /**********************************************************************
2000  *              raise_segv_exception
2001  */
2002 static void raise_segv_exception( EXCEPTION_RECORD *rec, CONTEXT *context )
2003 {
2004     NTSTATUS status;
2005
2006     switch(rec->ExceptionCode)
2007     {
2008     case EXCEPTION_ACCESS_VIOLATION:
2009         if (rec->NumberParameters == 2)
2010         {
2011             if (!(rec->ExceptionCode = virtual_handle_fault( (void *)rec->ExceptionInformation[1],
2012                                                              rec->ExceptionInformation[0] )))
2013                 set_cpu_context( context );
2014         }
2015         break;
2016     }
2017     status = raise_exception( rec, context, TRUE );
2018     if (status) raise_status( status, rec );
2019     set_cpu_context( context );
2020 }
2021
2022
2023 /**********************************************************************
2024  *              raise_generic_exception
2025  *
2026  * Generic raise function for exceptions that don't need special treatment.
2027  */
2028 static void raise_generic_exception( EXCEPTION_RECORD *rec, CONTEXT *context )
2029 {
2030     NTSTATUS status = raise_exception( rec, context, TRUE );
2031     if (status) raise_status( status, rec );
2032     set_cpu_context( context );
2033 }
2034
2035
2036 /**********************************************************************
2037  *              segv_handler
2038  *
2039  * Handler for SIGSEGV and related errors.
2040  */
2041 static void segv_handler( int signal, siginfo_t *siginfo, void *sigcontext )
2042 {
2043     EXCEPTION_RECORD *rec = setup_exception( sigcontext, raise_segv_exception );
2044     ucontext_t *ucontext = sigcontext;
2045
2046     switch(TRAP_sig(ucontext))
2047     {
2048     case TRAP_x86_OFLOW:   /* Overflow exception */
2049         rec->ExceptionCode = EXCEPTION_INT_OVERFLOW;
2050         break;
2051     case TRAP_x86_BOUND:   /* Bound range exception */
2052         rec->ExceptionCode = EXCEPTION_ARRAY_BOUNDS_EXCEEDED;
2053         break;
2054     case TRAP_x86_PRIVINFLT:   /* Invalid opcode exception */
2055         rec->ExceptionCode = EXCEPTION_ILLEGAL_INSTRUCTION;
2056         break;
2057     case TRAP_x86_STKFLT:  /* Stack fault */
2058         rec->ExceptionCode = EXCEPTION_STACK_OVERFLOW;
2059         break;
2060     case TRAP_x86_SEGNPFLT:  /* Segment not present exception */
2061     case TRAP_x86_PROTFLT:   /* General protection fault */
2062     case TRAP_x86_UNKNOWN:   /* Unknown fault code */
2063         rec->ExceptionCode = ERROR_sig(ucontext) ? EXCEPTION_ACCESS_VIOLATION : EXCEPTION_PRIV_INSTRUCTION;
2064         rec->ExceptionCode = EXCEPTION_ACCESS_VIOLATION;
2065         break;
2066     case TRAP_x86_PAGEFLT:  /* Page fault */
2067         rec->ExceptionCode = EXCEPTION_ACCESS_VIOLATION;
2068         rec->NumberParameters = 2;
2069         rec->ExceptionInformation[0] = (ERROR_sig(ucontext) & 2) != 0;
2070         rec->ExceptionInformation[1] = (ULONG_PTR)siginfo->si_addr;
2071         break;
2072     case TRAP_x86_ALIGNFLT:  /* Alignment check exception */
2073         rec->ExceptionCode = EXCEPTION_DATATYPE_MISALIGNMENT;
2074         break;
2075     default:
2076         ERR( "Got unexpected trap %ld\n", TRAP_sig(ucontext) );
2077         /* fall through */
2078     case TRAP_x86_NMI:       /* NMI interrupt */
2079     case TRAP_x86_DNA:       /* Device not available exception */
2080     case TRAP_x86_DOUBLEFLT: /* Double fault exception */
2081     case TRAP_x86_TSSFLT:    /* Invalid TSS exception */
2082     case TRAP_x86_MCHK:      /* Machine check exception */
2083     case TRAP_x86_CACHEFLT:  /* Cache flush exception */
2084         rec->ExceptionCode = EXCEPTION_ILLEGAL_INSTRUCTION;
2085         break;
2086     }
2087 }
2088
2089 /**********************************************************************
2090  *              trap_handler
2091  *
2092  * Handler for SIGTRAP.
2093  */
2094 static void trap_handler( int signal, siginfo_t *siginfo, void *sigcontext )
2095 {
2096     EXCEPTION_RECORD *rec = setup_exception( sigcontext, raise_generic_exception );
2097
2098     switch (siginfo->si_code)
2099     {
2100     case TRAP_TRACE:  /* Single-step exception */
2101     case 4 /* TRAP_HWBKPT */: /* Hardware breakpoint exception */
2102         rec->ExceptionCode = EXCEPTION_SINGLE_STEP;
2103         break;
2104     case TRAP_BRKPT:   /* Breakpoint exception */
2105         rec->ExceptionAddress = (char *)rec->ExceptionAddress - 1;  /* back up over the int3 instruction */
2106         /* fall through */
2107     default:
2108         rec->ExceptionCode = EXCEPTION_BREAKPOINT;
2109         break;
2110     }
2111 }
2112
2113 /**********************************************************************
2114  *              fpe_handler
2115  *
2116  * Handler for SIGFPE.
2117  */
2118 static void fpe_handler( int signal, siginfo_t *siginfo, void *sigcontext )
2119 {
2120     EXCEPTION_RECORD *rec = setup_exception( sigcontext, raise_generic_exception );
2121
2122     switch (siginfo->si_code)
2123     {
2124     case FPE_FLTSUB:
2125         rec->ExceptionCode = EXCEPTION_ARRAY_BOUNDS_EXCEEDED;
2126         break;
2127     case FPE_INTDIV:
2128         rec->ExceptionCode = EXCEPTION_INT_DIVIDE_BY_ZERO;
2129         break;
2130     case FPE_INTOVF:
2131         rec->ExceptionCode = EXCEPTION_INT_OVERFLOW;
2132         break;
2133     case FPE_FLTDIV:
2134         rec->ExceptionCode = EXCEPTION_FLT_DIVIDE_BY_ZERO;
2135         break;
2136     case FPE_FLTOVF:
2137         rec->ExceptionCode = EXCEPTION_FLT_OVERFLOW;
2138         break;
2139     case FPE_FLTUND:
2140         rec->ExceptionCode = EXCEPTION_FLT_UNDERFLOW;
2141         break;
2142     case FPE_FLTRES:
2143         rec->ExceptionCode = EXCEPTION_FLT_INEXACT_RESULT;
2144         break;
2145     case FPE_FLTINV:
2146     default:
2147         rec->ExceptionCode = EXCEPTION_FLT_INVALID_OPERATION;
2148         break;
2149     }
2150 }
2151
2152 /**********************************************************************
2153  *              int_handler
2154  *
2155  * Handler for SIGINT.
2156  */
2157 static void int_handler( int signal, siginfo_t *siginfo, void *sigcontext )
2158 {
2159     if (!dispatch_signal(SIGINT))
2160     {
2161         EXCEPTION_RECORD *rec = setup_exception( sigcontext, raise_generic_exception );
2162         rec->ExceptionCode = CONTROL_C_EXIT;
2163     }
2164 }
2165
2166
2167 /**********************************************************************
2168  *              abrt_handler
2169  *
2170  * Handler for SIGABRT.
2171  */
2172 static void abrt_handler( int signal, siginfo_t *siginfo, void *sigcontext )
2173 {
2174     EXCEPTION_RECORD *rec = setup_exception( sigcontext, raise_generic_exception );
2175     rec->ExceptionCode = EXCEPTION_WINE_ASSERTION;
2176     rec->ExceptionFlags = EH_NONCONTINUABLE;
2177 }
2178
2179
2180 /**********************************************************************
2181  *              quit_handler
2182  *
2183  * Handler for SIGQUIT.
2184  */
2185 static void quit_handler( int signal, siginfo_t *siginfo, void *ucontext )
2186 {
2187     abort_thread(0);
2188 }
2189
2190
2191 /**********************************************************************
2192  *              usr1_handler
2193  *
2194  * Handler for SIGUSR1, used to signal a thread that it got suspended.
2195  */
2196 static void usr1_handler( int signal, siginfo_t *siginfo, void *ucontext )
2197 {
2198     CONTEXT context;
2199
2200     save_context( &context, ucontext );
2201     wait_suspend( &context );
2202     restore_context( &context, ucontext );
2203 }
2204
2205
2206 /***********************************************************************
2207  *           __wine_set_signal_handler   (NTDLL.@)
2208  */
2209 int CDECL __wine_set_signal_handler(unsigned int sig, wine_signal_handler wsh)
2210 {
2211     if (sig > sizeof(handlers) / sizeof(handlers[0])) return -1;
2212     if (handlers[sig] != NULL) return -2;
2213     handlers[sig] = wsh;
2214     return 0;
2215 }
2216
2217
2218 /**********************************************************************
2219  *              signal_alloc_thread
2220  */
2221 NTSTATUS signal_alloc_thread( TEB **teb )
2222 {
2223     static size_t sigstack_zero_bits;
2224     SIZE_T size;
2225     NTSTATUS status;
2226
2227     if (!sigstack_zero_bits)
2228     {
2229         size_t min_size = teb_size + max( MINSIGSTKSZ, 8192 );
2230         /* find the first power of two not smaller than min_size */
2231         sigstack_zero_bits = 12;
2232         while ((1u << sigstack_zero_bits) < min_size) sigstack_zero_bits++;
2233         signal_stack_size = (1 << sigstack_zero_bits) - teb_size;
2234         assert( sizeof(TEB) <= teb_size );
2235     }
2236
2237     size = 1 << sigstack_zero_bits;
2238     *teb = NULL;
2239     if (!(status = NtAllocateVirtualMemory( NtCurrentProcess(), (void **)teb, sigstack_zero_bits,
2240                                             &size, MEM_COMMIT | MEM_TOP_DOWN, PAGE_READWRITE )))
2241     {
2242         (*teb)->Tib.Self = &(*teb)->Tib;
2243         (*teb)->Tib.ExceptionList = (void *)~0UL;
2244     }
2245     return status;
2246 }
2247
2248
2249 /**********************************************************************
2250  *              signal_free_thread
2251  */
2252 void signal_free_thread( TEB *teb )
2253 {
2254     SIZE_T size;
2255
2256     if (teb->DeallocationStack)
2257     {
2258         size = 0;
2259         NtFreeVirtualMemory( GetCurrentProcess(), &teb->DeallocationStack, &size, MEM_RELEASE );
2260     }
2261     size = 0;
2262     NtFreeVirtualMemory( NtCurrentProcess(), (void **)&teb, &size, MEM_RELEASE );
2263 }
2264
2265
2266 /**********************************************************************
2267  *              signal_init_thread
2268  */
2269 void signal_init_thread( TEB *teb )
2270 {
2271     stack_t ss;
2272
2273 #ifdef __linux__
2274     arch_prctl( ARCH_SET_GS, teb );
2275 #else
2276 # error Please define setting %gs for your architecture
2277 #endif
2278
2279     ss.ss_sp    = (char *)teb + teb_size;
2280     ss.ss_size  = signal_stack_size;
2281     ss.ss_flags = 0;
2282     if (sigaltstack(&ss, NULL) == -1) perror( "sigaltstack" );
2283 }
2284
2285 /**********************************************************************
2286  *              signal_init_process
2287  */
2288 void signal_init_process(void)
2289 {
2290     struct sigaction sig_act;
2291
2292     sig_act.sa_mask = server_block_set;
2293     sig_act.sa_flags = SA_RESTART | SA_SIGINFO | SA_ONSTACK;
2294
2295     sig_act.sa_sigaction = int_handler;
2296     if (sigaction( SIGINT, &sig_act, NULL ) == -1) goto error;
2297     sig_act.sa_sigaction = fpe_handler;
2298     if (sigaction( SIGFPE, &sig_act, NULL ) == -1) goto error;
2299     sig_act.sa_sigaction = abrt_handler;
2300     if (sigaction( SIGABRT, &sig_act, NULL ) == -1) goto error;
2301     sig_act.sa_sigaction = quit_handler;
2302     if (sigaction( SIGQUIT, &sig_act, NULL ) == -1) goto error;
2303     sig_act.sa_sigaction = usr1_handler;
2304     if (sigaction( SIGUSR1, &sig_act, NULL ) == -1) goto error;
2305
2306     sig_act.sa_sigaction = segv_handler;
2307     if (sigaction( SIGSEGV, &sig_act, NULL ) == -1) goto error;
2308     if (sigaction( SIGILL, &sig_act, NULL ) == -1) goto error;
2309 #ifdef SIGBUS
2310     if (sigaction( SIGBUS, &sig_act, NULL ) == -1) goto error;
2311 #endif
2312
2313 #ifdef SIGTRAP
2314     sig_act.sa_sigaction = trap_handler;
2315     if (sigaction( SIGTRAP, &sig_act, NULL ) == -1) goto error;
2316 #endif
2317     return;
2318
2319  error:
2320     perror("sigaction");
2321     exit(1);
2322 }
2323
2324
2325 /**********************************************************************
2326  *              RtlAddFunctionTable   (NTDLL.@)
2327  */
2328 BOOLEAN CDECL RtlAddFunctionTable( RUNTIME_FUNCTION *table, DWORD count, DWORD64 addr )
2329 {
2330     FIXME( "%p %u %lx: stub\n", table, count, addr );
2331     return FALSE;
2332 }
2333
2334
2335 /**********************************************************************
2336  *              RtlDeleteFunctionTable   (NTDLL.@)
2337  */
2338 BOOLEAN CDECL RtlDeleteFunctionTable( RUNTIME_FUNCTION *table )
2339 {
2340     FIXME( "%p: stub\n", table );
2341     return FALSE;
2342 }
2343
2344
2345 /**********************************************************************
2346  *              RtlLookupFunctionEntry   (NTDLL.@)
2347  */
2348 PRUNTIME_FUNCTION WINAPI RtlLookupFunctionEntry( ULONG64 pc, ULONG64 *base, UNWIND_HISTORY_TABLE *table )
2349 {
2350     LDR_MODULE *module;
2351     RUNTIME_FUNCTION *func;
2352     ULONG size;
2353
2354     /* FIXME: should use the history table to make things faster */
2355
2356     if (LdrFindEntryForAddress( (void *)pc, &module ))
2357     {
2358         WARN( "module not found for %lx\n", pc );
2359         return NULL;
2360     }
2361     if (!(func = RtlImageDirectoryEntryToData( module->BaseAddress, TRUE,
2362                                                IMAGE_DIRECTORY_ENTRY_EXCEPTION, &size )))
2363     {
2364         WARN( "no exception table found in module %p pc %lx\n", module->BaseAddress, pc );
2365         return NULL;
2366     }
2367     func = find_function_info( pc, module->BaseAddress, func, size );
2368     if (func) *base = (ULONG64)module->BaseAddress;
2369     return func;
2370 }
2371
2372 static ULONG64 get_int_reg( CONTEXT *context, int reg )
2373 {
2374     return *(&context->Rax + reg);
2375 }
2376
2377 static void set_int_reg( CONTEXT *context, KNONVOLATILE_CONTEXT_POINTERS *ctx_ptr, int reg, ULONG64 val )
2378 {
2379     *(&context->Rax + reg) = val;
2380     if (ctx_ptr) ctx_ptr->u2.IntegerContext[reg] = &context->Rax + reg;
2381 }
2382
2383 static void set_float_reg( CONTEXT *context, KNONVOLATILE_CONTEXT_POINTERS *ctx_ptr, int reg, M128A val )
2384 {
2385     *(&context->u.s.Xmm0 + reg) = val;
2386     if (ctx_ptr) ctx_ptr->u1.FloatingContext[reg] = &context->u.s.Xmm0 + reg;
2387 }
2388
2389 static int get_opcode_size( struct opcode op )
2390 {
2391     switch (op.code)
2392     {
2393     case UWOP_ALLOC_LARGE:
2394         return 2 + (op.info != 0);
2395     case UWOP_SAVE_NONVOL:
2396     case UWOP_SAVE_XMM128:
2397         return 2;
2398     case UWOP_SAVE_NONVOL_FAR:
2399     case UWOP_SAVE_XMM128_FAR:
2400         return 3;
2401     default:
2402         return 1;
2403     }
2404 }
2405
2406 static BOOL is_inside_epilog( BYTE *pc )
2407 {
2408     /* add or lea must be the first instruction, and it must have a rex.W prefix */
2409     if ((pc[0] & 0xf8) == 0x48)
2410     {
2411         switch (pc[1])
2412         {
2413         case 0x81: /* add $nnnn,%rsp */
2414             if (pc[0] == 0x48 && pc[2] == 0xc4)
2415             {
2416                 pc += 7;
2417                 break;
2418             }
2419             return FALSE;
2420         case 0x83: /* add $n,%rsp */
2421             if (pc[0] == 0x48 && pc[2] == 0xc4)
2422             {
2423                 pc += 4;
2424                 break;
2425             }
2426             return FALSE;
2427         case 0x8d: /* lea n(reg),%rsp */
2428             if (pc[0] & 0x06) return FALSE;  /* rex.RX must be cleared */
2429             if (((pc[2] >> 3) & 7) != 4) return FALSE;  /* dest reg mus be %rsp */
2430             if ((pc[2] & 7) == 4) return FALSE;  /* no SIB byte allowed */
2431             if ((pc[2] >> 6) == 1)  /* 8-bit offset */
2432             {
2433                 pc += 4;
2434                 break;
2435             }
2436             if ((pc[2] >> 6) == 2)  /* 32-bit offset */
2437             {
2438                 pc += 7;
2439                 break;
2440             }
2441             return FALSE;
2442         }
2443     }
2444
2445     /* now check for various pop instructions */
2446
2447     for (;;)
2448     {
2449         BYTE rex = 0;
2450
2451         if ((*pc & 0xf0) == 0x40) rex = *pc++ & 0x0f;  /* rex prefix */
2452
2453         switch (*pc)
2454         {
2455         case 0x58: /* pop %rax/%r8 */
2456         case 0x59: /* pop %rcx/%r9 */
2457         case 0x5a: /* pop %rdx/%r10 */
2458         case 0x5b: /* pop %rbx/%r11 */
2459         case 0x5c: /* pop %rsp/%r12 */
2460         case 0x5d: /* pop %rbp/%r13 */
2461         case 0x5e: /* pop %rsi/%r14 */
2462         case 0x5f: /* pop %rdi/%r15 */
2463             pc++;
2464             continue;
2465         case 0xc2: /* ret $nn */
2466         case 0xc3: /* ret */
2467             return TRUE;
2468         /* FIXME: add various jump instructions */
2469         }
2470         return FALSE;
2471     }
2472 }
2473
2474 /* execute a function epilog, which must have been validated with is_inside_epilog() */
2475 static void interpret_epilog( BYTE *pc, CONTEXT *context, KNONVOLATILE_CONTEXT_POINTERS *ctx_ptr )
2476 {
2477     for (;;)
2478     {
2479         BYTE rex = 0;
2480
2481         if ((*pc & 0xf0) == 0x40) rex = *pc++ & 0x0f;  /* rex prefix */
2482
2483         switch (*pc)
2484         {
2485         case 0x58: /* pop %rax/r8 */
2486         case 0x59: /* pop %rcx/r9 */
2487         case 0x5a: /* pop %rdx/r10 */
2488         case 0x5b: /* pop %rbx/r11 */
2489         case 0x5c: /* pop %rsp/r12 */
2490         case 0x5d: /* pop %rbp/r13 */
2491         case 0x5e: /* pop %rsi/r14 */
2492         case 0x5f: /* pop %rdi/r15 */
2493             set_int_reg( context, ctx_ptr, *pc - 0x58 + (rex & 1) * 8, *(ULONG64 *)context->Rsp );
2494             context->Rsp += sizeof(ULONG64);
2495             pc++;
2496             continue;
2497         case 0x81: /* add $nnnn,%rsp */
2498             context->Rsp += *(LONG *)(pc + 2);
2499             pc += 2 + sizeof(LONG);
2500             continue;
2501         case 0x83: /* add $n,%rsp */
2502             context->Rsp += (signed char)pc[2];
2503             pc += 3;
2504             continue;
2505         case 0x8d:
2506             if ((pc[1] >> 6) == 1)  /* lea n(reg),%rsp */
2507             {
2508                 context->Rsp = get_int_reg( context, (pc[1] & 7) + (rex & 1) * 8 ) + (signed char)pc[2];
2509                 pc += 3;
2510             }
2511             else  /* lea nnnn(reg),%rsp */
2512             {
2513                 context->Rsp = get_int_reg( context, (pc[1] & 7) + (rex & 1) * 8 ) + *(LONG *)(pc + 2);
2514                 pc += 2 + sizeof(LONG);
2515             }
2516             continue;
2517         case 0xc2: /* ret $nn */
2518             context->Rip = *(ULONG64 *)context->Rsp;
2519             context->Rsp += sizeof(ULONG64) + *(WORD *)(pc + 1);
2520             return;
2521         case 0xc3: /* ret */
2522             context->Rip = *(ULONG64 *)context->Rsp;
2523             context->Rsp += sizeof(ULONG64);
2524             return;
2525         /* FIXME: add various jump instructions */
2526         }
2527         return;
2528     }
2529 }
2530
2531 /**********************************************************************
2532  *              RtlVirtualUnwind   (NTDLL.@)
2533  */
2534 PVOID WINAPI RtlVirtualUnwind( ULONG type, ULONG64 base, ULONG64 pc,
2535                                RUNTIME_FUNCTION *function, CONTEXT *context,
2536                                PVOID *data, ULONG64 *frame_ret,
2537                                KNONVOLATILE_CONTEXT_POINTERS *ctx_ptr )
2538 {
2539     union handler_data *handler_data;
2540     ULONG64 frame, off;
2541     struct UNWIND_INFO *info;
2542     unsigned int i, prolog_offset;
2543
2544     TRACE( "type %x rip %lx rsp %lx\n", type, pc, context->Rsp );
2545     if (TRACE_ON(seh)) dump_unwind_info( base, function );
2546
2547     frame = *frame_ret = context->Rsp;
2548     for (;;)
2549     {
2550         info = (struct UNWIND_INFO *)((char *)base + function->UnwindData);
2551         handler_data = (union handler_data *)&info->opcodes[(info->count + 1) & ~1];
2552
2553         if (info->version != 1)
2554         {
2555             FIXME( "unknown unwind info version %u at %p\n", info->version, info );
2556             return NULL;
2557         }
2558
2559         if (info->frame_reg)
2560             frame = get_int_reg( context, info->frame_reg ) - info->frame_offset * 16;
2561
2562         /* check if in prolog */
2563         if (pc >= base + function->BeginAddress && pc < base + function->BeginAddress + info->prolog)
2564         {
2565             prolog_offset = pc - base - function->BeginAddress;
2566         }
2567         else
2568         {
2569             prolog_offset = ~0;
2570             if (is_inside_epilog( (BYTE *)pc ))
2571             {
2572                 interpret_epilog( (BYTE *)pc, context, ctx_ptr );
2573                 *frame_ret = frame;
2574                 return NULL;
2575             }
2576         }
2577
2578         for (i = 0; i < info->count; i += get_opcode_size(info->opcodes[i]))
2579         {
2580             if (prolog_offset < info->opcodes[i].offset) continue; /* skip it */
2581
2582             switch (info->opcodes[i].code)
2583             {
2584             case UWOP_PUSH_NONVOL:  /* pushq %reg */
2585                 set_int_reg( context, ctx_ptr, info->opcodes[i].info, *(ULONG64 *)context->Rsp );
2586                 context->Rsp += sizeof(ULONG64);
2587                 break;
2588             case UWOP_ALLOC_LARGE:  /* subq $nn,%rsp */
2589                 if (info->opcodes[i].info) context->Rsp += *(DWORD *)&info->opcodes[i+1];
2590                 else context->Rsp += *(USHORT *)&info->opcodes[i+1] * 8;
2591                 break;
2592             case UWOP_ALLOC_SMALL:  /* subq $n,%rsp */
2593                 context->Rsp += (info->opcodes[i].info + 1) * 8;
2594                 break;
2595             case UWOP_SET_FPREG:  /* leaq nn(%rsp),%framereg */
2596                 context->Rsp = *frame_ret = frame;
2597                 break;
2598             case UWOP_SAVE_NONVOL:  /* movq %reg,n(%rsp) */
2599                 off = frame + *(USHORT *)&info->opcodes[i+1] * 8;
2600                 set_int_reg( context, ctx_ptr, info->opcodes[i].info, *(ULONG64 *)off );
2601                 break;
2602             case UWOP_SAVE_NONVOL_FAR:  /* movq %reg,nn(%rsp) */
2603                 off = frame + *(DWORD *)&info->opcodes[i+1];
2604                 set_int_reg( context, ctx_ptr, info->opcodes[i].info, *(ULONG64 *)off );
2605                 break;
2606             case UWOP_SAVE_XMM128:  /* movaps %xmmreg,n(%rsp) */
2607                 off = frame + *(USHORT *)&info->opcodes[i+1] * 16;
2608                 set_float_reg( context, ctx_ptr, info->opcodes[i].info, *(M128A *)off );
2609                 break;
2610             case UWOP_SAVE_XMM128_FAR:  /* movaps %xmmreg,nn(%rsp) */
2611                 off = frame + *(DWORD *)&info->opcodes[i+1];
2612                 set_float_reg( context, ctx_ptr, info->opcodes[i].info, *(M128A *)off );
2613                 break;
2614             case UWOP_PUSH_MACHFRAME:
2615                 FIXME( "PUSH_MACHFRAME %u\n", info->opcodes[i].info );
2616                 break;
2617             default:
2618                 FIXME( "unknown code %u\n", info->opcodes[i].code );
2619                 break;
2620             }
2621         }
2622
2623         if (!(info->flags & UNW_FLAG_CHAININFO)) break;
2624         function = &handler_data->chain;  /* restart with the chained info */
2625     }
2626
2627     /* now pop return address */
2628     context->Rip = *(ULONG64 *)context->Rsp;
2629     context->Rsp += sizeof(ULONG64);
2630
2631     if (!(info->flags & type)) return NULL;  /* no matching handler */
2632     if (prolog_offset != ~0) return NULL;  /* inside prolog */
2633
2634     *data = &handler_data->handler + 1;
2635     return (char *)base + handler_data->handler;
2636 }
2637
2638
2639 /**********************************************************************
2640  *           call_unwind_handler
2641  *
2642  * Call a single unwind handler.
2643  * FIXME: Handle nested exceptions.
2644  */
2645 static void call_unwind_handler( EXCEPTION_RECORD *rec, DISPATCHER_CONTEXT *dispatch )
2646 {
2647     DWORD res;
2648
2649     dispatch->ControlPc = dispatch->ContextRecord->Rip;
2650
2651     TRACE( "calling handler %p (rec=%p, frame=0x%lx context=%p, dispatch=%p)\n",
2652          dispatch->LanguageHandler, rec, dispatch->EstablisherFrame, dispatch->ContextRecord, dispatch );
2653     res = dispatch->LanguageHandler( rec, dispatch->EstablisherFrame, dispatch->ContextRecord, dispatch );
2654     TRACE( "handler %p returned %x\n", dispatch->LanguageHandler, res );
2655
2656     switch (res)
2657     {
2658     case ExceptionContinueSearch:
2659         break;
2660     case ExceptionCollidedUnwind:
2661         FIXME( "ExceptionCollidedUnwind not supported yet\n" );
2662         break;
2663     default:
2664         raise_status( STATUS_INVALID_DISPOSITION, rec );
2665         break;
2666     }
2667 }
2668
2669
2670 /**********************************************************************
2671  *           call_teb_unwind_handler
2672  *
2673  * Call a single unwind handler from the TEB chain.
2674  * FIXME: Handle nested exceptions.
2675  */
2676 static void call_teb_unwind_handler( EXCEPTION_RECORD *rec, DISPATCHER_CONTEXT *dispatch,
2677                                      EXCEPTION_REGISTRATION_RECORD *teb_frame )
2678 {
2679     EXCEPTION_REGISTRATION_RECORD *dispatcher;
2680     DWORD res;
2681
2682     TRACE( "calling TEB handler %p (rec=%p, frame=%p context=%p, dispatcher=%p)\n",
2683            teb_frame->Handler, rec, teb_frame, dispatch->ContextRecord, &dispatcher );
2684     res = teb_frame->Handler( rec, teb_frame, dispatch->ContextRecord, &dispatcher );
2685     TRACE( "handler at %p returned %u\n", teb_frame->Handler, res );
2686
2687     switch (res)
2688     {
2689     case ExceptionContinueSearch:
2690         break;
2691     case ExceptionCollidedUnwind:
2692         FIXME( "ExceptionCollidedUnwind not supported yet\n" );
2693         break;
2694     default:
2695         raise_status( STATUS_INVALID_DISPOSITION, rec );
2696         break;
2697     }
2698 }
2699
2700
2701 /*******************************************************************
2702  *              RtlUnwindEx (NTDLL.@)
2703  */
2704 void WINAPI RtlUnwindEx( ULONG64 end_frame, ULONG64 target_ip, EXCEPTION_RECORD *rec,
2705                          ULONG64 retval, CONTEXT *orig_context, UNWIND_HISTORY_TABLE *table )
2706 {
2707     EXCEPTION_REGISTRATION_RECORD *teb_frame = NtCurrentTeb()->Tib.ExceptionList;
2708     EXCEPTION_RECORD record;
2709     DISPATCHER_CONTEXT dispatch;
2710     CONTEXT context, new_context;
2711     LDR_MODULE *module;
2712     NTSTATUS status;
2713     DWORD size;
2714
2715     /* build an exception record, if we do not have one */
2716     if (!rec)
2717     {
2718         record.ExceptionCode    = STATUS_UNWIND;
2719         record.ExceptionFlags   = 0;
2720         record.ExceptionRecord  = NULL;
2721         record.ExceptionAddress = (void *)orig_context->Rip;
2722         record.NumberParameters = 0;
2723         rec = &record;
2724     }
2725
2726     rec->ExceptionFlags |= EH_UNWINDING | (end_frame ? 0 : EH_EXIT_UNWIND);
2727
2728     TRACE( "code=%x flags=%x end_frame=%lx target_ip=%lx rip=%016lx\n",
2729            rec->ExceptionCode, rec->ExceptionFlags, end_frame, target_ip, orig_context->Rip );
2730     TRACE(" rax=%016lx rbx=%016lx rcx=%016lx rdx=%016lx\n",
2731           orig_context->Rax, orig_context->Rbx, orig_context->Rcx, orig_context->Rdx );
2732     TRACE(" rsi=%016lx rdi=%016lx rbp=%016lx rsp=%016lx\n",
2733           orig_context->Rsi, orig_context->Rdi, orig_context->Rbp, orig_context->Rsp );
2734     TRACE("  r8=%016lx  r9=%016lx r10=%016lx r11=%016lx\n",
2735           orig_context->R8, orig_context->R9, orig_context->R10, orig_context->R11 );
2736     TRACE(" r12=%016lx r13=%016lx r14=%016lx r15=%016lx\n",
2737           orig_context->R12, orig_context->R13, orig_context->R14, orig_context->R15 );
2738
2739     context = *orig_context;
2740     dispatch.EstablisherFrame = context.Rsp;
2741     dispatch.TargetIp         = target_ip;
2742     dispatch.ContextRecord    = &context;
2743     dispatch.HistoryTable     = table;
2744
2745     while (dispatch.EstablisherFrame != end_frame)
2746     {
2747         new_context = context;
2748
2749         /* FIXME: should use the history table to make things faster */
2750
2751         module = NULL;
2752         dispatch.ImageBase = 0;
2753         dispatch.ScopeIndex = 0; /* FIXME */
2754
2755         /* first look for PE exception information */
2756
2757         if (!LdrFindEntryForAddress( (void *)context.Rip, &module ))
2758         {
2759             RUNTIME_FUNCTION *dir;
2760
2761             dispatch.ImageBase = (ULONG64)module->BaseAddress;
2762             if ((dir = RtlImageDirectoryEntryToData( module->BaseAddress, TRUE,
2763                                                      IMAGE_DIRECTORY_ENTRY_EXCEPTION, &size )))
2764             {
2765                 if ((dispatch.FunctionEntry = find_function_info( context.Rip, module->BaseAddress,
2766                                                                   dir, size )))
2767                 {
2768                     dispatch.LanguageHandler = RtlVirtualUnwind( UNW_FLAG_UHANDLER, dispatch.ImageBase,
2769                                                                  context.Rip, dispatch.FunctionEntry,
2770                                                                  &new_context, &dispatch.HandlerData,
2771                                                                  &dispatch.EstablisherFrame, NULL );
2772                     goto unwind_done;
2773                 }
2774             }
2775             else if (!(module->Flags & LDR_WINE_INTERNAL))
2776                 WARN( "exception data not found in %s\n", debugstr_w(module->BaseDllName.Buffer) );
2777         }
2778
2779         /* then look for host system exception information */
2780
2781         if (!module || (module->Flags & LDR_WINE_INTERNAL))
2782         {
2783             struct dwarf_eh_bases bases;
2784             const struct dwarf_fde *fde = _Unwind_Find_FDE( (void *)(context.Rip - 1), &bases );
2785
2786             if (fde)
2787             {
2788                 dispatch.FunctionEntry = NULL;
2789                 status = dwarf_virtual_unwind( context.Rip, &dispatch.EstablisherFrame, &new_context, fde,
2790                                                &bases, &dispatch.LanguageHandler, &dispatch.HandlerData );
2791                 if (status != STATUS_SUCCESS) raise_status( status, rec );
2792                 if (dispatch.LanguageHandler && !module)
2793                 {
2794                     FIXME( "calling personality routine in system library not supported yet\n" );
2795                     dispatch.LanguageHandler = NULL;
2796                 }
2797                 goto unwind_done;
2798             }
2799         }
2800
2801         /* no exception information, treat as a leaf function */
2802
2803         new_context.Rip = *(ULONG64 *)context.Rsp;
2804         new_context.Rsp = context.Rsp + sizeof(ULONG64);
2805         dispatch.EstablisherFrame = new_context.Rsp;
2806         dispatch.LanguageHandler = NULL;
2807
2808     unwind_done:
2809         if (!dispatch.EstablisherFrame) break;
2810
2811         if (is_inside_signal_stack( (void *)dispatch.EstablisherFrame ))
2812         {
2813             TRACE( "frame %lx is inside signal stack (%p-%p)\n", dispatch.EstablisherFrame,
2814                    get_signal_stack(), (char *)get_signal_stack() + signal_stack_size );
2815             context = new_context;
2816             continue;
2817         }
2818
2819         if ((dispatch.EstablisherFrame & 7) ||
2820             dispatch.EstablisherFrame < (ULONG64)NtCurrentTeb()->Tib.StackLimit ||
2821             dispatch.EstablisherFrame > (ULONG64)NtCurrentTeb()->Tib.StackBase)
2822         {
2823             ERR( "invalid frame %lx (%p-%p)\n", dispatch.EstablisherFrame,
2824                  NtCurrentTeb()->Tib.StackLimit, NtCurrentTeb()->Tib.StackBase );
2825             rec->ExceptionFlags |= EH_STACK_INVALID;
2826             break;
2827         }
2828
2829         if (dispatch.LanguageHandler)
2830         {
2831             if (end_frame && (dispatch.EstablisherFrame > end_frame))
2832             {
2833                 ERR( "invalid end frame %lx/%lx\n", dispatch.EstablisherFrame, end_frame );
2834                 raise_status( STATUS_INVALID_UNWIND_TARGET, rec );
2835             }
2836             call_unwind_handler( rec, &dispatch );
2837         }
2838         else  /* hack: call builtin handlers registered in the tib list */
2839         {
2840             while ((ULONG64)teb_frame < new_context.Rsp && (ULONG64)teb_frame < end_frame)
2841             {
2842                 TRACE( "found builtin frame %p handler %p\n", teb_frame, teb_frame->Handler );
2843                 dispatch.EstablisherFrame = (ULONG64)teb_frame;
2844                 call_teb_unwind_handler( rec, &dispatch, teb_frame );
2845                 teb_frame = __wine_pop_frame( teb_frame );
2846             }
2847             if ((ULONG64)teb_frame == end_frame && end_frame < new_context.Rsp) break;
2848             dispatch.EstablisherFrame = new_context.Rsp;
2849         }
2850
2851         context = new_context;
2852     }
2853     context.Rax = retval;
2854     context.Rip = target_ip;
2855     TRACE( "returning to %lx stack %lx\n", context.Rip, context.Rsp );
2856     set_cpu_context( &context );
2857 }
2858
2859
2860 /*******************************************************************
2861  *              RtlUnwind (NTDLL.@)
2862  */
2863 void WINAPI __regs_RtlUnwind( ULONG64 frame, ULONG64 target_ip, EXCEPTION_RECORD *rec,
2864                               ULONG64 retval, CONTEXT *context )
2865 {
2866     RtlUnwindEx( frame, target_ip, rec, retval, context, NULL );
2867 }
2868 DEFINE_REGS_ENTRYPOINT( RtlUnwind, 4 )
2869
2870
2871 /*******************************************************************
2872  *              __C_specific_handler (NTDLL.@)
2873  */
2874 EXCEPTION_DISPOSITION WINAPI __C_specific_handler( EXCEPTION_RECORD *rec,
2875                                                    ULONG64 frame,
2876                                                    CONTEXT *context,
2877                                                    struct _DISPATCHER_CONTEXT *dispatch )
2878 {
2879     SCOPE_TABLE *table = dispatch->HandlerData;
2880     ULONG i;
2881
2882     TRACE( "%p %lx %p %p\n", rec, frame, context, dispatch );
2883     if (TRACE_ON(seh)) dump_scope_table( dispatch->ImageBase, table );
2884
2885     if (rec->ExceptionFlags & (EH_UNWINDING | EH_EXIT_UNWIND))  /* FIXME */
2886         return ExceptionContinueSearch;
2887
2888     for (i = 0; i < table->Count; i++)
2889     {
2890         if (context->Rip >= dispatch->ImageBase + table->ScopeRecord[i].BeginAddress &&
2891             context->Rip < dispatch->ImageBase + table->ScopeRecord[i].EndAddress)
2892         {
2893             if (!table->ScopeRecord[i].JumpTarget) continue;
2894             if (table->ScopeRecord[i].HandlerAddress != EXCEPTION_EXECUTE_HANDLER)
2895             {
2896                 EXCEPTION_POINTERS ptrs;
2897                 PC_LANGUAGE_EXCEPTION_HANDLER filter;
2898
2899                 filter = (PC_LANGUAGE_EXCEPTION_HANDLER)(dispatch->ImageBase + table->ScopeRecord[i].HandlerAddress);
2900                 ptrs.ExceptionRecord = rec;
2901                 ptrs.ContextRecord = context;
2902                 TRACE( "calling filter %p ptrs %p frame %lx\n", filter, &ptrs, frame );
2903                 switch (filter( &ptrs, frame ))
2904                 {
2905                 case EXCEPTION_EXECUTE_HANDLER:
2906                     break;
2907                 case EXCEPTION_CONTINUE_SEARCH:
2908                     continue;
2909                 case EXCEPTION_CONTINUE_EXECUTION:
2910                     return ExceptionContinueExecution;
2911                 }
2912             }
2913             TRACE( "unwinding to target %lx\n", dispatch->ImageBase + table->ScopeRecord[i].JumpTarget );
2914             RtlUnwindEx( frame, dispatch->ImageBase + table->ScopeRecord[i].JumpTarget,
2915                          rec, 0, context, dispatch->HistoryTable );
2916         }
2917     }
2918     return ExceptionContinueSearch;
2919 }
2920
2921
2922 /*******************************************************************
2923  *              NtRaiseException (NTDLL.@)
2924  */
2925 NTSTATUS WINAPI NtRaiseException( EXCEPTION_RECORD *rec, CONTEXT *context, BOOL first_chance )
2926 {
2927     NTSTATUS status = raise_exception( rec, context, first_chance );
2928     if (status == STATUS_SUCCESS) NtSetContextThread( GetCurrentThread(), context );
2929     return status;
2930 }
2931
2932
2933 /***********************************************************************
2934  *              RtlRaiseException (NTDLL.@)
2935  */
2936 void WINAPI __regs_RtlRaiseException( EXCEPTION_RECORD *rec, CONTEXT *context )
2937 {
2938     NTSTATUS status;
2939
2940     rec->ExceptionAddress = (void *)context->Rip;
2941     status = raise_exception( rec, context, TRUE );
2942     if (status != STATUS_SUCCESS) raise_status( status, rec );
2943 }
2944 DEFINE_REGS_ENTRYPOINT( RtlRaiseException, 1 )
2945
2946
2947 /*************************************************************************
2948  *              RtlCaptureStackBackTrace (NTDLL.@)
2949  */
2950 USHORT WINAPI RtlCaptureStackBackTrace( ULONG skip, ULONG count, PVOID *buffer, ULONG *hash )
2951 {
2952     FIXME( "(%d, %d, %p, %p) stub!\n", skip, count, buffer, hash );
2953     return 0;
2954 }
2955
2956
2957 /***********************************************************************
2958  *           call_thread_func
2959  */
2960 void call_thread_func( LPTHREAD_START_ROUTINE entry, void *arg, void *frame )
2961 {
2962     ntdll_get_thread_data()->exit_frame = frame;
2963     __TRY
2964     {
2965         RtlExitUserThread( entry( arg ));
2966     }
2967     __EXCEPT(unhandled_exception_filter)
2968     {
2969         NtTerminateThread( GetCurrentThread(), GetExceptionCode() );
2970     }
2971     __ENDTRY
2972     abort();  /* should not be reached */
2973 }
2974
2975 extern void DECLSPEC_NORETURN call_thread_entry_point( LPTHREAD_START_ROUTINE entry, void *arg );
2976 __ASM_GLOBAL_FUNC( call_thread_entry_point,
2977                    "subq $8,%rsp\n\t"
2978                    __ASM_CFI(".cfi_adjust_cfa_offset 8\n\t")
2979                    "movq %rsp,%rdx\n\t"
2980                    "call " __ASM_NAME("call_thread_func") );
2981
2982 extern void DECLSPEC_NORETURN call_thread_exit_func( int status, void (*func)(int), void *frame );
2983 __ASM_GLOBAL_FUNC( call_thread_exit_func,
2984                    "subq $8,%rsp\n\t"
2985                    __ASM_CFI(".cfi_adjust_cfa_offset 8\n\t")
2986                    "movq %rdx,%rsp\n\t"
2987                    "call *%rsi" );
2988
2989 /***********************************************************************
2990  *           RtlExitUserThread  (NTDLL.@)
2991  */
2992 void WINAPI RtlExitUserThread( ULONG status )
2993 {
2994     if (!ntdll_get_thread_data()->exit_frame) exit_thread( status );
2995     call_thread_exit_func( status, exit_thread, ntdll_get_thread_data()->exit_frame );
2996 }
2997
2998 /***********************************************************************
2999  *           abort_thread
3000  */
3001 void abort_thread( int status )
3002 {
3003     if (!ntdll_get_thread_data()->exit_frame) terminate_thread( status );
3004     call_thread_exit_func( status, terminate_thread, ntdll_get_thread_data()->exit_frame );
3005 }
3006
3007 /**********************************************************************
3008  *              __wine_enter_vm86   (NTDLL.@)
3009  */
3010 void __wine_enter_vm86( CONTEXT *context )
3011 {
3012     MESSAGE("vm86 mode not supported on this platform\n");
3013 }
3014
3015 /**********************************************************************
3016  *              DbgBreakPoint   (NTDLL.@)
3017  */
3018 __ASM_STDCALL_FUNC( DbgBreakPoint, 0, "int $3; ret")
3019
3020 /**********************************************************************
3021  *              DbgUserBreakPoint   (NTDLL.@)
3022  */
3023 __ASM_STDCALL_FUNC( DbgUserBreakPoint, 0, "int $3; ret")
3024
3025 #endif  /* __x86_64__ */