/* * 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 "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__ */