/* Fetch live process registers from TID.

   Copyright (C) 2015 Oracle, In

   This file is part of elfutils.

   This file is free software; you can redistribute it and/or modify

   it under the terms of either

     * the GNU Lesser General Public License as published by the Free

       Software Foundation; either version 3 of the License, or (at

       your option) any later version

   or

     * the GNU General Public License as published by the Free

       Software Foundation; either version 2 of the License, or (at

       your option) any later version

   or both in parallel, as here.

   elfutils 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

   General Public License for more details.

   You should have received copies of the GNU General Public License and

   the GNU Lesser General Public License along with this program.  If

   not, see <http://www.gnu.org/licenses/>.  */

#ifdef HAVE_CONFIG_H

# include <config.h>

#endif

#include "system.h"

#include <stdlib.h>

#ifdef __sparc__

# include <asm/ptrace.h>

# include <sys/ptrace.h>

#endif

#define BACKEND sparc_

#include "libebl_CPU.h"

bool

EBLHOOK (set_initial_registers_tid) (pid_t tid __attribute__ ((unused)),

                                     ebl_tid_registers_t *setfunc __attribute__ ((unused)),

                                     void *arg __attribute__ ((unused)))

{

#if !defined(__sparc__) || !defined( __arch64__)

  return false;

#else /* __sparc__ */

  /* The pt_regs structure filled in by PTRACE_GETREGS provides the

     PC, the global registers and the output registers.  Note how the

     %g0 register is not explicitly provided in the structure (it's

     value is always 0) and the resulting weird packing in the u_regs

     array: the last element is not used.  */

  struct pt_regs regs;

  if (ptrace (PTRACE_GETREGS, tid, &regs, 0) == -1)

    return false;

  /* PC: no DWARF number  */

  if (!setfunc (-1, 1, (Dwarf_Word *) &regs.tpc, arg))

    return false;

  /* Global registers: DWARF 0 .. 7  */

  Dwarf_Word zero = 0;

  if (!setfunc (0, 1, &zero, arg))

    return false;

  if (!setfunc (1, 7, (Dwarf_Word *) &regs.u_regs[0], arg))

    return false;

  /* Output registers: DWARF  8 .. 15  */

  if (!setfunc (8, 8, (Dwarf_Word *) &regs.u_regs[7], arg))

    return false;

  /* Local and input registers must be read from the stack.  They are

     saved in the previous stack frame.  The stack pointer is %o6,

     read above.  */

  Dwarf_Word locals_outs[16];

  Dwarf_Word sp = regs.u_regs[13];

  if (sp & 1)

    {

      /* Registers are 64 bits, and we need to apply the 2047 stack

         bias in order to get the real stack pointer.  */

      sp += 2047;

      for (unsigned i = 0; i < 16; i++)

        {

          locals_outs[i] = ptrace (PTRACE_PEEKDATA, tid,

                                   (void *) (uintptr_t) (sp + (i * 8)),

                                   NULL);

          if (errno != 0)

            return false;

        }

    }

  else

    {

      /* Registers are 32 bits.  */

      for (unsigned i = 0; i < 8; i++)

        {

          Dwarf_Word tuple = ptrace (PTRACE_PEEKDATA, tid,

                                     (void *) (uintptr_t) (sp + (i * 8)),

                                     NULL);

          if (errno != 0)

            return false;

          locals_outs[2*i] = (tuple >> 32) & 0xffffffff;

          locals_outs[2*i+1] = tuple & 0xffffffff;

        }

    }

  /* Local registers:  DWARF 16 .. 23 */

  if (!setfunc (16, 8, &locals_outs[0], arg))

    return false;

  /* Input registers: DWARF 24 .. 31 */

  if (!setfunc (24, 8, &locals_outs[8], arg))

    return false;

  return true;

#endif

}