2 * PowerPC register context support
4 * Copyright (C) 2002 Marcus Meissner, SuSE Linux AG.
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.
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.
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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
27 #include <sys/types.h>
33 #ifdef HAVE_SYS_PTRACE_H
34 # include <sys/ptrace.h>
37 #ifndef PTRACE_PEEKUSER
39 # define PTRACE_PEEKUSER PT_READ_D
41 #endif /* PTRACE_PEEKUSER */
43 #ifndef PTRACE_POKEUSER
45 # define PTRACE_POKEUSER PT_WRITE_D
47 #endif /* PTRACE_POKEUSER */
55 /* retrieve a thread context */
56 static void get_thread_context( struct thread *thread, unsigned int flags, CONTEXT *context )
58 int pid = get_ptrace_pid(thread);
59 if (flags & CONTEXT_FULL)
61 if (flags & CONTEXT_INTEGER)
63 #define XREG(x,y) if (ptrace( PTRACE_PEEKUSER, pid, (void*)(x<<2), &context->y) == -1) goto error;
64 #define IREG(x) if (ptrace( PTRACE_PEEKUSER, pid, (void*)(x<<2), &context->Gpr##x) == -1) goto error;
65 IREG(0); IREG(1); IREG(2); IREG(3); IREG(4); IREG(5); IREG(6);
66 IREG(7); IREG(8); IREG(9); IREG(10); IREG(11); IREG(12); IREG(13);
67 IREG(14); IREG(15); IREG(16); IREG(17); IREG(18); IREG(19);
68 IREG(20); IREG(21); IREG(22); IREG(23); IREG(24); IREG(25);
69 IREG(26); IREG(27); IREG(28); IREG(29); IREG(30); IREG(31);
74 if (flags & CONTEXT_CONTROL)
79 XREG(36,Lr); /* 36 is LNK ... probably Lr ? */
82 if (flags & CONTEXT_FLOATING_POINT)
84 #define FREG(x) if (ptrace( PTRACE_PEEKUSER, pid, (void*)((48+x*2)<<2), &context->Fpr##x) == -1) goto error;
117 XREG((48+32*2),Fpscr);
127 #define XREG(x,y) if (ptrace( PTRACE_POKEUSER, pid, (void*)(x<<2), &context->y) == -1) goto error;
128 #define IREG(x) if (ptrace( PTRACE_POKEUSER, pid, (void*)(x<<2), &context->Gpr##x) == -1) goto error;
129 #define FREG(x) if (ptrace( PTRACE_POKEUSER, pid, (void*)((48+x*2)<<2), &context->Fpr##x) == -1) goto error;
130 /* set a thread context */
131 static void set_thread_context( struct thread *thread, unsigned int flags, const CONTEXT *context )
133 int pid = get_ptrace_pid(thread);
134 if (flags & CONTEXT_FULL)
136 if (flags & CONTEXT_INTEGER)
138 IREG(0); IREG(1); IREG(2); IREG(3); IREG(4); IREG(5); IREG(6);
139 IREG(7); IREG(8); IREG(9); IREG(10); IREG(11); IREG(12); IREG(13);
140 IREG(14); IREG(15); IREG(16); IREG(17); IREG(18); IREG(19);
141 IREG(20); IREG(21); IREG(22); IREG(23); IREG(24); IREG(25);
142 IREG(26); IREG(27); IREG(28); IREG(29); IREG(30); IREG(31);
147 if (flags & CONTEXT_CONTROL)
155 if (flags & CONTEXT_FLOATING_POINT)
190 XREG((48+32*2),Fpscr);
200 #define IREG(x) to->Gpr##x = from->Gpr##x;
201 #define FREG(x) to->Fpr##x = from->Fpr##x;
202 #define CREG(x) to->x = from->x;
203 /* copy a context structure according to the flags */
204 static void copy_context( CONTEXT *to, const CONTEXT *from, int flags )
206 if (flags & CONTEXT_CONTROL)
212 if (flags & CONTEXT_INTEGER)
214 IREG(0); IREG(1); IREG(2); IREG(3); IREG(4); IREG(5); IREG(6);
215 IREG(7); IREG(8); IREG(9); IREG(10); IREG(11); IREG(12); IREG(13);
216 IREG(14); IREG(15); IREG(16); IREG(17); IREG(18); IREG(19);
217 IREG(20); IREG(21); IREG(22); IREG(23); IREG(24); IREG(25);
218 IREG(26); IREG(27); IREG(28); IREG(29); IREG(30); IREG(31);
222 if (flags & CONTEXT_FLOATING_POINT)
260 /* retrieve the current instruction pointer of a thread */
261 void *get_thread_ip( struct thread *thread )
265 if (suspend_for_ptrace( thread ))
267 get_thread_context( thread, CONTEXT_CONTROL, &context );
268 resume_after_ptrace( thread );
270 return (void *)context.Iar;
273 /* determine if we should continue the thread in single-step mode */
274 int get_thread_single_step( struct thread *thread )
277 if (thread->context) return 0;
278 get_thread_context( thread, CONTEXT_CONTROL, &context );
280 # define MSR_SE (1<<10)
282 return (context.Msr & MSR_SE) != 0;
285 /* send a signal to a specific thread */
286 int tkill( int pid, int sig )
288 /* FIXME: should do something here */
293 /* retrieve the current context of a thread */
294 DECL_HANDLER(get_thread_context)
296 struct thread *thread;
298 int flags = req->flags;
300 if (get_reply_max_size() < sizeof(CONTEXT))
302 set_error( STATUS_INVALID_PARAMETER );
305 if (!(thread = get_thread_from_handle( req->handle, THREAD_GET_CONTEXT ))) return;
307 if ((data = set_reply_data_size( sizeof(CONTEXT) )))
309 if (thread->context) /* thread is inside an exception event */
311 copy_context( data, thread->context, flags );
314 if (flags && suspend_for_ptrace( thread ))
316 get_thread_context( thread, flags, data );
317 resume_after_ptrace( thread );
320 release_object( thread );
324 /* set the current context of a thread */
325 DECL_HANDLER(set_thread_context)
327 struct thread *thread;
328 int flags = req->flags;
330 if (get_req_data_size() < sizeof(CONTEXT))
332 set_error( STATUS_INVALID_PARAMETER );
335 if ((thread = get_thread_from_handle( req->handle, THREAD_SET_CONTEXT )))
337 if (thread->context) /* thread is inside an exception event */
339 copy_context( thread->context, get_req_data(), flags );
342 if (flags && suspend_for_ptrace( thread ))
344 set_thread_context( thread, flags, get_req_data() );
345 resume_after_ptrace( thread );
347 release_object( thread );
351 #endif /* __powerpc__ */