arch/um/os-Linux/sys-x86_64/registers.c

   1 /*
   2  * Copyright (C) 2004 PathScale, Inc
   3  * Licensed under the GPL
   4  */
   5
   6 #include <errno.h>
   7 #include <sys/ptrace.h>
   8 #include <string.h>
   9 #include "ptrace_user.h"
  10 #include "uml-config.h"
  11 #include "skas_ptregs.h"
  12 #include "registers.h"
  13 #include "longjmp.h"
  14 #include "user.h"
  15
  16 /* These are set once at boot time and not changed thereafter */
  17
  18 static unsigned long exec_regs[MAX_REG_NR];
  19 static unsigned long exec_fp_regs[HOST_FP_SIZE];
  20
  21 int save_fp_registers(int pid, unsigned long *fp_regs)
  22 {
  23         if(ptrace(PTRACE_GETFPREGS, pid, 0, fp_regs) < 0)
  24                 return -errno;
  25         return 0;
  26 }
  27
  28 int restore_fp_registers(int pid, unsigned long *fp_regs)
  29 {
  30         if(ptrace(PTRACE_SETFPREGS, pid, 0, fp_regs) < 0)
  31                 return -errno;
  32         return 0;
  33 }
  34
  35 void init_thread_registers(union uml_pt_regs *to)
  36 {
  37         memcpy(to->skas.regs, exec_regs, sizeof(to->skas.regs));
  38         memcpy(to->skas.fp, exec_fp_regs, sizeof(to->skas.fp));
  39 }
  40
  41 static int move_registers(int pid, int int_op, int fp_op,
  42                           union uml_pt_regs *regs)
  43 {
  44         if(ptrace(int_op, pid, 0, regs->skas.regs) < 0)
  45                 return -errno;
  46
  47         if(ptrace(fp_op, pid, 0, regs->skas.fp) < 0)
  48                 return -errno;
  49
  50         return 0;
  51 }
  52
  53 void save_registers(int pid, union uml_pt_regs *regs)
  54 {
  55         int err;
  56
  57         err = move_registers(pid, PTRACE_GETREGS, PTRACE_GETFPREGS, regs);
  58         if(err)
  59                 panic("save_registers - saving registers failed, errno = %d\n",
  60                       -err);
  61 }
  62
  63 void restore_registers(int pid, union uml_pt_regs *regs)
  64 {
  65         int err;
  66
  67         err = move_registers(pid, PTRACE_SETREGS, PTRACE_SETFPREGS, regs);
  68         if(err)
  69                 panic("restore_registers - saving registers failed, "
  70                       "errno = %d\n", -err);
  71 }
  72
  73 void init_registers(int pid)
  74 {
  75         int err;
  76
  77         err = ptrace(PTRACE_GETREGS, pid, 0, exec_regs);
  78         if(err)
  79                 panic("check_ptrace : PTRACE_GETREGS failed, errno = %d",
  80                       errno);
  81
  82         err = ptrace(PTRACE_GETFPREGS, pid, 0, exec_fp_regs);
  83         if(err)
  84                 panic("check_ptrace : PTRACE_GETFPREGS failed, errno = %d",
  85                       errno);
  86 }
  87
  88 void get_safe_registers(unsigned long *regs, unsigned long *fp_regs)
  89 {
  90         memcpy(regs, exec_regs, sizeof(exec_regs));
  91         if(fp_regs != NULL)
  92                 memcpy(fp_regs, exec_fp_regs,
  93                        HOST_FP_SIZE * sizeof(unsigned long));
  94 }
  95
  96 unsigned long get_thread_reg(int reg, jmp_buf *buf)
  97 {
  98         switch(reg){
  99         case RIP: return buf[0]->__rip;
 100         case RSP: return buf[0]->__rsp;
 101         case RBP: return buf[0]->__rbp;
 102         default:
 103                 printk("get_thread_regs - unknown register %d\n", reg);
 104                 return 0;
 105         }
 106 }