1e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata/*
2e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * This file is part of ltrace.
344ae188c8dcd2727e383dcac0d46c3f784d0da5fPetr Machata * Copyright (C) 2011,2012,2013 Petr Machata, Red Hat Inc.
4e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * Copyright (C) 2008,2009 Juan Cespedes
5e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * Copyright (C) 2006 Ian Wienand
6e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata *
7e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * This program is free software; you can redistribute it and/or
8e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * modify it under the terms of the GNU General Public License as
9e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * published by the Free Software Foundation; either version 2 of the
10e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * License, or (at your option) any later version.
11e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata *
12e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * This program is distributed in the hope that it will be useful, but
13e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * WITHOUT ANY WARRANTY; without even the implied warranty of
14e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * General Public License for more details.
16e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata *
17e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * You should have received a copy of the GNU General Public License
18e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * along with this program; if not, write to the Free Software
19e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
20e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata * 02110-1301 USA
21e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata */
22e99af270a60891e68d465c4cd97dbe29cd1a05e4Petr Machata
235570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand#include "config.h"
245570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand
255570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand#include <sys/types.h>
265570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand#include <sys/ptrace.h>
2712387c439d08755c0d8edf2516677d3f7b1f6ef0Petr Machata#include <errno.h>
285570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand
292d45b1a8e26a36a9f85dc49e721c4390ca93dc40Ian Wienand#include <asm/ptrace_offsets.h>
302d45b1a8e26a36a9f85dc49e721c4390ca93dc40Ian Wienand#include <asm/rse.h>
315570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand
325570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand#include <stddef.h>
33366c2f46d844f040458df9b7e35fc3b8527ed2d3Petr Machata#include "proc.h"
34f728123bd75a65a6a1536e198c3c30719e494e71Juan Cespedes#include "common.h"
355570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand
36f13505251e6402460f6cc7ec84e0d8ca91607b4fJuan Cespedesvoid *
37929bd57ca202fd2f2e8485ebf65d683e664f67b5Petr Machataget_instruction_pointer(struct process *proc)
38929bd57ca202fd2f2e8485ebf65d683e664f67b5Petr Machata{
395570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand	unsigned long ip = ptrace(PTRACE_PEEKUSER, proc->pid, PT_CR_IIP, 0);
402d45b1a8e26a36a9f85dc49e721c4390ca93dc40Ian Wienand	unsigned long slot =
412d45b1a8e26a36a9f85dc49e721c4390ca93dc40Ian Wienand	    (ptrace(PTRACE_PEEKUSER, proc->pid, PT_CR_IPSR, 0) >> 41) & 3;
422d45b1a8e26a36a9f85dc49e721c4390ca93dc40Ian Wienand
432d45b1a8e26a36a9f85dc49e721c4390ca93dc40Ian Wienand	return (void *)(ip | slot);
445570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand}
455570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand
46f13505251e6402460f6cc7ec84e0d8ca91607b4fJuan Cespedesvoid
47929bd57ca202fd2f2e8485ebf65d683e664f67b5Petr Machataset_instruction_pointer(struct process *proc, void *addr)
48929bd57ca202fd2f2e8485ebf65d683e664f67b5Petr Machata{
495570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand
505570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand	unsigned long newip = (unsigned long)addr;
51a841f6592e75d78620ee9e645af22a58c9e3bbf9Olaf Hering	unsigned long slot = (unsigned long)addr & 0xf;
525570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand	unsigned long psr = ptrace(PTRACE_PEEKUSER, proc->pid, PT_CR_IPSR, 0);
532d45b1a8e26a36a9f85dc49e721c4390ca93dc40Ian Wienand
545570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand	psr &= ~(3UL << 41);
55a841f6592e75d78620ee9e645af22a58c9e3bbf9Olaf Hering	psr |= (slot & 0x3) << 41;
562d45b1a8e26a36a9f85dc49e721c4390ca93dc40Ian Wienand
575570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand	newip &= ~0xfUL;
585570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand
595570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand	ptrace(PTRACE_POKEUSER, proc->pid, PT_CR_IIP, (long)newip);
605570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand	ptrace(PTRACE_POKEUSER, proc->pid, PT_CR_IPSR, psr);
615570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand}
625570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand
63f13505251e6402460f6cc7ec84e0d8ca91607b4fJuan Cespedesvoid *
64929bd57ca202fd2f2e8485ebf65d683e664f67b5Petr Machataget_stack_pointer(struct process *proc)
65929bd57ca202fd2f2e8485ebf65d683e664f67b5Petr Machata{
6612387c439d08755c0d8edf2516677d3f7b1f6ef0Petr Machata	long l = ptrace(PTRACE_PEEKUSER, proc->pid, PT_R12, 0);
6712387c439d08755c0d8edf2516677d3f7b1f6ef0Petr Machata	if (l == -1 && errno)
6812387c439d08755c0d8edf2516677d3f7b1f6ef0Petr Machata		return NULL;
6912387c439d08755c0d8edf2516677d3f7b1f6ef0Petr Machata	return (void *)l;
705570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand}
715570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand
72f13505251e6402460f6cc7ec84e0d8ca91607b4fJuan Cespedesvoid *
73929bd57ca202fd2f2e8485ebf65d683e664f67b5Petr Machataget_return_addr(struct process *proc, void *stack_pointer)
74929bd57ca202fd2f2e8485ebf65d683e664f67b5Petr Machata{
7512387c439d08755c0d8edf2516677d3f7b1f6ef0Petr Machata	long l = ptrace(PTRACE_PEEKUSER, proc->pid, PT_B0, 0);
7612387c439d08755c0d8edf2516677d3f7b1f6ef0Petr Machata	if (l == -1 && errno)
7712387c439d08755c0d8edf2516677d3f7b1f6ef0Petr Machata		return NULL;
7812387c439d08755c0d8edf2516677d3f7b1f6ef0Petr Machata	return (void *)l;
795570a7769869a4df25ef85f302f74a7feb6c0cd3Ian Wienand}
80