| /* | |
| * PowerPC register context support | |
| * | |
| * Copyright (C) 2002 Marcus Meissner, SuSE Linux AG. | |
| * | |
| * 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 | |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
| */ | |
| #include "config.h" | |
| #ifdef __powerpc__ | |
| #include <assert.h> | |
| #include <errno.h> | |
| #include <sys/types.h> | |
| #ifdef HAVE_SYS_REG_H | |
| # include <sys/reg.h> | |
| #endif | |
| #include <stdarg.h> | |
| #include <unistd.h> | |
| #ifdef HAVE_SYS_PTRACE_H | |
| # include <sys/ptrace.h> | |
| #endif | |
| #ifndef PTRACE_PEEKUSER | |
| # ifdef PT_READ_D | |
| # define PTRACE_PEEKUSER PT_READ_D | |
| # endif | |
| #endif /* PTRACE_PEEKUSER */ | |
| #ifndef PTRACE_POKEUSER | |
| # ifdef PT_WRITE_D | |
| # define PTRACE_POKEUSER PT_WRITE_D | |
| # endif | |
| #endif /* PTRACE_POKEUSER */ | |
| #include "windef.h" | |
| #include "winbase.h" | |
| #include "file.h" | |
| #include "thread.h" | |
| #include "request.h" | |
| /* retrieve a thread context */ | |
| static void get_thread_context( struct thread *thread, unsigned int flags, CONTEXT *context ) | |
| { | |
| int pid = get_ptrace_pid(thread); | |
| if (flags & CONTEXT_FULL) | |
| { | |
| if (flags & CONTEXT_INTEGER) | |
| { | |
| #define XREG(x,y) if (ptrace( PTRACE_PEEKUSER, pid, (void*)(x<<2), &context->y) == -1) goto error; | |
| #define IREG(x) if (ptrace( PTRACE_PEEKUSER, pid, (void*)(x<<2), &context->Gpr##x) == -1) goto error; | |
| IREG(0); IREG(1); IREG(2); IREG(3); IREG(4); IREG(5); IREG(6); | |
| IREG(7); IREG(8); IREG(9); IREG(10); IREG(11); IREG(12); IREG(13); | |
| IREG(14); IREG(15); IREG(16); IREG(17); IREG(18); IREG(19); | |
| IREG(20); IREG(21); IREG(22); IREG(23); IREG(24); IREG(25); | |
| IREG(26); IREG(27); IREG(28); IREG(29); IREG(30); IREG(31); | |
| #undef IREG | |
| XREG(37,Xer); | |
| XREG(38,Cr); | |
| } | |
| if (flags & CONTEXT_CONTROL) | |
| { | |
| XREG(32,Iar); | |
| XREG(33,Msr); | |
| XREG(35,Ctr); | |
| XREG(36,Lr); /* 36 is LNK ... probably Lr ? */ | |
| } | |
| } | |
| if (flags & CONTEXT_FLOATING_POINT) | |
| { | |
| #define FREG(x) if (ptrace( PTRACE_PEEKUSER, pid, (void*)((48+x*2)<<2), &context->Fpr##x) == -1) goto error; | |
| FREG(0); | |
| FREG(1); | |
| FREG(2); | |
| FREG(3); | |
| FREG(4); | |
| FREG(5); | |
| FREG(6); | |
| FREG(7); | |
| FREG(8); | |
| FREG(9); | |
| FREG(10); | |
| FREG(11); | |
| FREG(12); | |
| FREG(13); | |
| FREG(14); | |
| FREG(15); | |
| FREG(16); | |
| FREG(17); | |
| FREG(18); | |
| FREG(19); | |
| FREG(20); | |
| FREG(21); | |
| FREG(22); | |
| FREG(23); | |
| FREG(24); | |
| FREG(25); | |
| FREG(26); | |
| FREG(27); | |
| FREG(28); | |
| FREG(29); | |
| FREG(30); | |
| FREG(31); | |
| XREG((48+32*2),Fpscr); | |
| } | |
| return; | |
| error: | |
| file_set_error(); | |
| } | |
| #undef XREG | |
| #undef IREG | |
| #undef FREG | |
| #define XREG(x,y) if (ptrace( PTRACE_POKEUSER, pid, (void*)(x<<2), &context->y) == -1) goto error; | |
| #define IREG(x) if (ptrace( PTRACE_POKEUSER, pid, (void*)(x<<2), &context->Gpr##x) == -1) goto error; | |
| #define FREG(x) if (ptrace( PTRACE_POKEUSER, pid, (void*)((48+x*2)<<2), &context->Fpr##x) == -1) goto error; | |
| /* set a thread context */ | |
| static void set_thread_context( struct thread *thread, unsigned int flags, const CONTEXT *context ) | |
| { | |
| int pid = get_ptrace_pid(thread); | |
| if (flags & CONTEXT_FULL) | |
| { | |
| if (flags & CONTEXT_INTEGER) | |
| { | |
| IREG(0); IREG(1); IREG(2); IREG(3); IREG(4); IREG(5); IREG(6); | |
| IREG(7); IREG(8); IREG(9); IREG(10); IREG(11); IREG(12); IREG(13); | |
| IREG(14); IREG(15); IREG(16); IREG(17); IREG(18); IREG(19); | |
| IREG(20); IREG(21); IREG(22); IREG(23); IREG(24); IREG(25); | |
| IREG(26); IREG(27); IREG(28); IREG(29); IREG(30); IREG(31); | |
| XREG(37,Xer); | |
| XREG(38,Cr); | |
| } | |
| if (flags & CONTEXT_CONTROL) | |
| { | |
| XREG(32,Iar); | |
| XREG(33,Msr); | |
| XREG(35,Ctr); | |
| XREG(36,Lr); | |
| } | |
| } | |
| if (flags & CONTEXT_FLOATING_POINT) | |
| { | |
| FREG(0); | |
| FREG(1); | |
| FREG(2); | |
| FREG(3); | |
| FREG(4); | |
| FREG(5); | |
| FREG(6); | |
| FREG(7); | |
| FREG(8); | |
| FREG(9); | |
| FREG(10); | |
| FREG(11); | |
| FREG(12); | |
| FREG(13); | |
| FREG(14); | |
| FREG(15); | |
| FREG(16); | |
| FREG(17); | |
| FREG(18); | |
| FREG(19); | |
| FREG(20); | |
| FREG(21); | |
| FREG(22); | |
| FREG(23); | |
| FREG(24); | |
| FREG(25); | |
| FREG(26); | |
| FREG(27); | |
| FREG(28); | |
| FREG(29); | |
| FREG(30); | |
| FREG(31); | |
| #undef FREG | |
| XREG((48+32*2),Fpscr); | |
| } | |
| return; | |
| error: | |
| file_set_error(); | |
| } | |
| #undef XREG | |
| #undef IREG | |
| #undef FREG | |
| #define IREG(x) to->Gpr##x = from->Gpr##x; | |
| #define FREG(x) to->Fpr##x = from->Fpr##x; | |
| #define CREG(x) to->x = from->x; | |
| /* copy a context structure according to the flags */ | |
| static void copy_context( CONTEXT *to, const CONTEXT *from, int flags ) | |
| { | |
| if (flags & CONTEXT_CONTROL) | |
| { | |
| CREG(Msr); | |
| CREG(Ctr); | |
| CREG(Iar); | |
| } | |
| if (flags & CONTEXT_INTEGER) | |
| { | |
| IREG(0); IREG(1); IREG(2); IREG(3); IREG(4); IREG(5); IREG(6); | |
| IREG(7); IREG(8); IREG(9); IREG(10); IREG(11); IREG(12); IREG(13); | |
| IREG(14); IREG(15); IREG(16); IREG(17); IREG(18); IREG(19); | |
| IREG(20); IREG(21); IREG(22); IREG(23); IREG(24); IREG(25); | |
| IREG(26); IREG(27); IREG(28); IREG(29); IREG(30); IREG(31); | |
| CREG(Xer); | |
| CREG(Cr); | |
| } | |
| if (flags & CONTEXT_FLOATING_POINT) | |
| { | |
| FREG(0); | |
| FREG(1); | |
| FREG(2); | |
| FREG(3); | |
| FREG(4); | |
| FREG(5); | |
| FREG(6); | |
| FREG(7); | |
| FREG(8); | |
| FREG(9); | |
| FREG(10); | |
| FREG(11); | |
| FREG(12); | |
| FREG(13); | |
| FREG(14); | |
| FREG(15); | |
| FREG(16); | |
| FREG(17); | |
| FREG(18); | |
| FREG(19); | |
| FREG(20); | |
| FREG(21); | |
| FREG(22); | |
| FREG(23); | |
| FREG(24); | |
| FREG(25); | |
| FREG(26); | |
| FREG(27); | |
| FREG(28); | |
| FREG(29); | |
| FREG(30); | |
| FREG(31); | |
| CREG(Fpscr); | |
| } | |
| } | |
| /* retrieve the current instruction pointer of a thread */ | |
| void *get_thread_ip( struct thread *thread ) | |
| { | |
| CONTEXT context; | |
| context.Iar = 0; | |
| if (suspend_for_ptrace( thread )) | |
| { | |
| get_thread_context( thread, CONTEXT_CONTROL, &context ); | |
| resume_after_ptrace( thread ); | |
| } | |
| return (void *)context.Iar; | |
| } | |
| /* determine if we should continue the thread in single-step mode */ | |
| int get_thread_single_step( struct thread *thread ) | |
| { | |
| CONTEXT context; | |
| if (thread->context) return 0; | |
| get_thread_context( thread, CONTEXT_CONTROL, &context ); | |
| #ifndef MSR_SE | |
| # define MSR_SE (1<<10) | |
| #endif | |
| return (context.Msr & MSR_SE) != 0; | |
| } | |
| /* send a signal to a specific thread */ | |
| int tkill( int pid, int sig ) | |
| { | |
| /* FIXME: should do something here */ | |
| errno = ENOSYS; | |
| return -1; | |
| } | |
| /* retrieve the current context of a thread */ | |
| DECL_HANDLER(get_thread_context) | |
| { | |
| struct thread *thread; | |
| void *data; | |
| int flags = req->flags; | |
| if (get_reply_max_size() < sizeof(CONTEXT)) | |
| { | |
| set_error( STATUS_INVALID_PARAMETER ); | |
| return; | |
| } | |
| if (!(thread = get_thread_from_handle( req->handle, THREAD_GET_CONTEXT ))) return; | |
| if ((data = set_reply_data_size( sizeof(CONTEXT) ))) | |
| { | |
| if (thread->context) /* thread is inside an exception event */ | |
| { | |
| copy_context( data, thread->context, flags ); | |
| flags = 0; | |
| } | |
| if (flags && suspend_for_ptrace( thread )) | |
| { | |
| get_thread_context( thread, flags, data ); | |
| resume_after_ptrace( thread ); | |
| } | |
| } | |
| release_object( thread ); | |
| } | |
| /* set the current context of a thread */ | |
| DECL_HANDLER(set_thread_context) | |
| { | |
| struct thread *thread; | |
| int flags = req->flags; | |
| if (get_req_data_size() < sizeof(CONTEXT)) | |
| { | |
| set_error( STATUS_INVALID_PARAMETER ); | |
| return; | |
| } | |
| if ((thread = get_thread_from_handle( req->handle, THREAD_SET_CONTEXT ))) | |
| { | |
| if (thread->context) /* thread is inside an exception event */ | |
| { | |
| copy_context( thread->context, get_req_data(), flags ); | |
| flags = 0; | |
| } | |
| if (flags && suspend_for_ptrace( thread )) | |
| { | |
| set_thread_context( thread, flags, get_req_data() ); | |
| resume_after_ptrace( thread ); | |
| } | |
| release_object( thread ); | |
| } | |
| } | |
| #endif /* __powerpc__ */ |