sigutil_32.c 3.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129
  1. // SPDX-License-Identifier: GPL-2.0
  2. #include <linux/kernel.h>
  3. #include <linux/types.h>
  4. #include <linux/thread_info.h>
  5. #include <linux/uaccess.h>
  6. #include <linux/sched.h>
  7. #include <asm/sigcontext.h>
  8. #include <asm/fpumacro.h>
  9. #include <asm/ptrace.h>
  10. #include <asm/switch_to.h>
  11. #include "sigutil.h"
  12. int save_fpu_state(struct pt_regs *regs, __siginfo_fpu_t __user *fpu)
  13. {
  14. int err = 0;
  15. #ifdef CONFIG_SMP
  16. if (test_tsk_thread_flag(current, TIF_USEDFPU)) {
  17. put_psr(get_psr() | PSR_EF);
  18. fpsave(&current->thread.float_regs[0], &current->thread.fsr,
  19. &current->thread.fpqueue[0], &current->thread.fpqdepth);
  20. regs->psr &= ~(PSR_EF);
  21. clear_tsk_thread_flag(current, TIF_USEDFPU);
  22. }
  23. #else
  24. if (current == last_task_used_math) {
  25. put_psr(get_psr() | PSR_EF);
  26. fpsave(&current->thread.float_regs[0], &current->thread.fsr,
  27. &current->thread.fpqueue[0], &current->thread.fpqdepth);
  28. last_task_used_math = NULL;
  29. regs->psr &= ~(PSR_EF);
  30. }
  31. #endif
  32. err |= __copy_to_user(&fpu->si_float_regs[0],
  33. &current->thread.float_regs[0],
  34. (sizeof(unsigned long) * 32));
  35. err |= __put_user(current->thread.fsr, &fpu->si_fsr);
  36. err |= __put_user(current->thread.fpqdepth, &fpu->si_fpqdepth);
  37. if (current->thread.fpqdepth != 0)
  38. err |= __copy_to_user(&fpu->si_fpqueue[0],
  39. &current->thread.fpqueue[0],
  40. ((sizeof(unsigned long) +
  41. (sizeof(unsigned long *)))*16));
  42. clear_used_math();
  43. return err;
  44. }
  45. int restore_fpu_state(struct pt_regs *regs, __siginfo_fpu_t __user *fpu)
  46. {
  47. int err;
  48. if (((unsigned long) fpu) & 3)
  49. return -EFAULT;
  50. #ifdef CONFIG_SMP
  51. if (test_tsk_thread_flag(current, TIF_USEDFPU))
  52. regs->psr &= ~PSR_EF;
  53. #else
  54. if (current == last_task_used_math) {
  55. last_task_used_math = NULL;
  56. regs->psr &= ~PSR_EF;
  57. }
  58. #endif
  59. set_used_math();
  60. clear_tsk_thread_flag(current, TIF_USEDFPU);
  61. if (!access_ok(fpu, sizeof(*fpu)))
  62. return -EFAULT;
  63. err = __copy_from_user(&current->thread.float_regs[0], &fpu->si_float_regs[0],
  64. (sizeof(unsigned long) * 32));
  65. err |= __get_user(current->thread.fsr, &fpu->si_fsr);
  66. err |= __get_user(current->thread.fpqdepth, &fpu->si_fpqdepth);
  67. if (current->thread.fpqdepth != 0)
  68. err |= __copy_from_user(&current->thread.fpqueue[0],
  69. &fpu->si_fpqueue[0],
  70. ((sizeof(unsigned long) +
  71. (sizeof(unsigned long *)))*16));
  72. return err;
  73. }
  74. int save_rwin_state(int wsaved, __siginfo_rwin_t __user *rwin)
  75. {
  76. int i, err = __put_user(wsaved, &rwin->wsaved);
  77. for (i = 0; i < wsaved; i++) {
  78. struct reg_window32 *rp;
  79. unsigned long fp;
  80. rp = &current_thread_info()->reg_window[i];
  81. fp = current_thread_info()->rwbuf_stkptrs[i];
  82. err |= copy_to_user(&rwin->reg_window[i], rp,
  83. sizeof(struct reg_window32));
  84. err |= __put_user(fp, &rwin->rwbuf_stkptrs[i]);
  85. }
  86. return err;
  87. }
  88. int restore_rwin_state(__siginfo_rwin_t __user *rp)
  89. {
  90. struct thread_info *t = current_thread_info();
  91. int i, wsaved, err;
  92. if (((unsigned long) rp) & 3)
  93. return -EFAULT;
  94. get_user(wsaved, &rp->wsaved);
  95. if (wsaved > NSWINS)
  96. return -EFAULT;
  97. err = 0;
  98. for (i = 0; i < wsaved; i++) {
  99. err |= copy_from_user(&t->reg_window[i],
  100. &rp->reg_window[i],
  101. sizeof(struct reg_window32));
  102. err |= __get_user(t->rwbuf_stkptrs[i],
  103. &rp->rwbuf_stkptrs[i]);
  104. }
  105. if (err)
  106. return err;
  107. t->w_saved = wsaved;
  108. synchronize_user_stack();
  109. if (t->w_saved)
  110. return -EFAULT;
  111. return 0;
  112. }