registers.c 2.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111
  1. /*
  2. * Copyright (C) 2004 PathScale, Inc
  3. * Copyright (C) 2004 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
  4. * Licensed under the GPL
  5. */
  6. #include <errno.h>
  7. #include <sys/ptrace.h>
  8. #include <sys/user.h>
  9. #include "longjmp.h"
  10. #include "sysdep/ptrace_user.h"
  11. int save_fp_registers(int pid, unsigned long *fp_regs)
  12. {
  13. if (ptrace(PTRACE_GETFPREGS, pid, 0, fp_regs) < 0)
  14. return -errno;
  15. return 0;
  16. }
  17. int restore_fp_registers(int pid, unsigned long *fp_regs)
  18. {
  19. if (ptrace(PTRACE_SETFPREGS, pid, 0, fp_regs) < 0)
  20. return -errno;
  21. return 0;
  22. }
  23. #ifdef __i386__
  24. int have_fpx_regs = 1;
  25. int save_fpx_registers(int pid, unsigned long *fp_regs)
  26. {
  27. if (ptrace(PTRACE_GETFPXREGS, pid, 0, fp_regs) < 0)
  28. return -errno;
  29. return 0;
  30. }
  31. int restore_fpx_registers(int pid, unsigned long *fp_regs)
  32. {
  33. if (ptrace(PTRACE_SETFPXREGS, pid, 0, fp_regs) < 0)
  34. return -errno;
  35. return 0;
  36. }
  37. int get_fp_registers(int pid, unsigned long *regs)
  38. {
  39. if (have_fpx_regs)
  40. return save_fpx_registers(pid, regs);
  41. else
  42. return save_fp_registers(pid, regs);
  43. }
  44. int put_fp_registers(int pid, unsigned long *regs)
  45. {
  46. if (have_fpx_regs)
  47. return restore_fpx_registers(pid, regs);
  48. else
  49. return restore_fp_registers(pid, regs);
  50. }
  51. void arch_init_registers(int pid)
  52. {
  53. struct user_fpxregs_struct fpx_regs;
  54. int err;
  55. err = ptrace(PTRACE_GETFPXREGS, pid, 0, &fpx_regs);
  56. if (!err)
  57. return;
  58. if (errno != EIO)
  59. panic("check_ptrace : PTRACE_GETFPXREGS failed, errno = %d",
  60. errno);
  61. have_fpx_regs = 0;
  62. }
  63. #else
  64. int get_fp_registers(int pid, unsigned long *regs)
  65. {
  66. return save_fp_registers(pid, regs);
  67. }
  68. int put_fp_registers(int pid, unsigned long *regs)
  69. {
  70. return restore_fp_registers(pid, regs);
  71. }
  72. #endif
  73. unsigned long get_thread_reg(int reg, jmp_buf *buf)
  74. {
  75. switch (reg) {
  76. #ifdef __i386__
  77. case EIP:
  78. return buf[0]->__eip;
  79. case UESP:
  80. return buf[0]->__esp;
  81. case EBP:
  82. return buf[0]->__ebp;
  83. #else
  84. case RIP:
  85. return buf[0]->__rip;
  86. case RSP:
  87. return buf[0]->__rsp;
  88. case RBP:
  89. return buf[0]->__rbp;
  90. #endif
  91. default:
  92. printk(UM_KERN_ERR "get_thread_regs - unknown register %d\n",
  93. reg);
  94. return 0;
  95. }
  96. }