2 * Copyright (C) 2013 Imagination Technologies
3 * Author: Paul Burton <paul.burton@imgtec.com>
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License as published by the
7 * Free Software Foundation; either version 2 of the License, or (at your
8 * option) any later version.
13 #include <asm/mipsregs.h>
19 extern void _save_msa(struct task_struct *);
20 extern void _restore_msa(struct task_struct *);
21 extern void _init_msa_upper(void);
23 extern void read_msa_wr_b(unsigned idx, union fpureg *to);
24 extern void read_msa_wr_h(unsigned idx, union fpureg *to);
25 extern void read_msa_wr_w(unsigned idx, union fpureg *to);
26 extern void read_msa_wr_d(unsigned idx, union fpureg *to);
29 * read_msa_wr() - Read a single MSA vector register
30 * @idx: The index of the vector register to read
31 * @to: The FPU register union to store the registers value in
32 * @fmt: The format of the data in the vector register
34 * Read the value of MSA vector register idx into the FPU register
35 * union to, using the format fmt.
37 static inline void read_msa_wr(unsigned idx, union fpureg *to,
42 read_msa_wr_b(idx, to);
46 read_msa_wr_h(idx, to);
50 read_msa_wr_w(idx, to);
54 read_msa_wr_d(idx, to);
62 extern void write_msa_wr_b(unsigned idx, union fpureg *from);
63 extern void write_msa_wr_h(unsigned idx, union fpureg *from);
64 extern void write_msa_wr_w(unsigned idx, union fpureg *from);
65 extern void write_msa_wr_d(unsigned idx, union fpureg *from);
68 * write_msa_wr() - Write a single MSA vector register
69 * @idx: The index of the vector register to write
70 * @from: The FPU register union to take the registers value from
71 * @fmt: The format of the data in the vector register
73 * Write the value from the FPU register union from into MSA vector
74 * register idx, using the format fmt.
76 static inline void write_msa_wr(unsigned idx, union fpureg *from,
81 write_msa_wr_b(idx, from);
85 write_msa_wr_h(idx, from);
89 write_msa_wr_w(idx, from);
93 write_msa_wr_d(idx, from);
101 static inline void enable_msa(void)
104 set_c0_config5(MIPS_CONF5_MSAEN);
109 static inline void disable_msa(void)
112 clear_c0_config5(MIPS_CONF5_MSAEN);
113 disable_fpu_hazard();
117 static inline int is_msa_enabled(void)
122 return read_c0_config5() & MIPS_CONF5_MSAEN;
125 static inline int thread_msa_context_live(void)
128 * Check cpu_has_msa only if it's a constant. This will allow the
129 * compiler to optimise out code for CPUs without MSA without adding
130 * an extra redundant check for CPUs with MSA.
132 if (__builtin_constant_p(cpu_has_msa) && !cpu_has_msa)
135 return test_thread_flag(TIF_MSA_CTX_LIVE);
138 static inline void save_msa(struct task_struct *t)
144 static inline void restore_msa(struct task_struct *t)
150 static inline void init_msa_upper(void)
153 * Check cpu_has_msa only if it's a constant. This will allow the
154 * compiler to optimise out code for CPUs without MSA without adding
155 * an extra redundant check for CPUs with MSA.
157 if (__builtin_constant_p(cpu_has_msa) && !cpu_has_msa)
163 #ifdef TOOLCHAIN_SUPPORTS_MSA
165 #define __BUILD_MSA_CTL_REG(name, cs) \
166 static inline unsigned int read_msa_##name(void) \
169 __asm__ __volatile__( \
172 " cfcmsa %0, $" #cs "\n" \
178 static inline void write_msa_##name(unsigned int val) \
180 __asm__ __volatile__( \
183 " ctcmsa $" #cs ", %0\n" \
188 #else /* !TOOLCHAIN_SUPPORTS_MSA */
191 * Define functions using .word for the c[ft]cmsa instructions in order to
192 * allow compilation with toolchains that do not support MSA. Once all
193 * toolchains in use support MSA these can be removed.
196 #define __BUILD_MSA_CTL_REG(name, cs) \
197 static inline unsigned int read_msa_##name(void) \
200 __asm__ __volatile__( \
203 " # cfcmsa $1, $%1\n" \
204 _ASM_INSN_IF_MIPS(0x787e0059 | %1 << 11) \
205 _ASM_INSN32_IF_MM(0x587e0056 | %1 << 11) \
208 : "=r"(reg) : "i"(cs)); \
212 static inline void write_msa_##name(unsigned int val) \
214 __asm__ __volatile__( \
218 " # ctcmsa $%1, $1\n" \
219 _ASM_INSN_IF_MIPS(0x783e0819 | %1 << 6) \
220 _ASM_INSN32_IF_MM(0x583e0816 | %1 << 6) \
222 : : "r"(val), "i"(cs)); \
225 #endif /* !TOOLCHAIN_SUPPORTS_MSA */
227 __BUILD_MSA_CTL_REG(ir, 0)
228 __BUILD_MSA_CTL_REG(csr, 1)
229 __BUILD_MSA_CTL_REG(access, 2)
230 __BUILD_MSA_CTL_REG(save, 3)
231 __BUILD_MSA_CTL_REG(modify, 4)
232 __BUILD_MSA_CTL_REG(request, 5)
233 __BUILD_MSA_CTL_REG(map, 6)
234 __BUILD_MSA_CTL_REG(unmap, 7)
236 #endif /* !__ASSEMBLY__ */
243 #define MSA_REQUEST 5
247 /* MSA Implementation Register (MSAIR) */
248 #define MSA_IR_REVB 0
249 #define MSA_IR_REVF (_ULCAST_(0xff) << MSA_IR_REVB)
250 #define MSA_IR_PROCB 8
251 #define MSA_IR_PROCF (_ULCAST_(0xff) << MSA_IR_PROCB)
252 #define MSA_IR_WRPB 16
253 #define MSA_IR_WRPF (_ULCAST_(0x1) << MSA_IR_WRPB)
255 /* MSA Control & Status Register (MSACSR) */
256 #define MSA_CSR_RMB 0
257 #define MSA_CSR_RMF (_ULCAST_(0x3) << MSA_CSR_RMB)
258 #define MSA_CSR_RM_NEAREST 0
259 #define MSA_CSR_RM_TO_ZERO 1
260 #define MSA_CSR_RM_TO_POS 2
261 #define MSA_CSR_RM_TO_NEG 3
262 #define MSA_CSR_FLAGSB 2
263 #define MSA_CSR_FLAGSF (_ULCAST_(0x1f) << MSA_CSR_FLAGSB)
264 #define MSA_CSR_FLAGS_IB 2
265 #define MSA_CSR_FLAGS_IF (_ULCAST_(0x1) << MSA_CSR_FLAGS_IB)
266 #define MSA_CSR_FLAGS_UB 3
267 #define MSA_CSR_FLAGS_UF (_ULCAST_(0x1) << MSA_CSR_FLAGS_UB)
268 #define MSA_CSR_FLAGS_OB 4
269 #define MSA_CSR_FLAGS_OF (_ULCAST_(0x1) << MSA_CSR_FLAGS_OB)
270 #define MSA_CSR_FLAGS_ZB 5
271 #define MSA_CSR_FLAGS_ZF (_ULCAST_(0x1) << MSA_CSR_FLAGS_ZB)
272 #define MSA_CSR_FLAGS_VB 6
273 #define MSA_CSR_FLAGS_VF (_ULCAST_(0x1) << MSA_CSR_FLAGS_VB)
274 #define MSA_CSR_ENABLESB 7
275 #define MSA_CSR_ENABLESF (_ULCAST_(0x1f) << MSA_CSR_ENABLESB)
276 #define MSA_CSR_ENABLES_IB 7
277 #define MSA_CSR_ENABLES_IF (_ULCAST_(0x1) << MSA_CSR_ENABLES_IB)
278 #define MSA_CSR_ENABLES_UB 8
279 #define MSA_CSR_ENABLES_UF (_ULCAST_(0x1) << MSA_CSR_ENABLES_UB)
280 #define MSA_CSR_ENABLES_OB 9
281 #define MSA_CSR_ENABLES_OF (_ULCAST_(0x1) << MSA_CSR_ENABLES_OB)
282 #define MSA_CSR_ENABLES_ZB 10
283 #define MSA_CSR_ENABLES_ZF (_ULCAST_(0x1) << MSA_CSR_ENABLES_ZB)
284 #define MSA_CSR_ENABLES_VB 11
285 #define MSA_CSR_ENABLES_VF (_ULCAST_(0x1) << MSA_CSR_ENABLES_VB)
286 #define MSA_CSR_CAUSEB 12
287 #define MSA_CSR_CAUSEF (_ULCAST_(0x3f) << MSA_CSR_CAUSEB)
288 #define MSA_CSR_CAUSE_IB 12
289 #define MSA_CSR_CAUSE_IF (_ULCAST_(0x1) << MSA_CSR_CAUSE_IB)
290 #define MSA_CSR_CAUSE_UB 13
291 #define MSA_CSR_CAUSE_UF (_ULCAST_(0x1) << MSA_CSR_CAUSE_UB)
292 #define MSA_CSR_CAUSE_OB 14
293 #define MSA_CSR_CAUSE_OF (_ULCAST_(0x1) << MSA_CSR_CAUSE_OB)
294 #define MSA_CSR_CAUSE_ZB 15
295 #define MSA_CSR_CAUSE_ZF (_ULCAST_(0x1) << MSA_CSR_CAUSE_ZB)
296 #define MSA_CSR_CAUSE_VB 16
297 #define MSA_CSR_CAUSE_VF (_ULCAST_(0x1) << MSA_CSR_CAUSE_VB)
298 #define MSA_CSR_CAUSE_EB 17
299 #define MSA_CSR_CAUSE_EF (_ULCAST_(0x1) << MSA_CSR_CAUSE_EB)
300 #define MSA_CSR_NXB 18
301 #define MSA_CSR_NXF (_ULCAST_(0x1) << MSA_CSR_NXB)
302 #define MSA_CSR_FSB 24
303 #define MSA_CSR_FSF (_ULCAST_(0x1) << MSA_CSR_FSB)
305 #endif /* _ASM_MSA_H */