server/ptrace.c

   1 /*
   2  * Server-side ptrace support
   3  *
   4  * Copyright (C) 1999 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 #include "config.h"
  22 #include "wine/port.h"
  23
  24 #include <assert.h>
  25 #include <errno.h>
  26 #include <fcntl.h>
  27 #include <stdio.h>
  28 #include <signal.h>
  29 #include <stdarg.h>
  30 #include <sys/types.h>
  31 #ifdef HAVE_SYS_PTRACE_H
  32 # include <sys/ptrace.h>
  33 #endif
  34 #ifdef HAVE_SYS_PARAM_H
  35 # include <sys/param.h>
  36 #endif
  37 #ifdef HAVE_SYS_WAIT_H
  38 # include <sys/wait.h>
  39 #endif
  40 #ifdef HAVE_SYS_SYSCALL_H
  41 # include <sys/syscall.h>
  42 #endif
  43 #ifdef HAVE_SYS_THR_H
  44 # include <sys/ucontext.h>
  45 # include <sys/thr.h>
  46 #endif
  47 #include <unistd.h>
  48
  49 #include "ntstatus.h"
  50 #define WIN32_NO_STATUS
  51 #include "winternl.h"
  52
  53 #include "file.h"
  54 #include "process.h"
  55 #include "thread.h"
  56
  57 #ifdef USE_PTRACE
  58
  59 #ifndef PTRACE_CONT
  60 #define PTRACE_CONT PT_CONTINUE
  61 #endif
  62 #ifndef PTRACE_SINGLESTEP
  63 #define PTRACE_SINGLESTEP PT_STEP
  64 #endif
  65 #ifndef PTRACE_ATTACH
  66 #define PTRACE_ATTACH PT_ATTACH
  67 #endif
  68 #ifndef PTRACE_DETACH
  69 #define PTRACE_DETACH PT_DETACH
  70 #endif
  71 #ifndef PTRACE_PEEKDATA
  72 #define PTRACE_PEEKDATA PT_READ_D
  73 #endif
  74 #ifndef PTRACE_POKEDATA
  75 #define PTRACE_POKEDATA PT_WRITE_D
  76 #endif
  77 #ifndef PTRACE_PEEKUSER
  78 #define PTRACE_PEEKUSER PT_READ_U
  79 #endif
  80 #ifndef PTRACE_POKEUSER
  81 #define PTRACE_POKEUSER PT_WRITE_U
  82 #endif
  83
  84 #ifdef PT_GETDBREGS
  85 #define PTRACE_GETDBREGS PT_GETDBREGS
  86 #endif
  87 #ifdef PT_SETDBREGS
  88 #define PTRACE_SETDBREGS PT_SETDBREGS
  89 #endif
  90
  91 #ifndef HAVE_SYS_PTRACE_H
  92 #define PT_CONTINUE 0
  93 #define PT_ATTACH   1
  94 #define PT_DETACH   2
  95 #define PT_READ_D   3
  96 #define PT_WRITE_D  4
  97 #define PT_STEP     5
  98 static inline int ptrace(int req, ...) { errno = EPERM; return -1; /*FAIL*/ }
  99 #endif  /* HAVE_SYS_PTRACE_H */
 100
 101 #ifndef __WALL
 102 #define __WALL 0
 103 #endif
 104
 105 /* handle a status returned by waitpid */
 106 static int handle_child_status( struct thread *thread, int pid, int status, int want_sig )
 107 {
 108     if (WIFSTOPPED(status))
 109     {
 110         int sig = WSTOPSIG(status);
 111         if (debug_level && thread)
 112             fprintf( stderr, "%04x: *signal* signal=%d\n", thread->id, sig );
 113         if (sig != want_sig)
 114         {
 115             /* ignore other signals for now */
 116             ptrace( PTRACE_CONT, pid, (caddr_t)1, sig );
 117         }
 118         return sig;
 119     }
 120     if (thread && (WIFSIGNALED(status) || WIFEXITED(status)))
 121     {
 122         thread->unix_pid = -1;
 123         thread->unix_tid = -1;
 124         if (debug_level)
 125         {
 126             if (WIFSIGNALED(status))
 127                 fprintf( stderr, "%04x: *exited* signal=%d\n",
 128                          thread->id, WTERMSIG(status) );
 129             else
 130                 fprintf( stderr, "%04x: *exited* status=%d\n",
 131                          thread->id, WEXITSTATUS(status) );
 132         }
 133     }
 134     return 0;
 135 }
 136
 137 /* handle a SIGCHLD signal */
 138 void sigchld_callback(void)
 139 {
 140     int pid, status;
 141
 142     for (;;)
 143     {
 144         if (!(pid = waitpid( -1, &status, WUNTRACED | WNOHANG | __WALL ))) break;
 145         if (pid != -1)
 146         {
 147             struct thread *thread = get_thread_from_tid( pid );
 148             if (!thread) thread = get_thread_from_pid( pid );
 149             handle_child_status( thread, pid, status, -1 );
 150         }
 151         else break;
 152     }
 153 }
 154
 155 /* return the Unix pid to use in ptrace calls for a given process */
 156 static int get_ptrace_pid( struct thread *thread )
 157 {
 158 #ifdef linux  /* linux always uses thread id */
 159     if (thread->unix_tid != -1) return thread->unix_tid;
 160 #endif
 161     return thread->unix_pid;
 162 }
 163
 164 /* return the Unix tid to use in ptrace calls for a given thread */
 165 static int get_ptrace_tid( struct thread *thread )
 166 {
 167     if (thread->unix_tid != -1) return thread->unix_tid;
 168     return thread->unix_pid;
 169 }
 170
 171 /* wait for a ptraced child to get a certain signal */
 172 static int waitpid_thread( struct thread *thread, int signal )
 173 {
 174     int res, status;
 175
 176     start_watchdog();
 177     for (;;)
 178     {
 179         if ((res = waitpid( get_ptrace_pid(thread), &status, WUNTRACED | __WALL )) == -1)
 180         {
 181             if (errno == EINTR)
 182             {
 183                 if (!watchdog_triggered()) continue;
 184                 if (debug_level) fprintf( stderr, "%04x: *watchdog* waitpid aborted\n", thread->id );
 185             }
 186             else if (errno == ECHILD)  /* must have died */
 187             {
 188                 thread->unix_pid = -1;
 189                 thread->unix_tid = -1;
 190             }
 191             else perror( "waitpid" );
 192             stop_watchdog();
 193             return 0;
 194         }
 195         res = handle_child_status( thread, res, status, signal );
 196         if (!res || res == signal) break;
 197     }
 198     stop_watchdog();
 199     return (thread->unix_pid != -1);
 200 }
 201
 202 /* send a signal to a specific thread */
 203 static inline int tkill( int tgid, int pid, int sig )
 204 {
 205 #ifdef __linux__
 206     int ret = syscall( __NR_tgkill, tgid, pid, sig );
 207     if (ret < 0 && errno == ENOSYS) ret = syscall( __NR_tkill, pid, sig );
 208     return ret;
 209 #elif (defined(__FreeBSD__) || defined (__FreeBSD_kernel__)) && defined(HAVE_THR_KILL2)
 210     return thr_kill2( tgid, pid, sig );
 211 #else
 212     errno = ENOSYS;
 213     return -1;
 214 #endif
 215 }
 216
 217 /* initialize the process tracing mechanism */
 218 void init_tracing_mechanism(void)
 219 {
 220     /* no initialization needed for ptrace */
 221 }
 222
 223 /* initialize the per-process tracing mechanism */
 224 void init_process_tracing( struct process *process )
 225 {
 226     /* ptrace setup is done on-demand */
 227 }
 228
 229 /* terminate the per-process tracing mechanism */
 230 void finish_process_tracing( struct process *process )
 231 {
 232 }
 233
 234 /* send a Unix signal to a specific thread */
 235 int send_thread_signal( struct thread *thread, int sig )
 236 {
 237     int ret = -1;
 238
 239     if (thread->unix_pid != -1)
 240     {
 241         if (thread->unix_tid != -1)
 242         {
 243             ret = tkill( thread->unix_pid, thread->unix_tid, sig );
 244             if (ret == -1 && errno == ENOSYS) ret = kill( thread->unix_pid, sig );
 245         }
 246         else ret = kill( thread->unix_pid, sig );
 247
 248         if (ret == -1 && errno == ESRCH) /* thread got killed */
 249         {
 250             thread->unix_pid = -1;
 251             thread->unix_tid = -1;
 252         }
 253     }
 254     if (debug_level && ret != -1)
 255         fprintf( stderr, "%04x: *sent signal* signal=%d\n", thread->id, sig );
 256     return (ret != -1);
 257 }
 258
 259 /* resume a thread after we have used ptrace on it */
 260 static void resume_after_ptrace( struct thread *thread )
 261 {
 262     if (thread->unix_pid == -1) return;
 263     if (ptrace( PTRACE_DETACH, get_ptrace_pid(thread), (caddr_t)1, 0 ) == -1)
 264     {
 265         if (errno == ESRCH) thread->unix_pid = thread->unix_tid = -1;  /* thread got killed */
 266     }
 267 }
 268
 269 /* suspend a thread to allow using ptrace on it */
 270 /* you must do a resume_after_ptrace when finished with the thread */
 271 static int suspend_for_ptrace( struct thread *thread )
 272 {
 273     /* can't stop a thread while initialisation is in progress */
 274     if (thread->unix_pid == -1 || !is_process_init_done(thread->process)) goto error;
 275
 276     /* this may fail if the client is already being debugged */
 277     if (ptrace( PTRACE_ATTACH, get_ptrace_pid(thread), 0, 0 ) == -1)
 278     {
 279         if (errno == ESRCH) thread->unix_pid = thread->unix_tid = -1;  /* thread got killed */
 280         goto error;
 281     }
 282     if (waitpid_thread( thread, SIGSTOP )) return 1;
 283     resume_after_ptrace( thread );
 284  error:
 285     set_error( STATUS_ACCESS_DENIED );
 286     return 0;
 287 }
 288
 289 /* read a long from a thread address space */
 290 static long read_thread_long( struct thread *thread, long *addr, long *data )
 291 {
 292     errno = 0;
 293     *data = ptrace( PTRACE_PEEKDATA, get_ptrace_pid(thread), (caddr_t)addr, 0 );
 294     if ( *data == -1 && errno)
 295     {
 296         file_set_error();
 297         return -1;
 298     }
 299     return 0;
 300 }
 301
 302 /* write a long to a thread address space */
 303 static long write_thread_long( struct thread *thread, long *addr, long data, unsigned long mask )
 304 {
 305     long res;
 306     if (mask != ~0ul)
 307     {
 308         if (read_thread_long( thread, addr, &res ) == -1) return -1;
 309         data = (data & mask) | (res & ~mask);
 310     }
 311     if ((res = ptrace( PTRACE_POKEDATA, get_ptrace_pid(thread), (caddr_t)addr, data )) == -1)
 312         file_set_error();
 313     return res;
 314 }
 315
 316 /* return a thread of the process suitable for ptracing */
 317 static struct thread *get_ptrace_thread( struct process *process )
 318 {
 319     struct thread *thread;
 320
 321     LIST_FOR_EACH_ENTRY( thread, &process->thread_list, struct thread, proc_entry )
 322     {
 323         if (thread->unix_pid != -1) return thread;
 324     }
 325     set_error( STATUS_PROCESS_IS_TERMINATING );  /* process is dead */
 326     return NULL;
 327 }
 328
 329 /* read data from a process memory space */
 330 int read_process_memory( struct process *process, client_ptr_t ptr, data_size_t size, char *dest )
 331 {
 332     struct thread *thread = get_ptrace_thread( process );
 333     unsigned int first_offset, last_offset, len;
 334     long data, *addr;
 335
 336     if (!thread) return 0;
 337
 338     if ((unsigned long)ptr != ptr)
 339     {
 340         set_error( STATUS_ACCESS_DENIED );
 341         return 0;
 342     }
 343
 344     first_offset = ptr % sizeof(long);
 345     last_offset = (size + first_offset) % sizeof(long);
 346     if (!last_offset) last_offset = sizeof(long);
 347
 348     addr = (long *)(unsigned long)(ptr - first_offset);
 349     len = (size + first_offset + sizeof(long) - 1) / sizeof(long);
 350
 351     if (suspend_for_ptrace( thread ))
 352     {
 353         if (len > 3)  /* /proc/pid/mem should be faster for large sizes */
 354         {
 355             char procmem[24];
 356             int fd;
 357
 358             sprintf( procmem, "/proc/%u/mem", process->unix_pid );
 359             if ((fd = open( procmem, O_RDONLY )) != -1)
 360             {
 361                 ssize_t ret = pread( fd, dest, size, ptr );
 362                 close( fd );
 363                 if (ret == size)
 364                 {
 365                     len = 0;
 366                     goto done;
 367                 }
 368             }
 369         }
 370
 371         if (len > 1)
 372         {
 373             if (read_thread_long( thread, addr++, &data ) == -1) goto done;
 374             memcpy( dest, (char *)&data + first_offset, sizeof(long) - first_offset );
 375             dest += sizeof(long) - first_offset;
 376             first_offset = 0;
 377             len--;
 378         }
 379
 380         while (len > 1)
 381         {
 382             if (read_thread_long( thread, addr++, &data ) == -1) goto done;
 383             memcpy( dest, &data, sizeof(long) );
 384             dest += sizeof(long);
 385             len--;
 386         }
 387
 388         if (read_thread_long( thread, addr++, &data ) == -1) goto done;
 389         memcpy( dest, (char *)&data + first_offset, last_offset - first_offset );
 390         len--;
 391
 392     done:
 393         resume_after_ptrace( thread );
 394     }
 395     return !len;
 396 }
 397
 398 /* make sure we can write to the whole address range */
 399 /* len is the total size (in ints) */
 400 static int check_process_write_access( struct thread *thread, long *addr, data_size_t len )
 401 {
 402     int page = get_page_size() / sizeof(int);
 403
 404     for (;;)
 405     {
 406         if (write_thread_long( thread, addr, 0, 0 ) == -1) return 0;
 407         if (len <= page) break;
 408         addr += page;
 409         len -= page;
 410     }
 411     return (write_thread_long( thread, addr + len - 1, 0, 0 ) != -1);
 412 }
 413
 414 /* write data to a process memory space */
 415 int write_process_memory( struct process *process, client_ptr_t ptr, data_size_t size, const char *src )
 416 {
 417     struct thread *thread = get_ptrace_thread( process );
 418     int ret = 0;
 419     long data = 0;
 420     data_size_t len;
 421     long *addr;
 422     unsigned long first_mask, first_offset, last_mask, last_offset;
 423
 424     if (!thread) return 0;
 425
 426     if ((unsigned long)ptr != ptr)
 427     {
 428         set_error( STATUS_ACCESS_DENIED );
 429         return 0;
 430     }
 431
 432     /* compute the mask for the first long */
 433     first_mask = ~0;
 434     first_offset = ptr % sizeof(long);
 435     memset( &first_mask, 0, first_offset );
 436
 437     /* compute the mask for the last long */
 438     last_offset = (size + first_offset) % sizeof(long);
 439     if (!last_offset) last_offset = sizeof(long);
 440     last_mask = 0;
 441     memset( &last_mask, 0xff, last_offset );
 442
 443     addr = (long *)(unsigned long)(ptr - first_offset);
 444     len = (size + first_offset + sizeof(long) - 1) / sizeof(long);
 445
 446     if (suspend_for_ptrace( thread ))
 447     {
 448         if (!check_process_write_access( thread, addr, len ))
 449         {
 450             set_error( STATUS_ACCESS_DENIED );
 451             goto done;
 452         }
 453
 454         if (len > 3)
 455         {
 456             char procmem[24];
 457             int fd;
 458
 459             sprintf( procmem, "/proc/%u/mem", process->unix_pid );
 460             if ((fd = open( procmem, O_WRONLY )) != -1)
 461             {
 462                 ssize_t r = pwrite( fd, src, size, ptr );
 463                 close( fd );
 464                 if (r == size)
 465                 {
 466                     ret = 1;
 467                     goto done;
 468                 }
 469             }
 470         }
 471
 472         /* first word is special */
 473         if (len > 1)
 474         {
 475             memcpy( (char *)&data + first_offset, src, sizeof(long) - first_offset );
 476             src += sizeof(long) - first_offset;
 477             if (write_thread_long( thread, addr++, data, first_mask ) == -1) goto done;
 478             first_offset = 0;
 479             len--;
 480         }
 481         else last_mask &= first_mask;
 482
 483         while (len > 1)
 484         {
 485             memcpy( &data, src, sizeof(long) );
 486             src += sizeof(long);
 487             if (write_thread_long( thread, addr++, data, ~0ul ) == -1) goto done;
 488             len--;
 489         }
 490
 491         /* last word is special too */
 492         memcpy( (char *)&data + first_offset, src, last_offset - first_offset );
 493         if (write_thread_long( thread, addr, data, last_mask ) == -1) goto done;
 494         ret = 1;
 495
 496     done:
 497         resume_after_ptrace( thread );
 498     }
 499     return ret;
 500 }
 501
 502 /* retrieve an LDT selector entry */
 503 void get_selector_entry( struct thread *thread, int entry, unsigned int *base,
 504                          unsigned int *limit, unsigned char *flags )
 505 {
 506     if (!thread->process->ldt_copy)
 507     {
 508         set_error( STATUS_ACCESS_DENIED );
 509         return;
 510     }
 511     if (entry >= 8192)
 512     {
 513         set_error( STATUS_ACCESS_VIOLATION );
 514         return;
 515     }
 516     if (suspend_for_ptrace( thread ))
 517     {
 518         unsigned char flags_buf[sizeof(long)];
 519         long *addr = (long *)(unsigned long)thread->process->ldt_copy + entry;
 520         if (read_thread_long( thread, addr, (long *)base ) == -1) goto done;
 521         if (read_thread_long( thread, addr + 8192, (long *)limit ) == -1) goto done;
 522         addr = (long *)(unsigned long)thread->process->ldt_copy + 2*8192 + (entry / sizeof(long));
 523         if (read_thread_long( thread, addr, (long *)flags_buf ) == -1) goto done;
 524         *flags = flags_buf[entry % sizeof(long)];
 525     done:
 526         resume_after_ptrace( thread );
 527     }
 528 }
 529
 530
 531 #if defined(linux) && defined(HAVE_SYS_USER_H) && (defined(__i386__) || defined(__x86_64__))
 532
 533 #include <sys/user.h>
 534
 535 /* debug register offset in struct user */
 536 #define DR_OFFSET(dr) ((((struct user *)0)->u_debugreg) + (dr))
 537
 538 /* retrieve the thread x86 registers */
 539 void get_thread_context( struct thread *thread, context_t *context, unsigned int flags )
 540 {
 541     int i, pid = get_ptrace_tid(thread);
 542     long data[8];
 543
 544     /* all other regs are handled on the client side */
 545     assert( flags == SERVER_CTX_DEBUG_REGISTERS );
 546
 547     if (!suspend_for_ptrace( thread )) return;
 548
 549     for (i = 0; i < 8; i++)
 550     {
 551         if (i == 4 || i == 5) continue;
 552         errno = 0;
 553         data[i] = ptrace( PTRACE_PEEKUSER, pid, DR_OFFSET(i), 0 );
 554         if ((data[i] == -1) && errno)
 555         {
 556             file_set_error();
 557             goto done;
 558         }
 559     }
 560     switch (context->cpu)
 561     {
 562     case CPU_x86:
 563         context->debug.i386_regs.dr0 = data[0];
 564         context->debug.i386_regs.dr1 = data[1];
 565         context->debug.i386_regs.dr2 = data[2];
 566         context->debug.i386_regs.dr3 = data[3];
 567         context->debug.i386_regs.dr6 = data[6];
 568         context->debug.i386_regs.dr7 = data[7];
 569         break;
 570     case CPU_x86_64:
 571         context->debug.x86_64_regs.dr0 = data[0];
 572         context->debug.x86_64_regs.dr1 = data[1];
 573         context->debug.x86_64_regs.dr2 = data[2];
 574         context->debug.x86_64_regs.dr3 = data[3];
 575         context->debug.x86_64_regs.dr6 = data[6];
 576         context->debug.x86_64_regs.dr7 = data[7];
 577         break;
 578     default:
 579         set_error( STATUS_INVALID_PARAMETER );
 580         goto done;
 581     }
 582     context->flags |= SERVER_CTX_DEBUG_REGISTERS;
 583 done:
 584     resume_after_ptrace( thread );
 585 }
 586
 587 /* set the thread x86 registers */
 588 void set_thread_context( struct thread *thread, const context_t *context, unsigned int flags )
 589 {
 590     int pid = get_ptrace_tid( thread );
 591
 592     /* all other regs are handled on the client side */
 593     assert( flags == SERVER_CTX_DEBUG_REGISTERS );
 594
 595     if (!suspend_for_ptrace( thread )) return;
 596
 597     switch (context->cpu)
 598     {
 599     case CPU_x86:
 600         /* Linux 2.6.33+ does DR0-DR3 alignment validation, so it has to know LEN bits first */
 601         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.i386_regs.dr7 & 0xffff0000 ) == -1) goto error;
 602         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(0), context->debug.i386_regs.dr0 ) == -1) goto error;
 603         if (thread->context) thread->context->debug.i386_regs.dr0 = context->debug.i386_regs.dr0;
 604         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(1), context->debug.i386_regs.dr1 ) == -1) goto error;
 605         if (thread->context) thread->context->debug.i386_regs.dr1 = context->debug.i386_regs.dr1;
 606         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(2), context->debug.i386_regs.dr2 ) == -1) goto error;
 607         if (thread->context) thread->context->debug.i386_regs.dr2 = context->debug.i386_regs.dr2;
 608         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(3), context->debug.i386_regs.dr3 ) == -1) goto error;
 609         if (thread->context) thread->context->debug.i386_regs.dr3 = context->debug.i386_regs.dr3;
 610         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(6), context->debug.i386_regs.dr6 ) == -1) goto error;
 611         if (thread->context) thread->context->debug.i386_regs.dr6 = context->debug.i386_regs.dr6;
 612         /* Linux 2.6.33+ needs enable bits set briefly to update value returned by PEEKUSER later */
 613         ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.i386_regs.dr7 | 0x55 );
 614         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.i386_regs.dr7 ) == -1) goto error;
 615         if (thread->context) thread->context->debug.i386_regs.dr7 = context->debug.i386_regs.dr7;
 616         break;
 617     case CPU_x86_64:
 618         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.x86_64_regs.dr7 & 0xffff0000 ) == -1) goto error;
 619         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(0), context->debug.x86_64_regs.dr0 ) == -1) goto error;
 620         if (thread->context) thread->context->debug.x86_64_regs.dr0 = context->debug.x86_64_regs.dr0;
 621         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(1), context->debug.x86_64_regs.dr1 ) == -1) goto error;
 622         if (thread->context) thread->context->debug.x86_64_regs.dr1 = context->debug.x86_64_regs.dr1;
 623         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(2), context->debug.x86_64_regs.dr2 ) == -1) goto error;
 624         if (thread->context) thread->context->debug.x86_64_regs.dr2 = context->debug.x86_64_regs.dr2;
 625         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(3), context->debug.x86_64_regs.dr3 ) == -1) goto error;
 626         if (thread->context) thread->context->debug.x86_64_regs.dr3 = context->debug.x86_64_regs.dr3;
 627         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(6), context->debug.x86_64_regs.dr6 ) == -1) goto error;
 628         if (thread->context) thread->context->debug.x86_64_regs.dr6 = context->debug.x86_64_regs.dr6;
 629         ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.x86_64_regs.dr7 | 0x55 );
 630         if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.x86_64_regs.dr7 ) == -1) goto error;
 631         if (thread->context) thread->context->debug.x86_64_regs.dr7 = context->debug.x86_64_regs.dr7;
 632         break;
 633     default:
 634         set_error( STATUS_INVALID_PARAMETER );
 635     }
 636     resume_after_ptrace( thread );
 637     return;
 638  error:
 639     file_set_error();
 640     resume_after_ptrace( thread );
 641 }
 642
 643 #elif defined(__i386__) && defined(PTRACE_GETDBREGS) && defined(PTRACE_SETDBREGS) && \
 644     (defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__OpenBSD__) || defined(__NetBSD__) || defined(__DragonFly__))
 645
 646 #include <machine/reg.h>
 647
 648 /* retrieve the thread x86 registers */
 649 void get_thread_context( struct thread *thread, context_t *context, unsigned int flags )
 650 {
 651     int pid = get_ptrace_tid(thread);
 652     struct dbreg dbregs;
 653
 654     /* all other regs are handled on the client side */
 655     assert( flags == SERVER_CTX_DEBUG_REGISTERS );
 656
 657     if (!suspend_for_ptrace( thread )) return;
 658
 659     if (ptrace( PTRACE_GETDBREGS, pid, (caddr_t) &dbregs, 0 ) == -1) file_set_error();
 660     else
 661     {
 662 #ifdef DBREG_DRX
 663         /* needed for FreeBSD, the structure fields have changed under 5.x */
 664         context->debug.i386_regs.dr0 = DBREG_DRX((&dbregs), 0);
 665         context->debug.i386_regs.dr1 = DBREG_DRX((&dbregs), 1);
 666         context->debug.i386_regs.dr2 = DBREG_DRX((&dbregs), 2);
 667         context->debug.i386_regs.dr3 = DBREG_DRX((&dbregs), 3);
 668         context->debug.i386_regs.dr6 = DBREG_DRX((&dbregs), 6);
 669         context->debug.i386_regs.dr7 = DBREG_DRX((&dbregs), 7);
 670 #else
 671         context->debug.i386_regs.dr0 = dbregs.dr0;
 672         context->debug.i386_regs.dr1 = dbregs.dr1;
 673         context->debug.i386_regs.dr2 = dbregs.dr2;
 674         context->debug.i386_regs.dr3 = dbregs.dr3;
 675         context->debug.i386_regs.dr6 = dbregs.dr6;
 676         context->debug.i386_regs.dr7 = dbregs.dr7;
 677 #endif
 678         context->flags |= SERVER_CTX_DEBUG_REGISTERS;
 679     }
 680     resume_after_ptrace( thread );
 681 }
 682
 683 /* set the thread x86 registers */
 684 void set_thread_context( struct thread *thread, const context_t *context, unsigned int flags )
 685 {
 686     int pid = get_ptrace_tid(thread);
 687     struct dbreg dbregs;
 688
 689     /* all other regs are handled on the client side */
 690     assert( flags == SERVER_CTX_DEBUG_REGISTERS );
 691
 692     if (!suspend_for_ptrace( thread )) return;
 693
 694 #ifdef DBREG_DRX
 695     /* needed for FreeBSD, the structure fields have changed under 5.x */
 696     DBREG_DRX((&dbregs), 0) = context->debug.i386_regs.dr0;
 697     DBREG_DRX((&dbregs), 1) = context->debug.i386_regs.dr1;
 698     DBREG_DRX((&dbregs), 2) = context->debug.i386_regs.dr2;
 699     DBREG_DRX((&dbregs), 3) = context->debug.i386_regs.dr3;
 700     DBREG_DRX((&dbregs), 4) = 0;
 701     DBREG_DRX((&dbregs), 5) = 0;
 702     DBREG_DRX((&dbregs), 6) = context->debug.i386_regs.dr6;
 703     DBREG_DRX((&dbregs), 7) = context->debug.i386_regs.dr7;
 704 #else
 705     dbregs.dr0 = context->debug.i386_regs.dr0;
 706     dbregs.dr1 = context->debug.i386_regs.dr1;
 707     dbregs.dr2 = context->debug.i386_regs.dr2;
 708     dbregs.dr3 = context->debug.i386_regs.dr3;
 709     dbregs.dr4 = 0;
 710     dbregs.dr5 = 0;
 711     dbregs.dr6 = context->debug.i386_regs.dr6;
 712     dbregs.dr7 = context->debug.i386_regs.dr7;
 713 #endif
 714     if (ptrace( PTRACE_SETDBREGS, pid, (caddr_t) &dbregs, 0 ) == -1) file_set_error();
 715     else if (thread->context)
 716         thread->context->debug.i386_regs = context->debug.i386_regs;  /* update the cached values */
 717     resume_after_ptrace( thread );
 718 }
 719
 720 #else  /* linux || __FreeBSD__ */
 721
 722 /* retrieve the thread x86 registers */
 723 void get_thread_context( struct thread *thread, context_t *context, unsigned int flags )
 724 {
 725 }
 726
 727 /* set the thread x86 debug registers */
 728 void set_thread_context( struct thread *thread, const context_t *context, unsigned int flags )
 729 {
 730 }
 731
 732 #endif  /* linux || __FreeBSD__ */
 733
 734 #endif  /* USE_PTRACE */