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

   1 /*
   2  * Copyright (C) 2004 PathScale, Inc
   3  * Licensed under the GPL
   4  */
   5
   6 #include <errno.h>
   7 #include <string.h>
   8 #include <sys/ptrace.h>
   9 #include "sysdep/ptrace.h"
  10 #include "uml-config.h"
  11 #include "skas_ptregs.h"
  12 #include "registers.h"
  13 #include "user.h"
  14
  15 /* These are set once at boot time and not changed thereafter */
  16
  17 static unsigned long exec_regs[HOST_FRAME_SIZE];
  18 static unsigned long exec_fp_regs[HOST_FP_SIZE];
  19 static unsigned long exec_fpx_regs[HOST_XFP_SIZE];
  20 static int have_fpx_regs = 1;
  21
  22 void init_thread_registers(union uml_pt_regs *to)
  23 {
  24         memcpy(to->skas.regs, exec_regs, sizeof(to->skas.regs));
  25         memcpy(to->skas.fp, exec_fp_regs, sizeof(to->skas.fp));
  26         if(have_fpx_regs)
  27                 memcpy(to->skas.xfp, exec_fpx_regs, sizeof(to->skas.xfp));
  28 }
  29
  30 static int move_registers(int pid, int int_op, union uml_pt_regs *regs,
  31                           int fp_op, unsigned long *fp_regs)
  32 {
  33         if(ptrace(int_op, pid, 0, regs->skas.regs) < 0)
  34                 return(-errno);
  35
  36         if(ptrace(fp_op, pid, 0, fp_regs) < 0)
  37                 return(-errno);
  38
  39         return(0);
  40 }
  41
  42 void save_registers(int pid, union uml_pt_regs *regs)
  43 {
  44         unsigned long *fp_regs;
  45         int err, fp_op;
  46
  47         if(have_fpx_regs){
  48                 fp_op = PTRACE_GETFPXREGS;
  49                 fp_regs = regs->skas.xfp;
  50         }
  51         else {
  52                 fp_op = PTRACE_GETFPREGS;
  53                 fp_regs = regs->skas.fp;
  54         }
  55
  56         err = move_registers(pid, PTRACE_GETREGS, regs, fp_op, fp_regs);
  57         if(err)
  58                 panic("save_registers - saving registers failed, errno = %d\n",
  59                       -err);
  60 }
  61
  62 void restore_registers(int pid, union uml_pt_regs *regs)
  63 {
  64         unsigned long *fp_regs;
  65         int err, fp_op;
  66
  67         if(have_fpx_regs){
  68                 fp_op = PTRACE_SETFPXREGS;
  69                 fp_regs = regs->skas.xfp;
  70         }
  71         else {
  72                 fp_op = PTRACE_SETFPREGS;
  73                 fp_regs = regs->skas.fp;
  74         }
  75
  76         err = move_registers(pid, PTRACE_SETREGS, regs, fp_op, fp_regs);
  77         if(err)
  78                 panic("restore_registers - saving registers failed, "
  79                       "errno = %d\n", -err);
  80 }
  81
  82 void init_registers(int pid)
  83 {
  84         int err;
  85
  86         err = ptrace(PTRACE_GETREGS, pid, 0, exec_regs);
  87         if(err)
  88                 panic("check_ptrace : PTRACE_GETREGS failed, errno = %d",
  89                       err);
  90
  91         err = ptrace(PTRACE_GETFPXREGS, pid, 0, exec_fpx_regs);
  92         if(!err)
  93                 return;
  94
  95         have_fpx_regs = 0;
  96         if(err != EIO)
  97                 panic("check_ptrace : PTRACE_GETFPXREGS failed, errno = %d",
  98                       err);
  99
 100         err = ptrace(PTRACE_GETFPREGS, pid, 0, exec_fp_regs);
 101         if(err)
 102                 panic("check_ptrace : PTRACE_GETFPREGS failed, errno = %d",
 103                       err);
 104 }
 105
 106 /*
 107  * Overrides for Emacs so that we follow Linus's tabbing style.
 108  * Emacs will notice this stuff at the end of the file and automatically
 109  * adjust the settings for this buffer only.  This must remain at the end
 110  * of the file.
 111  * ---------------------------------------------------------------------------
 112  * Local variables:
 113  * c-file-style: "linux"
 114  * End:
 115  */