Thu Sep 19 16:19:01 1996 Martin M. Hunt <hunt@pizza.cygnus.com>
[deliverable/binutils-gdb.git] / gdb / d10v-tdep.c
index 0dc4c4d26856afec75a7c53581efe7a235a19de4..464aec6bd737445138970b843cb6a12b3e8ef9f9 100644 (file)
@@ -22,31 +22,211 @@ Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.  */
 #include "gdbtypes.h"
 #include "gdbcmd.h"
 #include "gdbcore.h"
+#include "gdb_string.h"
 #include "value.h"
 #include "inferior.h"
 #include "dis-asm.h"  
 
+void d10v_frame_find_saved_regs PARAMS ((struct frame_info *fi, struct frame_saved_regs *fsr));
+
+/* Discard from the stack the innermost frame,
+   restoring all saved registers.  */
+
 void
 d10v_pop_frame ()
 {
+  struct frame_info *frame = get_current_frame ();
+  int fp, r13;
+  int regnum;
+  struct frame_saved_regs fsr;
+  char raw_buffer[8];
+
+  fp = (int)FRAME_FP (frame);
+
+  /* fill out fsr with the address of where each */
+  /* register was stored in the frame */
+  get_frame_saved_regs (frame, &fsr);
+  
+  /* r13 contains the old PC.  save it. */
+  r13 = (int)read_register (13);
+
+  /* now update the current registers with the old values */
+  for (regnum = A0_REGNUM; regnum < A0_REGNUM+2 ; regnum++)
+    {
+      if (fsr.regs[regnum])
+       {
+         read_memory (fsr.regs[regnum], raw_buffer, 8);
+         write_register_bytes (REGISTER_BYTE (regnum), raw_buffer, 8);
+       }
+    }
+  for (regnum = 0; regnum < SP_REGNUM; regnum++)
+    {
+      if (fsr.regs[regnum])
+       {
+         write_register (regnum, read_memory_unsigned_integer (fsr.regs[regnum], 2));
+       }
+    }
+  if (fsr.regs[PSW_REGNUM])
+    {
+      write_register (PSW_REGNUM, read_memory_unsigned_integer (fsr.regs[PSW_REGNUM], 2));
+    }
+
+  /* PC is set to r13 */
+  write_register (PC_REGNUM, (LONGEST)r13);
+  write_register (SP_REGNUM, fp - frame->size);
+  flush_cached_frames ();
+}
+
+static int 
+check_prologue (op)
+     unsigned short op;
+{
+  /* st  rn, @-sp */
+  if ((op & 0x7E1F) == 0x6C1F)
+    return 1;
+
+  /* st2w  rn, @-sp */
+  if ((op & 0x7E3F) == 0x6E1F)
+    return 1;
+
+  /* subi  sp, n */
+  if ((op & 0x7FE1) == 0x01E1)
+    return 1;
+
+  /* mv  r11, sp */
+  if (op == 0x417E)
+    return 1;
+
+  /* nop */
+  if (op == 0x5E00)
+    return 1;
+
+  /* st  rn, @sp */
+  if ((op & 0x7E1F) == 0x681E)
+    return 1;
+
+  /* st2w  rn, @sp */
+ if ((op & 0x7E3F) == 0x3A1E)
+   return 1;
+
+  return 0;
 }
 
 CORE_ADDR
-d10v_skip_prologue (start_pc)
-     CORE_ADDR start_pc;
+d10v_skip_prologue (pc)
+     CORE_ADDR pc;
 {
+  unsigned long op;
+  unsigned short op1, op2;
+
+  if (target_read_memory (pc, (char *)&op, 4))
+    return pc;                 /* Can't access it -- assume no prologue. */
+
+  while (1)
+    {
+      op = (unsigned long)read_memory_integer (pc, 4);
+      if ((op & 0xC0000000) == 0xC0000000)
+       {
+         /* long instruction */
+         if ( ((op & 0x3FFF0000) != 0x01FF0000) &&   /* add3 sp,sp,n */
+              ((op & 0x3F0F0000) != 0x340F0000) &&   /* st  rn, @(offset,sp) */
+              ((op & 0x3F1F0000) != 0x350F0000))     /* st2w  rn, @(offset,sp) */
+           break;
+       }
+      else
+       {
+         /* short instructions */
+         op1 = (op & 0x3FFF8000) >> 15;
+         op2 = op & 0x7FFF;
+         if (!check_prologue(op1) || !check_prologue(op2))
+           break;
+       }
+      pc += 4;
+    }
+  return pc;
 }
  
+/* Given a GDB frame, determine the address of the calling function's frame.
+   This will be used to create a new GDB frame struct, and then
+   INIT_EXTRA_FRAME_INFO and INIT_FRAME_PC will be called for the new frame.
+*/
+
 CORE_ADDR
 d10v_frame_chain (frame)
      struct frame_info *frame;
 {
-  if (!inside_entry_file (frame->pc))
-    return read_memory_integer (FRAME_FP (frame) + frame->f_offset, 4);
-  else
-    return 0;
+  struct frame_saved_regs fsr;
+  d10v_frame_find_saved_regs (frame, &fsr);
+  return read_memory_unsigned_integer(fsr.regs[FP_REGNUM],2);
 }  
 
+static int next_addr;
+
+static int 
+prologue_find_regs (op, fsr, addr)
+     unsigned short op;
+     struct frame_saved_regs *fsr;
+     CORE_ADDR addr;
+{
+  int n;
+
+  /* st  rn, @-sp */
+  if ((op & 0x7E1F) == 0x6C1F)
+    {
+      n = (op & 0x1E0) >> 5;
+      next_addr -= 2;
+      fsr->regs[n] = next_addr;
+      return 1;
+    }
+
+  /* st2w  rn, @-sp */
+  else if ((op & 0x7E3F) == 0x6E1F)
+    {
+      n = (op & 0x1E0) >> 5;
+      next_addr -= 4;
+      fsr->regs[n] = next_addr;
+      fsr->regs[n+1] = next_addr+2;
+      return 1;
+    }
+
+  /* subi  sp, n */
+  if ((op & 0x7FE1) == 0x01E1)
+    {
+      n = (op & 0x1E) >> 1;
+      if (n == 0)
+       n = 16;
+      next_addr -= n;
+      return 1;
+    }
+
+  /* mv  r11, sp */
+  if (op == 0x417E)
+    return 1;
+
+  /* nop */
+  if (op == 0x5E00)
+    return 1;
+
+  /* st  rn, @sp */
+  if ((op & 0x7E1F) == 0x681E)
+    {
+      n = (op & 0x1E0) >> 5;
+      fsr->regs[n] = next_addr;
+      return 1;
+    }
+
+  /* st2w  rn, @sp */
+  if ((op & 0x7E3F) == 0x3A1E)
+    {
+      n = (op & 0x1E0) >> 5;
+      fsr->regs[n] = next_addr;
+      fsr->regs[n+1] = next_addr+2;
+      return 1;
+    }
+
+  return 0;
+}
+
 /* Put here the code to store, into a struct frame_saved_regs, the
    addresses of the saved registers of frame described by FRAME_INFO.
    This includes special registers such as pc and fp saved in special
@@ -56,7 +236,71 @@ void
 d10v_frame_find_saved_regs (fi, fsr)
      struct frame_info *fi;
      struct frame_saved_regs *fsr;
-{                             
+{
+  CORE_ADDR fp, pc;
+  unsigned long op;
+  unsigned short op1, op2;
+  int i;
+
+  fp = fi->frame;
+  memset (fsr, 0, sizeof (*fsr));
+  next_addr = 0;
+
+  pc = get_pc_function_start (fi->pc);
+
+  while (1)
+    {
+      op = (unsigned long)read_memory_integer (pc, 4);
+      if ((op & 0xC0000000) == 0xC0000000)
+       {
+         /* long instruction */
+         if ((op & 0x3FFF0000) == 0x01FF0000)
+           {
+             /* add3 sp,sp,n */
+             short n = op & 0xFFFF;
+             next_addr += n;
+           }
+         else if ((op & 0x3F0F0000) == 0x340F0000)
+           {
+             /* st  rn, @(offset,sp) */
+             short offset = op & 0xFFFF;
+             short n = (op >> 20) & 0xF;
+             fsr->regs[n] = next_addr + offset;
+           }
+         else if ((op & 0x3F1F0000) == 0x350F0000)
+           {
+             /* st2w  rn, @(offset,sp) */
+             short offset = op & 0xFFFF;
+             short n = (op >> 20) & 0xF;
+             fsr->regs[n] = next_addr + offset;
+             fsr->regs[n+1] = next_addr + offset + 2;
+           }
+         else
+           break;
+       }
+      else
+       {
+         /* short instructions */
+         op1 = (op & 0x3FFF8000) >> 15;
+         op2 = op & 0x7FFF;
+         if (!prologue_find_regs(op1,fsr,pc) || !prologue_find_regs(op2,fsr,pc))
+           break;
+       }
+      pc += 4;
+    }
+  
+  fi->size = -next_addr;
+
+  for (i=0; i<NUM_REGS; i++)
+    if (fsr->regs[i])
+      {
+       fsr->regs[i] = fp - (next_addr - fsr->regs[i]); 
+      }
+
+  if (fsr->regs[13])
+    fi->return_pc = (read_memory_unsigned_integer(fsr->regs[13],2)-1) << 2;
+  else
+    fi->return_pc = (read_register(13) - 1)  << 2;
 }
 
 void
@@ -65,9 +309,11 @@ d10v_init_extra_frame_info (fromleaf, fi)
      struct frame_info *fi;
 {
   struct frame_saved_regs dummy;
-  if (fi->next)
-    fi->pc = fi->next->return_pc;
-  d10v_frame_find_saved_regs (fi, &dummy);
+
+  if (fi->next && (fi->pc == 0))
+    fi->pc = fi->next->return_pc; 
+
+  d10v_frame_find_saved_regs (fi, &dummy); 
 }
 
 static void
@@ -103,12 +349,11 @@ show_regs (args, from_tty)
   read_register_gen (A0_REGNUM, (char *)&num1);
   read_register_gen (A0_REGNUM+1, (char *)&num2);
   printf_filtered ("A0-A1  %010llx %010llx\n",num1, num2);
-}              
+}
 
 void
 _initialize_d10v_tdep ()
 {
-  struct cmd_list_element *c;
   tm_print_insn = print_insn_d10v;
   add_com ("regs", class_vars, show_regs, "Print all registers");
 } 
This page took 0.026927 seconds and 4 git commands to generate.