1 // SPDX-License-Identifier: GPL-2.0-or-later
2
3 #include <linux/regset.h>
4
5 #include <asm/switch_to.h>
6
7 #include "ptrace-decl.h"
8
9 /*
10 * Regardless of transactions, 'fp_state' holds the current running
11 * value of all FPR registers and 'ckfp_state' holds the last checkpointed
12 * value of all FPR registers for the current transaction.
13 *
14 * Userspace interface buffer layout:
15 *
16 * struct data {
17 * u64 fpr[32];
18 * u64 fpscr;
19 * };
20 */
fpr_get(struct task_struct * target,const struct user_regset * regset,struct membuf to)21 int fpr_get(struct task_struct *target, const struct user_regset *regset,
22 struct membuf to)
23 {
24 u64 buf[33];
25 int i;
26
27 flush_fp_to_thread(target);
28
29 /* copy to local buffer then write that out */
30 for (i = 0; i < 32 ; i++)
31 buf[i] = target->thread.TS_FPR(i);
32 buf[32] = target->thread.fp_state.fpscr;
33 return membuf_write(&to, buf, 33 * sizeof(u64));
34 }
35
36 /*
37 * Regardless of transactions, 'fp_state' holds the current running
38 * value of all FPR registers and 'ckfp_state' holds the last checkpointed
39 * value of all FPR registers for the current transaction.
40 *
41 * Userspace interface buffer layout:
42 *
43 * struct data {
44 * u64 fpr[32];
45 * u64 fpscr;
46 * };
47 *
48 */
fpr_set(struct task_struct * target,const struct user_regset * regset,unsigned int pos,unsigned int count,const void * kbuf,const void __user * ubuf)49 int fpr_set(struct task_struct *target, const struct user_regset *regset,
50 unsigned int pos, unsigned int count,
51 const void *kbuf, const void __user *ubuf)
52 {
53 u64 buf[33];
54 int i;
55
56 flush_fp_to_thread(target);
57
58 for (i = 0; i < 32 ; i++)
59 buf[i] = target->thread.TS_FPR(i);
60 buf[32] = target->thread.fp_state.fpscr;
61
62 /* copy to local buffer then write that out */
63 i = user_regset_copyin(&pos, &count, &kbuf, &ubuf, buf, 0, -1);
64 if (i)
65 return i;
66
67 for (i = 0; i < 32 ; i++)
68 target->thread.TS_FPR(i) = buf[i];
69 target->thread.fp_state.fpscr = buf[32];
70 return 0;
71 }
72
73 /*
74 * Currently to set and get all the vsx state, you need to call
75 * the fp and VMX calls as well. This only get/sets the lower 32
76 * 128bit VSX registers.
77 */
78
vsr_active(struct task_struct * target,const struct user_regset * regset)79 int vsr_active(struct task_struct *target, const struct user_regset *regset)
80 {
81 flush_vsx_to_thread(target);
82 return target->thread.used_vsr ? regset->n : 0;
83 }
84
85 /*
86 * Regardless of transactions, 'fp_state' holds the current running
87 * value of all FPR registers and 'ckfp_state' holds the last
88 * checkpointed value of all FPR registers for the current
89 * transaction.
90 *
91 * Userspace interface buffer layout:
92 *
93 * struct data {
94 * u64 vsx[32];
95 * };
96 */
vsr_get(struct task_struct * target,const struct user_regset * regset,struct membuf to)97 int vsr_get(struct task_struct *target, const struct user_regset *regset,
98 struct membuf to)
99 {
100 u64 buf[32];
101 int i;
102
103 flush_tmregs_to_thread(target);
104 flush_fp_to_thread(target);
105 flush_altivec_to_thread(target);
106 flush_vsx_to_thread(target);
107
108 for (i = 0; i < 32 ; i++)
109 buf[i] = target->thread.fp_state.fpr[i][TS_VSRLOWOFFSET];
110
111 return membuf_write(&to, buf, 32 * sizeof(double));
112 }
113
114 /*
115 * Regardless of transactions, 'fp_state' holds the current running
116 * value of all FPR registers and 'ckfp_state' holds the last
117 * checkpointed value of all FPR registers for the current
118 * transaction.
119 *
120 * Userspace interface buffer layout:
121 *
122 * struct data {
123 * u64 vsx[32];
124 * };
125 */
vsr_set(struct task_struct * target,const struct user_regset * regset,unsigned int pos,unsigned int count,const void * kbuf,const void __user * ubuf)126 int vsr_set(struct task_struct *target, const struct user_regset *regset,
127 unsigned int pos, unsigned int count,
128 const void *kbuf, const void __user *ubuf)
129 {
130 u64 buf[32];
131 int ret, i;
132
133 flush_tmregs_to_thread(target);
134 flush_fp_to_thread(target);
135 flush_altivec_to_thread(target);
136 flush_vsx_to_thread(target);
137
138 for (i = 0; i < 32 ; i++)
139 buf[i] = target->thread.fp_state.fpr[i][TS_VSRLOWOFFSET];
140
141 ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
142 buf, 0, 32 * sizeof(double));
143 if (!ret)
144 for (i = 0; i < 32 ; i++)
145 target->thread.fp_state.fpr[i][TS_VSRLOWOFFSET] = buf[i];
146
147 return ret;
148 }
149