ptrace.c 25.1 KB
Newer Older
1 2 3 4
/*
 * Server-side ptrace support
 *
 * Copyright (C) 1999 Alexandre Julliard
5 6 7 8 9 10 11 12 13 14 15 16 17
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * 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 25

#include <assert.h>
#include <errno.h>
26
#include <fcntl.h>
27 28
#include <stdio.h>
#include <signal.h>
29
#include <stdarg.h>
Alexandre Julliard's avatar
Alexandre Julliard committed
30
#include <sys/types.h>
31 32 33
#ifdef HAVE_SYS_PTRACE_H
# include <sys/ptrace.h>
#endif
34 35 36
#ifdef HAVE_SYS_PARAM_H
# include <sys/param.h>
#endif
37
#ifdef HAVE_SYS_WAIT_H
38
# include <sys/wait.h>
39
#endif
40 41 42
#ifdef HAVE_SYS_SYSCALL_H
# include <sys/syscall.h>
#endif
43
#ifdef HAVE_SYS_UCONTEXT_H
44
# include <sys/ucontext.h>
45 46
#endif
#ifdef HAVE_SYS_THR_H
47 48
# include <sys/thr.h>
#endif
49 50
#include <unistd.h>

51 52 53 54
#include "ntstatus.h"
#define WIN32_NO_STATUS
#include "winternl.h"

55
#include "file.h"
56 57 58
#include "process.h"
#include "thread.h"

59 60
#ifdef USE_PTRACE

61 62 63
#ifndef PTRACE_CONT
#define PTRACE_CONT PT_CONTINUE
#endif
64 65 66
#ifndef PTRACE_SINGLESTEP
#define PTRACE_SINGLESTEP PT_STEP
#endif
67 68 69 70 71 72 73 74 75 76 77 78
#ifndef PTRACE_ATTACH
#define PTRACE_ATTACH PT_ATTACH
#endif
#ifndef PTRACE_DETACH
#define PTRACE_DETACH PT_DETACH
#endif
#ifndef PTRACE_PEEKDATA
#define PTRACE_PEEKDATA PT_READ_D
#endif
#ifndef PTRACE_POKEDATA
#define PTRACE_POKEDATA PT_WRITE_D
#endif
79 80 81 82 83 84 85 86 87 88 89 90 91
#ifndef PTRACE_PEEKUSER
#define PTRACE_PEEKUSER PT_READ_U
#endif
#ifndef PTRACE_POKEUSER
#define PTRACE_POKEUSER PT_WRITE_U
#endif

#ifdef PT_GETDBREGS
#define PTRACE_GETDBREGS PT_GETDBREGS
#endif
#ifdef PT_SETDBREGS
#define PTRACE_SETDBREGS PT_SETDBREGS
#endif
92

93
#ifndef HAVE_SYS_PTRACE_H
94 95 96 97 98
#define PT_CONTINUE 0
#define PT_ATTACH   1
#define PT_DETACH   2
#define PT_READ_D   3
#define PT_WRITE_D  4
99
#define PT_STEP     5
100
static inline int ptrace(int req, ...) { errno = EPERM; return -1; /*FAIL*/ }
101
#endif  /* HAVE_SYS_PTRACE_H */
102

103 104 105 106
#ifndef __WALL
#define __WALL 0
#endif

107
/* handle a status returned by waitpid */
108
static int handle_child_status( struct thread *thread, int pid, int status, int want_sig )
109 110 111 112
{
    if (WIFSTOPPED(status))
    {
        int sig = WSTOPSIG(status);
113
        if (debug_level && thread)
114
            fprintf( stderr, "%04x: *signal* signal=%d\n", thread->id, sig );
115
        if (sig != want_sig)
116
        {
117
            /* ignore other signals for now */
118
            ptrace( PTRACE_CONT, pid, (caddr_t)1, sig );
119
        }
120
        return sig;
121
    }
122
    if (thread && (WIFSIGNALED(status) || WIFEXITED(status)))
123
    {
124
        thread->unix_pid = -1;
125
        thread->unix_tid = -1;
126
        if (debug_level)
127 128
        {
            if (WIFSIGNALED(status))
129 130
                fprintf( stderr, "%04x: *exited* signal=%d\n",
                         thread->id, WTERMSIG(status) );
131
            else
132 133
                fprintf( stderr, "%04x: *exited* status=%d\n",
                         thread->id, WEXITSTATUS(status) );
134
        }
135
    }
136 137 138 139
    return 0;
}

/* handle a SIGCHLD signal */
140
void sigchld_callback(void)
141 142 143 144
{
    int pid, status;

    for (;;)
145
    {
146
        if (!(pid = waitpid( -1, &status, WUNTRACED | WNOHANG | __WALL ))) break;
147 148 149 150 151 152
        if (pid != -1)
        {
            struct thread *thread = get_thread_from_tid( pid );
            if (!thread) thread = get_thread_from_pid( pid );
            handle_child_status( thread, pid, status, -1 );
        }
153
        else break;
154
    }
155 156
}

157
/* return the Unix pid to use in ptrace calls for a given process */
158
static int get_ptrace_pid( struct thread *thread )
159 160 161 162 163 164 165 166 167
{
#ifdef linux  /* linux always uses thread id */
    if (thread->unix_tid != -1) return thread->unix_tid;
#endif
    return thread->unix_pid;
}

/* return the Unix tid to use in ptrace calls for a given thread */
static int get_ptrace_tid( struct thread *thread )
168 169 170 171 172
{
    if (thread->unix_tid != -1) return thread->unix_tid;
    return thread->unix_pid;
}

173
/* wait for a ptraced child to get a certain signal */
174
static int waitpid_thread( struct thread *thread, int signal )
175 176 177
{
    int res, status;

178
    start_watchdog();
179
    for (;;)
180
    {
181
        if ((res = waitpid( get_ptrace_pid(thread), &status, WUNTRACED | __WALL )) == -1)
182
        {
183 184 185
            if (errno == EINTR)
            {
                if (!watchdog_triggered()) continue;
186
                if (debug_level) fprintf( stderr, "%04x: *watchdog* waitpid aborted\n", thread->id );
187 188
            }
            else if (errno == ECHILD)  /* must have died */
189 190
            {
                thread->unix_pid = -1;
191
                thread->unix_tid = -1;
192
            }
193
            else perror( "waitpid" );
194
            stop_watchdog();
195
            return 0;
196
        }
197
        res = handle_child_status( thread, res, status, signal );
198 199
        if (!res || res == signal) break;
    }
200
    stop_watchdog();
201
    return (thread->unix_pid != -1);
202 203
}

204 205 206 207
/* send a signal to a specific thread */
static inline int tkill( int tgid, int pid, int sig )
{
#ifdef __linux__
208 209
    int ret = syscall( __NR_tgkill, tgid, pid, sig );
    if (ret < 0 && errno == ENOSYS) ret = syscall( __NR_tkill, pid, sig );
210
    return ret;
211
#elif (defined(__FreeBSD__) || defined (__FreeBSD_kernel__)) && defined(HAVE_THR_KILL2)
212 213 214 215 216
    return thr_kill2( tgid, pid, sig );
#else
    errno = ENOSYS;
    return -1;
#endif
217 218
}

219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235
/* initialize the process tracing mechanism */
void init_tracing_mechanism(void)
{
    /* no initialization needed for ptrace */
}

/* initialize the per-process tracing mechanism */
void init_process_tracing( struct process *process )
{
    /* ptrace setup is done on-demand */
}

/* terminate the per-process tracing mechanism */
void finish_process_tracing( struct process *process )
{
}

236 237 238 239 240 241 242
/* send a Unix signal to a specific thread */
int send_thread_signal( struct thread *thread, int sig )
{
    int ret = -1;

    if (thread->unix_pid != -1)
    {
243 244
        if (thread->unix_tid != -1)
        {
245
            ret = tkill( thread->unix_pid, thread->unix_tid, sig );
246 247
            if (ret == -1 && errno == ENOSYS) ret = kill( thread->unix_pid, sig );
        }
248 249
        else ret = kill( thread->unix_pid, sig );

250 251 252
        if (ret == -1 && errno == ESRCH) /* thread got killed */
        {
            thread->unix_pid = -1;
253
            thread->unix_tid = -1;
254 255
        }
    }
256 257
    if (debug_level && ret != -1)
        fprintf( stderr, "%04x: *sent signal* signal=%d\n", thread->id, sig );
258 259 260
    return (ret != -1);
}

261 262 263 264 265 266 267 268 269 270
/* resume a thread after we have used ptrace on it */
static void resume_after_ptrace( struct thread *thread )
{
    if (thread->unix_pid == -1) return;
    if (ptrace( PTRACE_DETACH, get_ptrace_pid(thread), (caddr_t)1, 0 ) == -1)
    {
        if (errno == ESRCH) thread->unix_pid = thread->unix_tid = -1;  /* thread got killed */
    }
}

271
/* suspend a thread to allow using ptrace on it */
272
/* you must do a resume_after_ptrace when finished with the thread */
273
static int suspend_for_ptrace( struct thread *thread )
274
{
275 276 277
    /* can't stop a thread while initialisation is in progress */
    if (thread->unix_pid == -1 || !is_process_init_done(thread->process)) goto error;

278 279
    /* this may fail if the client is already being debugged */
    if (ptrace( PTRACE_ATTACH, get_ptrace_pid(thread), 0, 0 ) == -1)
280
    {
281 282
        if (errno == ESRCH) thread->unix_pid = thread->unix_tid = -1;  /* thread got killed */
        goto error;
283
    }
284
    if (waitpid_thread( thread, SIGSTOP )) return 1;
285
    resume_after_ptrace( thread );
286
 error:
287 288 289 290
    set_error( STATUS_ACCESS_DENIED );
    return 0;
}

291
/* read a long from a thread address space */
292
static int read_thread_long( struct thread *thread, void *addr, unsigned long *data )
293
{
294
    errno = 0;
295
    *data = ptrace( PTRACE_PEEKDATA, get_ptrace_pid(thread), (caddr_t)addr, 0 );
296
    if ( *data == -1 && errno)
297 298 299 300 301 302 303
    {
        file_set_error();
        return -1;
    }
    return 0;
}

304 305 306 307 308 309 310 311 312 313
static int read_thread_int( struct thread *thread, void *addr, unsigned int *data )
{
    unsigned long long_data;
    int ret;

    ret = read_thread_long( thread, addr, &long_data );
    *data = long_data;
    return ret;
}

314
/* write a long to a thread address space */
315
static long write_thread_long( struct thread *thread, void *addr, unsigned long data, unsigned long mask )
316
{
317 318 319
    unsigned long old_data;
    int res;

320
    if (mask != ~0ul)
321
    {
322 323
        if (read_thread_long( thread, addr, &old_data ) == -1) return -1;
        data = (data & mask) | (old_data & ~mask);
324
    }
325
    if ((res = ptrace( PTRACE_POKEDATA, get_ptrace_pid(thread), (caddr_t)addr, data )) == -1)
326
        file_set_error();
327 328
    return res;
}
329

330 331 332 333 334 335 336 337 338
/* return a thread of the process suitable for ptracing */
static struct thread *get_ptrace_thread( struct process *process )
{
    struct thread *thread;

    LIST_FOR_EACH_ENTRY( thread, &process->thread_list, struct thread, proc_entry )
    {
        if (thread->unix_pid != -1) return thread;
    }
339
    set_error( STATUS_PROCESS_IS_TERMINATING );  /* process is dead */
340 341 342
    return NULL;
}

343
/* read data from a process memory space */
344
int read_process_memory( struct process *process, client_ptr_t ptr, data_size_t size, char *dest )
345
{
346
    struct thread *thread = get_ptrace_thread( process );
347
    unsigned int first_offset, last_offset, len;
348
    unsigned long data, *addr;
349

350
    if (!thread) return 0;
351

352 353 354 355 356 357
    if ((unsigned long)ptr != ptr)
    {
        set_error( STATUS_ACCESS_DENIED );
        return 0;
    }

358 359 360
    first_offset = ptr % sizeof(long);
    last_offset = (size + first_offset) % sizeof(long);
    if (!last_offset) last_offset = sizeof(long);
361

362
    addr = (unsigned long *)(unsigned long)(ptr - first_offset);
363
    len = (size + first_offset + sizeof(long) - 1) / sizeof(long);
364 365 366

    if (suspend_for_ptrace( thread ))
    {
367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384
        if (len > 3)  /* /proc/pid/mem should be faster for large sizes */
        {
            char procmem[24];
            int fd;

            sprintf( procmem, "/proc/%u/mem", process->unix_pid );
            if ((fd = open( procmem, O_RDONLY )) != -1)
            {
                ssize_t ret = pread( fd, dest, size, ptr );
                close( fd );
                if (ret == size)
                {
                    len = 0;
                    goto done;
                }
            }
        }

385 386
        if (len > 1)
        {
387 388 389
            if (read_thread_long( thread, addr++, &data ) == -1) goto done;
            memcpy( dest, (char *)&data + first_offset, sizeof(long) - first_offset );
            dest += sizeof(long) - first_offset;
390 391 392 393 394 395
            first_offset = 0;
            len--;
        }

        while (len > 1)
        {
396 397 398
            if (read_thread_long( thread, addr++, &data ) == -1) goto done;
            memcpy( dest, &data, sizeof(long) );
            dest += sizeof(long);
399 400 401
            len--;
        }

402
        if (read_thread_long( thread, addr++, &data ) == -1) goto done;
403 404 405 406 407 408 409 410 411 412 413
        memcpy( dest, (char *)&data + first_offset, last_offset - first_offset );
        len--;

    done:
        resume_after_ptrace( thread );
    }
    return !len;
}

/* make sure we can write to the whole address range */
/* len is the total size (in ints) */
414
static int check_process_write_access( struct thread *thread, long *addr, data_size_t len )
415 416 417 418 419
{
    int page = get_page_size() / sizeof(int);

    for (;;)
    {
420
        if (write_thread_long( thread, addr, 0, 0 ) == -1) return 0;
421 422 423 424
        if (len <= page) break;
        addr += page;
        len -= page;
    }
425
    return (write_thread_long( thread, addr + len - 1, 0, 0 ) != -1);
426 427 428
}

/* write data to a process memory space */
429
int write_process_memory( struct process *process, client_ptr_t ptr, data_size_t size, const char *src )
430
{
431
    struct thread *thread = get_ptrace_thread( process );
432 433
    int ret = 0;
    long data = 0;
434
    data_size_t len;
435 436
    long *addr;
    unsigned long first_mask, first_offset, last_mask, last_offset;
437

438
    if (!thread) return 0;
439

440 441 442 443 444 445
    if ((unsigned long)ptr != ptr)
    {
        set_error( STATUS_ACCESS_DENIED );
        return 0;
    }

446
    /* compute the mask for the first long */
447
    first_mask = ~0;
448
    first_offset = ptr % sizeof(long);
449 450
    memset( &first_mask, 0, first_offset );

451 452 453
    /* compute the mask for the last long */
    last_offset = (size + first_offset) % sizeof(long);
    if (!last_offset) last_offset = sizeof(long);
454 455 456
    last_mask = 0;
    memset( &last_mask, 0xff, last_offset );

457 458
    addr = (long *)(unsigned long)(ptr - first_offset);
    len = (size + first_offset + sizeof(long) - 1) / sizeof(long);
459 460 461 462 463 464 465 466

    if (suspend_for_ptrace( thread ))
    {
        if (!check_process_write_access( thread, addr, len ))
        {
            set_error( STATUS_ACCESS_DENIED );
            goto done;
        }
467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485

        if (len > 3)
        {
            char procmem[24];
            int fd;

            sprintf( procmem, "/proc/%u/mem", process->unix_pid );
            if ((fd = open( procmem, O_WRONLY )) != -1)
            {
                ssize_t r = pwrite( fd, src, size, ptr );
                close( fd );
                if (r == size)
                {
                    ret = 1;
                    goto done;
                }
            }
        }

486 487 488
        /* first word is special */
        if (len > 1)
        {
489 490 491
            memcpy( (char *)&data + first_offset, src, sizeof(long) - first_offset );
            src += sizeof(long) - first_offset;
            if (write_thread_long( thread, addr++, data, first_mask ) == -1) goto done;
492 493 494 495 496 497 498
            first_offset = 0;
            len--;
        }
        else last_mask &= first_mask;

        while (len > 1)
        {
499 500 501
            memcpy( &data, src, sizeof(long) );
            src += sizeof(long);
            if (write_thread_long( thread, addr++, data, ~0ul ) == -1) goto done;
502 503 504 505 506
            len--;
        }

        /* last word is special too */
        memcpy( (char *)&data + first_offset, src, last_offset - first_offset );
507
        if (write_thread_long( thread, addr, data, last_mask ) == -1) goto done;
508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526
        ret = 1;

    done:
        resume_after_ptrace( thread );
    }
    return ret;
}

/* retrieve an LDT selector entry */
void get_selector_entry( struct thread *thread, int entry, unsigned int *base,
                         unsigned int *limit, unsigned char *flags )
{
    if (!thread->process->ldt_copy)
    {
        set_error( STATUS_ACCESS_DENIED );
        return;
    }
    if (entry >= 8192)
    {
527
        set_error( STATUS_ACCESS_VIOLATION );
528 529 530 531
        return;
    }
    if (suspend_for_ptrace( thread ))
    {
532
        unsigned int flags_buf;
533
        unsigned long addr = (unsigned long)thread->process->ldt_copy + (entry * 4);
534 535 536

        if (read_thread_int( thread, (void *)addr, base ) == -1) goto done;
        if (read_thread_int( thread, (void *)(addr + (8192 * 4)), limit ) == -1) goto done;
537
        addr = (unsigned long)thread->process->ldt_copy + (2 * 8192 * 4) + (entry & ~3);
538 539
        if (read_thread_int( thread, (void *)addr, &flags_buf ) == -1) goto done;
        *flags = flags_buf >> (entry & 3) * 8;
540 541 542 543
    done:
        resume_after_ptrace( thread );
    }
}
544 545


546 547
#if defined(linux) && (defined(HAVE_SYS_USER_H) || defined(HAVE_ASM_USER_H)) \
    && (defined(__i386__) || defined(__x86_64__))
548

549
#ifdef HAVE_SYS_USER_H
550
#include <sys/user.h>
551
#elif defined(HAVE_ASM_USER_H)
552 553
#include <asm/user.h>
#endif
554 555

/* debug register offset in struct user */
556
#define DR_OFFSET(dr) ((((struct user *)0)->u_debugreg) + (dr))
557

558 559 560
/* initialize registers in new thread if necessary */
void init_thread_context( struct thread *thread )
{
561 562
    /* Linux doesn't clear all registers, but hopefully enough to avoid spurious breakpoints */
    thread->system_regs = 0;
563 564
}

565
/* retrieve the thread x86 registers */
566
void get_thread_context( struct thread *thread, context_t *context, unsigned int flags )
567
{
568
    int i, pid = get_ptrace_tid(thread);
569
    long data[8];
570 571

    /* all other regs are handled on the client side */
572
    assert( flags == SERVER_CTX_DEBUG_REGISTERS );
573 574 575

    if (!suspend_for_ptrace( thread )) return;

576 577 578 579 580 581 582
    if (!(thread->system_regs & SERVER_CTX_DEBUG_REGISTERS))
    {
        /* caller has initialized everything to 0 already, just return */
        context->flags |= SERVER_CTX_DEBUG_REGISTERS;
        goto done;
    }

583 584 585 586 587 588 589 590 591 592 593
    for (i = 0; i < 8; i++)
    {
        if (i == 4 || i == 5) continue;
        errno = 0;
        data[i] = ptrace( PTRACE_PEEKUSER, pid, DR_OFFSET(i), 0 );
        if ((data[i] == -1) && errno)
        {
            file_set_error();
            goto done;
        }
    }
594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615
    switch (context->cpu)
    {
    case CPU_x86:
        context->debug.i386_regs.dr0 = data[0];
        context->debug.i386_regs.dr1 = data[1];
        context->debug.i386_regs.dr2 = data[2];
        context->debug.i386_regs.dr3 = data[3];
        context->debug.i386_regs.dr6 = data[6];
        context->debug.i386_regs.dr7 = data[7];
        break;
    case CPU_x86_64:
        context->debug.x86_64_regs.dr0 = data[0];
        context->debug.x86_64_regs.dr1 = data[1];
        context->debug.x86_64_regs.dr2 = data[2];
        context->debug.x86_64_regs.dr3 = data[3];
        context->debug.x86_64_regs.dr6 = data[6];
        context->debug.x86_64_regs.dr7 = data[7];
        break;
    default:
        set_error( STATUS_INVALID_PARAMETER );
        goto done;
    }
616
    context->flags |= SERVER_CTX_DEBUG_REGISTERS;
617
done:
618 619 620 621
    resume_after_ptrace( thread );
}

/* set the thread x86 registers */
622
void set_thread_context( struct thread *thread, const context_t *context, unsigned int flags )
623
{
624
    int pid = get_ptrace_tid( thread );
625 626

    /* all other regs are handled on the client side */
627
    assert( flags == SERVER_CTX_DEBUG_REGISTERS );
628 629 630

    if (!suspend_for_ptrace( thread )) return;

631 632 633
    switch (context->cpu)
    {
    case CPU_x86:
634 635
        /* Linux 2.6.33+ does DR0-DR3 alignment validation, so it has to know LEN bits first */
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.i386_regs.dr7 & 0xffff0000 ) == -1) goto error;
636 637 638 639 640 641 642 643 644 645
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(0), context->debug.i386_regs.dr0 ) == -1) goto error;
        if (thread->context) thread->context->debug.i386_regs.dr0 = context->debug.i386_regs.dr0;
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(1), context->debug.i386_regs.dr1 ) == -1) goto error;
        if (thread->context) thread->context->debug.i386_regs.dr1 = context->debug.i386_regs.dr1;
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(2), context->debug.i386_regs.dr2 ) == -1) goto error;
        if (thread->context) thread->context->debug.i386_regs.dr2 = context->debug.i386_regs.dr2;
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(3), context->debug.i386_regs.dr3 ) == -1) goto error;
        if (thread->context) thread->context->debug.i386_regs.dr3 = context->debug.i386_regs.dr3;
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(6), context->debug.i386_regs.dr6 ) == -1) goto error;
        if (thread->context) thread->context->debug.i386_regs.dr6 = context->debug.i386_regs.dr6;
646 647
        /* Linux 2.6.33+ needs enable bits set briefly to update value returned by PEEKUSER later */
        ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.i386_regs.dr7 | 0x55 );
648 649
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.i386_regs.dr7 ) == -1) goto error;
        if (thread->context) thread->context->debug.i386_regs.dr7 = context->debug.i386_regs.dr7;
650
        thread->system_regs |= SERVER_CTX_DEBUG_REGISTERS;
651 652
        break;
    case CPU_x86_64:
653
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.x86_64_regs.dr7 & 0xffff0000 ) == -1) goto error;
654 655 656 657 658 659 660 661 662 663
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(0), context->debug.x86_64_regs.dr0 ) == -1) goto error;
        if (thread->context) thread->context->debug.x86_64_regs.dr0 = context->debug.x86_64_regs.dr0;
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(1), context->debug.x86_64_regs.dr1 ) == -1) goto error;
        if (thread->context) thread->context->debug.x86_64_regs.dr1 = context->debug.x86_64_regs.dr1;
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(2), context->debug.x86_64_regs.dr2 ) == -1) goto error;
        if (thread->context) thread->context->debug.x86_64_regs.dr2 = context->debug.x86_64_regs.dr2;
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(3), context->debug.x86_64_regs.dr3 ) == -1) goto error;
        if (thread->context) thread->context->debug.x86_64_regs.dr3 = context->debug.x86_64_regs.dr3;
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(6), context->debug.x86_64_regs.dr6 ) == -1) goto error;
        if (thread->context) thread->context->debug.x86_64_regs.dr6 = context->debug.x86_64_regs.dr6;
664
        ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.x86_64_regs.dr7 | 0x55 );
665 666
        if (ptrace( PTRACE_POKEUSER, pid, DR_OFFSET(7), context->debug.x86_64_regs.dr7 ) == -1) goto error;
        if (thread->context) thread->context->debug.x86_64_regs.dr7 = context->debug.x86_64_regs.dr7;
667
        thread->system_regs |= SERVER_CTX_DEBUG_REGISTERS;
668 669 670 671
        break;
    default:
        set_error( STATUS_INVALID_PARAMETER );
    }
672 673 674 675 676 677 678 679
    resume_after_ptrace( thread );
    return;
 error:
    file_set_error();
    resume_after_ptrace( thread );
}

#elif defined(__i386__) && defined(PTRACE_GETDBREGS) && defined(PTRACE_SETDBREGS) && \
680
    (defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__OpenBSD__) || defined(__NetBSD__) || defined(__DragonFly__))
681 682 683

#include <machine/reg.h>

684 685 686
/* initialize registers in new thread if necessary */
void init_thread_context( struct thread *thread )
{
687 688 689 690 691 692 693 694 695 696 697 698
    if (!(thread->system_regs & SERVER_CTX_DEBUG_REGISTERS)) return;

    /* FreeBSD doesn't clear the debug registers in new threads */
    if (suspend_for_ptrace( thread ))
    {
        struct dbreg dbregs;

        memset( &dbregs, 0, sizeof(dbregs) );
        ptrace( PTRACE_SETDBREGS, get_ptrace_tid( thread ), (caddr_t)&dbregs, 0 );
        resume_after_ptrace( thread );
    }
    thread->system_regs = 0;
699 700
}

701
/* retrieve the thread x86 registers */
702
void get_thread_context( struct thread *thread, context_t *context, unsigned int flags )
703
{
704
    int pid = get_ptrace_tid(thread);
705 706 707
    struct dbreg dbregs;

    /* all other regs are handled on the client side */
708
    assert( flags == SERVER_CTX_DEBUG_REGISTERS );
709 710 711 712 713 714 715 716

    if (!suspend_for_ptrace( thread )) return;

    if (ptrace( PTRACE_GETDBREGS, pid, (caddr_t) &dbregs, 0 ) == -1) file_set_error();
    else
    {
#ifdef DBREG_DRX
        /* needed for FreeBSD, the structure fields have changed under 5.x */
717 718 719 720 721 722
        context->debug.i386_regs.dr0 = DBREG_DRX((&dbregs), 0);
        context->debug.i386_regs.dr1 = DBREG_DRX((&dbregs), 1);
        context->debug.i386_regs.dr2 = DBREG_DRX((&dbregs), 2);
        context->debug.i386_regs.dr3 = DBREG_DRX((&dbregs), 3);
        context->debug.i386_regs.dr6 = DBREG_DRX((&dbregs), 6);
        context->debug.i386_regs.dr7 = DBREG_DRX((&dbregs), 7);
723
#else
724 725 726 727 728 729
        context->debug.i386_regs.dr0 = dbregs.dr0;
        context->debug.i386_regs.dr1 = dbregs.dr1;
        context->debug.i386_regs.dr2 = dbregs.dr2;
        context->debug.i386_regs.dr3 = dbregs.dr3;
        context->debug.i386_regs.dr6 = dbregs.dr6;
        context->debug.i386_regs.dr7 = dbregs.dr7;
730
#endif
731
        context->flags |= SERVER_CTX_DEBUG_REGISTERS;
732 733 734 735 736
    }
    resume_after_ptrace( thread );
}

/* set the thread x86 registers */
737
void set_thread_context( struct thread *thread, const context_t *context, unsigned int flags )
738
{
739
    int pid = get_ptrace_tid(thread);
740 741 742
    struct dbreg dbregs;

    /* all other regs are handled on the client side */
743
    assert( flags == SERVER_CTX_DEBUG_REGISTERS );
744 745 746 747 748

    if (!suspend_for_ptrace( thread )) return;

#ifdef DBREG_DRX
    /* needed for FreeBSD, the structure fields have changed under 5.x */
749 750 751 752
    DBREG_DRX((&dbregs), 0) = context->debug.i386_regs.dr0;
    DBREG_DRX((&dbregs), 1) = context->debug.i386_regs.dr1;
    DBREG_DRX((&dbregs), 2) = context->debug.i386_regs.dr2;
    DBREG_DRX((&dbregs), 3) = context->debug.i386_regs.dr3;
753 754
    DBREG_DRX((&dbregs), 4) = 0;
    DBREG_DRX((&dbregs), 5) = 0;
755 756
    DBREG_DRX((&dbregs), 6) = context->debug.i386_regs.dr6;
    DBREG_DRX((&dbregs), 7) = context->debug.i386_regs.dr7;
757
#else
758 759 760 761
    dbregs.dr0 = context->debug.i386_regs.dr0;
    dbregs.dr1 = context->debug.i386_regs.dr1;
    dbregs.dr2 = context->debug.i386_regs.dr2;
    dbregs.dr3 = context->debug.i386_regs.dr3;
762 763
    dbregs.dr4 = 0;
    dbregs.dr5 = 0;
764 765
    dbregs.dr6 = context->debug.i386_regs.dr6;
    dbregs.dr7 = context->debug.i386_regs.dr7;
766
#endif
767 768 769 770 771 772 773 774
    if (ptrace( PTRACE_SETDBREGS, pid, (caddr_t)&dbregs, 0 ) != -1)
    {
        if (thread->context)
            thread->context->debug.i386_regs = context->debug.i386_regs;  /* update the cached values */
        thread->system_regs |= SERVER_CTX_DEBUG_REGISTERS;
    }
    else file_set_error();

775 776 777 778 779
    resume_after_ptrace( thread );
}

#else  /* linux || __FreeBSD__ */

780 781 782 783 784
/* initialize registers in new thread if necessary */
void init_thread_context( struct thread *thread )
{
}

785
/* retrieve the thread x86 registers */
786
void get_thread_context( struct thread *thread, context_t *context, unsigned int flags )
787 788 789 790
{
}

/* set the thread x86 debug registers */
791
void set_thread_context( struct thread *thread, const context_t *context, unsigned int flags )
792 793 794 795
{
}

#endif  /* linux || __FreeBSD__ */
796 797

#endif  /* USE_PTRACE */