text: /* Dump registers.
     Copyright (C) 1998-2017 Free Software Foundation, Inc.
     This file is part of the GNU C Library.
     Contributed by Andreas Schwab <schwab@gnu.org>.
  
     The GNU C 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.
  
     The GNU C 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 the GNU C Library.  If not, see
     <http://www.gnu.org/licenses/>.  */
  
  #include <stddef.h>
  #include <sys/uio.h>
  #include <_itoa.h>
  
  /* We will print the register dump in this format:
  
    D0: XXXXXXXX   D1: XXXXXXXX   D2: XXXXXXXX   D3: XXXXXXXX
    D4: XXXXXXXX   D5: XXXXXXXX   D6: XXXXXXXX   D7: XXXXXXXX
    A0: XXXXXXXX   A1: XXXXXXXX   A2: XXXXXXXX   A3: XXXXXXXX
    A4: XXXXXXXX   A5: XXXXXXXX   A6: XXXXXXXX   A7: XXXXXXXX
    PC: XXXXXXXX   SR: XXXX
  
    OldMask: XXXXXXXX  Vector: XXXX
  
    FP0: XXXXXXXXXXXXXXXXXXXXXXXX   FP1: XXXXXXXXXXXXXXXXXXXXXXXX
    FP2: XXXXXXXXXXXXXXXXXXXXXXXX   FP3: XXXXXXXXXXXXXXXXXXXXXXXX
    FP4: XXXXXXXXXXXXXXXXXXXXXXXX   FP5: XXXXXXXXXXXXXXXXXXXXXXXX
    FP6: XXXXXXXXXXXXXXXXXXXXXXXX   FP7: XXXXXXXXXXXXXXXXXXXXXXXX
    FPCR: XXXXXXXX   FPSR: XXXXXXXX   FPIAR: XXXXXXXX
  
  */
  
  /* Linux saves only the call-clobbered registers in the sigcontext.  We
     need to use a trampoline that saves the rest so that the C code can
     access them.  We use the sc_fpstate field, since the handler is not
     supposed to return anyway, thus it doesn't matter that it's clobbered.  */
  
  /* static */ void catch_segfault (int, int, struct sigcontext *);
  
  /* Dummy function so that we can use asm with arguments.  */
  static void __attribute_used__
  __dummy__ (void)
  {
    asm ("\n\
  catch_segfault:\n\
  	move.l 12(%%sp),%%a0\n\
  	lea %c0(%%a0),%%a0\n\
  	/* Clear the first 4 bytes to make it a null fp state, just\n\
  	   in case the handler does return.  */\n\
  	clr.l (%%a0)+\n\
  	movem.l %%d2-%%d7/%%a2-%%a6,(%%a0)\n"
  #ifndef __mcoldfire__
         "fmovem.x %%fp2-%%fp7,11*4(%%a0)\n"
  #elif defined __mcffpu__
         "fmovem.d %%fp2-%%fp7,11*4(%%a0)\n"
  #endif
         "jra real_catch_segfault"
         : : "n" (offsetof (struct sigcontext, sc_fpstate)));
  }
  #define catch_segfault(a,b) \
    __attribute_used__ real_catch_segfault(a,b)
  
  static void
  hexvalue (unsigned long int value, char *buf, size_t len)
  {
    char *cp = _itoa_word (value, buf + len, 16, 0);
    while (cp > buf)
      *--cp = '0';
  }
  
  static void
  register_dump (int fd, struct sigcontext *ctx)
  {
    char regs[20][8];
    char fpregs[11][24];
    struct iovec iov[63], *next_iov = iov;
    unsigned long *p = (unsigned long *) ctx->sc_fpstate + 1;
    unsigned long *pfp = (unsigned long *) ctx->sc_fpregs;
    int i, j, fpreg_size;
  
  #define ADD_STRING(str) \
    next_iov->iov_base = (char *) (str); \
    next_iov->iov_len = strlen (str); \
    ++next_iov
  #define ADD_MEM(str, len) \
    next_iov->iov_base = (str); \
    next_iov->iov_len = (len); \
    ++next_iov
  
  #ifdef __mcoldfire__
    fpreg_size = 16;
  #else
    fpreg_size = 24;
  #endif
  
    /* Generate strings of register contents.  */
    hexvalue (ctx->sc_d0, regs[0], 8);
    hexvalue (ctx->sc_d1, regs[1], 8);
    hexvalue (*p++, regs[2], 8);
    hexvalue (*p++, regs[3], 8);
    hexvalue (*p++, regs[4], 8);
    hexvalue (*p++, regs[5], 8);
    hexvalue (*p++, regs[6], 8);
    hexvalue (*p++, regs[7], 8);
    hexvalue (ctx->sc_a0, regs[8], 8);
    hexvalue (ctx->sc_a1, regs[9], 8);
    hexvalue (*p++, regs[10], 8);
    hexvalue (*p++, regs[11], 8);
    hexvalue (*p++, regs[12], 8);
    hexvalue (*p++, regs[13], 8);
    hexvalue (*p++, regs[14], 8);
    hexvalue (ctx->sc_usp, regs[15], 8);
    hexvalue (ctx->sc_pc, regs[16], 8);
    hexvalue (ctx->sc_sr, regs[17], 4);
    hexvalue (ctx->sc_mask, regs[18], 8);
    hexvalue (ctx->sc_formatvec & 0xfff, regs[19], 4);
    for (i = 0; i < 2; i++)
      for (j = 0; j < fpreg_size; j += 8)
        hexvalue (*pfp++, fpregs[i] + j, 8);
    for (i = 2; i < 8; i++)
      for (j = 0; j < fpreg_size; j += 8)
        hexvalue (*p++, fpregs[i] + j, 8);
    hexvalue (ctx->sc_fpcntl[0], fpregs[8], 8);
    hexvalue (ctx->sc_fpcntl[1], fpregs[9], 8);
    hexvalue (ctx->sc_fpcntl[2], fpregs[10], 8);
  
    /* Generate the output.  */
    ADD_STRING ("Register dump:\n\n  D0: ");
    ADD_MEM (regs[0], 8);
    ADD_STRING ("  D1: ");
    ADD_MEM (regs[1], 8);
    ADD_STRING ("  D2: ");
    ADD_MEM (regs[2], 8);
    ADD_STRING ("  D3: ");
    ADD_MEM (regs[3], 8);
    ADD_STRING ("\n  D4: ");
    ADD_MEM (regs[4], 8);
    ADD_STRING ("  D5: ");
    ADD_MEM (regs[5], 8);
    ADD_STRING ("  D6: ");
    ADD_MEM (regs[6], 8);
    ADD_STRING ("  D7: ");
    ADD_MEM (regs[7], 8);
    ADD_STRING ("\n  A0: ");
    ADD_MEM (regs[8], 8);
    ADD_STRING ("  A1: ");
    ADD_MEM (regs[9], 8);
    ADD_STRING ("  A2: ");
    ADD_MEM (regs[10], 8);
    ADD_STRING ("  A3: ");
    ADD_MEM (regs[11], 8);
    ADD_STRING ("\n  A4: ");
    ADD_MEM (regs[12], 8);
    ADD_STRING ("  A5: ");
    ADD_MEM (regs[13], 8);
    ADD_STRING ("  A6: ");
    ADD_MEM (regs[14], 8);
    ADD_STRING ("  A7: ");
    ADD_MEM (regs[15], 8);
    ADD_STRING ("\n  PC: ");
    ADD_MEM (regs[16], 8);
    ADD_STRING ("  SR: ");
    ADD_MEM (regs[17], 4);
  
    ADD_STRING ("\n\n  OldMask: ");
    ADD_MEM (regs[18], 8);
    ADD_STRING ("  Vector: ");
    ADD_MEM (regs[19], 4);
  
    ADD_STRING ("\n\n  FP0: ");
    ADD_MEM (fpregs[0], fpreg_size);
    ADD_STRING ("  FP1: ");
    ADD_MEM (fpregs[1], fpreg_size);
    ADD_STRING ("\n  FP2: ");
    ADD_MEM (fpregs[2], fpreg_size);
    ADD_STRING ("  FP3: ");
    ADD_MEM (fpregs[3], fpreg_size);
    ADD_STRING ("\n  FP4: ");
    ADD_MEM (fpregs[4], fpreg_size);
    ADD_STRING ("  FP5: ");
    ADD_MEM (fpregs[5], fpreg_size);
    ADD_STRING ("\n  FP6: ");
    ADD_MEM (fpregs[6], fpreg_size);
    ADD_STRING ("  FP7: ");
    ADD_MEM (fpregs[7], fpreg_size);
    ADD_STRING ("\n  FPCR: ");
    ADD_MEM (fpregs[8], 8);
    ADD_STRING ("  FPSR: ");
    ADD_MEM (fpregs[9], 8);
    ADD_STRING ("  FPIAR: ");
    ADD_MEM (fpregs[10], 8);
    ADD_STRING ("\n");
  
    /* Write the stuff out.  */
    writev (fd, iov, next_iov - iov);
  }
  
  #define REGISTER_DUMP register_dump (fd, ctx)
  