[deliverable/linux.git] / arch / metag / tbx / tbictxfpu.S

/*
 * tbictxfpu.S
 *
 * Copyright (C) 2009, 2012 Imagination Technologies.
 *
 * This program is free software; you can redistribute it and/or modify it under
 * the terms of the GNU General Public License version 2 as published by the
 * Free Software Foundation.
 *
 * Explicit state save and restore routines forming part of the thread binary
 * interface for META processors
 */

	.file	"tbifpuctx.S"

#include <asm/metag_regs.h>
#include <asm/tbx.h>

#ifdef TBI_1_4
/*
 * void *__TBICtxFPUSave( TBIRES State, void *pExt )
 *
 *                 D0Ar2 contains TBICTX_*_BIT values that control what
 *                    extended data is to be saved.
 *                 These bits must be ored into the SaveMask of this structure.
 *
 *                 Virtually all possible scratch registers are used.
 */
	.text
	.balign	4
	.global	___TBICtxFPUSave
	.type	___TBICtxFPUSave,function
___TBICtxFPUSave:

	/* D1Ar1:D0Ar2 - State
	 * D1Ar3       - pExt
	 * D0Ar4       - Value of METAC_CORE_ID
	 * D1Ar5       - Scratch
	 * D0Ar6       - Scratch
	 */
	
	/* If the FPAC bit isnt set then there is nothing to do */
	TSTT	D0Ar2,#TBICTX_FPAC_BIT
	MOVZ	PC, D1RtP

	/* Obtain the Core config */
	MOVT	D0Ar4,        #HI(METAC_CORE_ID)
	ADD	D0Ar4, D0Ar4, #LO(METAC_CORE_ID)
	GETD	D0Ar4, [D0Ar4]

	/* Detect FX.8 - FX.15 and add to core config */
	MOV	D0Ar6, TXENABLE
	AND	D0Ar6, D0Ar6, #(TXENABLE_CLASSALT_FPUR8 << TXENABLE_CLASS_S)
	AND	D0Ar4, D0Ar4, #LO(0x0000FFFF)
	ORT	D0Ar4, D0Ar4, #HI(TBICTX_CFGFPU_FX16_BIT)
	XOR	D0Ar4, D0Ar4, D0Ar6

	/* Save the relevant bits to the buffer */
	SETD	[D1Ar3++], D0Ar4

	/* Save the relevant bits of TXDEFR (Assumes TXDEFR is coherent) ... */
	MOV	D0Ar6, TXDEFR
	LSR	D0Re0, D0Ar6, #8
	AND	D0Re0, D0Re0, #LO(TXDEFR_FPE_FE_BITS>>8)
	AND	D0Ar6, D0Ar6, #LO(TXDEFR_FPE_ICTRL_BITS)
	OR	D0Re0, D0Re0, D0Ar6

	/* ... along with relevant bits of TXMODE to buffer */
	MOV	D0Ar6, TXMODE
	ANDT	D0Ar6, D0Ar6, #HI(TXMODE_FPURMODE_BITS)
	ORT	D0Ar6, D0Ar6, #HI(TXMODE_FPURMODEWRITE_BIT)
	OR	D0Ar6, D0Ar6, D0Re0
	SETD	[D1Ar3++], D0Ar6

	GETD	D0Ar6,[D1Ar1+#TBICTX_SaveMask-2] /* Get the current SaveMask */
	/* D0Ar6       - pCtx->SaveMask */

	TSTT	D0Ar4, #HI(TBICTX_CFGFPU_FX16_BIT) /* Perform test here for extended FPU registers
	    	                                    * to avoid stalls
	    	                                    */
	/* Save the standard FPU registers */
F	MSETL	[D1Ar3++], FX.0, FX.2, FX.4, FX.6

	/* Save the extended FPU registers if they are present */
	BZ	$Lskip_save_fx8_fx16
F	MSETL	[D1Ar3++], FX.8, FX.10, FX.12, FX.14
$Lskip_save_fx8_fx16:

	/* Save the FPU Accumulator if it is present */
	TST	D0Ar4, #METAC_COREID_NOFPACC_BIT
	BNZ	$Lskip_save_fpacc
F	SETL	[D1Ar3++], ACF.0
F	SETL	[D1Ar3++], ACF.1
F	SETL	[D1Ar3++], ACF.2
$Lskip_save_fpacc:

	/* Update pCtx->SaveMask */
	ANDT	D0Ar2, D0Ar2, #TBICTX_FPAC_BIT
	OR	D0Ar6, D0Ar6, D0Ar2
	SETD	[D1Ar1+#TBICTX_SaveMask-2],D0Ar6/* Add in XCBF bit to TBICTX */

	MOV	D0Re0, D1Ar3 /* Return end of save area */
	MOV	PC, D1RtP

	.size	___TBICtxFPUSave,.-___TBICtxFPUSave

/*
 * void *__TBICtxFPURestore( TBIRES State, void *pExt )
 *
 *                 D0Ar2 contains TBICTX_*_BIT values that control what
 *                    extended data is to be recovered from D1Ar3 (pExt).
 *
 *                 Virtually all possible scratch registers are used.
 */
/*
 * If TBICTX_XEXT_BIT is specified in State. Then the saved state of
 *       the orginal A0.2 and A1.2 is restored from pExt and the XEXT
 *       related flags are removed from State.pCtx->SaveMask.
 *
 */
	.balign	4
	.global	___TBICtxFPURestore
	.type	___TBICtxFPURestore,function
___TBICtxFPURestore:

	/* D1Ar1:D0Ar2 - State
	 * D1Ar3       - pExt
	 * D0Ar4       - Value of METAC_CORE_ID
	 * D1Ar5       - Scratch
	 * D0Ar6       - Scratch
	 * D1Re0       - Scratch
	 */

	/* If the FPAC bit isnt set then there is nothing to do */
	TSTT	D0Ar2,#TBICTX_FPAC_BIT
	MOVZ	PC, D1RtP

	/* Obtain the relevant bits of the Core config */
	GETD	D0Ar4, [D1Ar3++]

	/* Restore FPU related parts of TXDEFR. Assumes TXDEFR is coherent */
	GETD	D1Ar5, [D1Ar3++]
	MOV	D0Ar6, D1Ar5
	LSL	D1Re0, D1Ar5, #8
	ANDT	D1Re0, D1Re0, #HI(TXDEFR_FPE_FE_BITS|TXDEFR_FPE_ICTRL_BITS)
	AND	D1Ar5, D1Ar5, #LO(TXDEFR_FPE_FE_BITS|TXDEFR_FPE_ICTRL_BITS)
	OR	D1Re0, D1Re0, D1Ar5

	MOV	D1Ar5, TXDEFR
	ANDMT	D1Ar5, D1Ar5, #HI(~(TXDEFR_FPE_FE_BITS|TXDEFR_FPE_ICTRL_BITS))
	ANDMB	D1Ar5, D1Ar5, #LO(~(TXDEFR_FPE_FE_BITS|TXDEFR_FPE_ICTRL_BITS))
	OR	D1Re0, D1Re0, D1Ar5
	MOV	TXDEFR, D1Re0

	/* Restore relevant bits of TXMODE */
	MOV	D1Ar5, TXMODE
	ANDMT	D1Ar5, D1Ar5, #HI(~TXMODE_FPURMODE_BITS)
	ANDT	D0Ar6, D0Ar6, #HI(TXMODE_FPURMODE_BITS|TXMODE_FPURMODEWRITE_BIT)
	OR	D0Ar6, D0Ar6, D1Ar5
	MOV	TXMODE, D0Ar6

	TSTT	D0Ar4, #HI(TBICTX_CFGFPU_FX16_BIT) /* Perform test here for extended FPU registers
	    	                                    * to avoid stalls
	    	                                    */
	/* Save the standard FPU registers */
F	MGETL	FX.0, FX.2, FX.4, FX.6, [D1Ar3++]

	/* Save the extended FPU registers if they are present */
	BZ	$Lskip_restore_fx8_fx16
F	MGETL	FX.8, FX.10, FX.12, FX.14, [D1Ar3++]
$Lskip_restore_fx8_fx16:

	/* Save the FPU Accumulator if it is present */
	TST	D0Ar4, #METAC_COREID_NOFPACC_BIT
	BNZ	$Lskip_restore_fpacc
F	GETL	ACF.0, [D1Ar3++]
F	GETL	ACF.1, [D1Ar3++]
F	GETL	ACF.2, [D1Ar3++]
$Lskip_restore_fpacc:

	MOV	D0Re0, D1Ar3 /* Return end of save area */
	MOV	PC, D1RtP

	.size	___TBICtxFPURestore,.-___TBICtxFPURestore

#endif /* TBI_1_4 */

/*
 * End of tbictx.S
 */
Commit	Line	Data
027f891f JH	1	/*
	2	* tbictxfpu.S
	3	*
	4	* Copyright (C) 2009, 2012 Imagination Technologies.
	5	*
	6	* This program is free software; you can redistribute it and/or modify it under
	7	* the terms of the GNU General Public License version 2 as published by the
	8	* Free Software Foundation.
	9	*
	10	* Explicit state save and restore routines forming part of the thread binary
	11	* interface for META processors
	12	*/
	13
	14	.file "tbifpuctx.S"
	15
	16	#include <asm/metag_regs.h>
	17	#include <asm/tbx.h>
	18
	19	#ifdef TBI_1_4
	20	/*
	21	* void __TBICtxFPUSave( TBIRES State, void pExt )
	22	*
	23	* D0Ar2 contains TBICTX_*_BIT values that control what
	24	* extended data is to be saved.
	25	* These bits must be ored into the SaveMask of this structure.
	26	*
	27	* Virtually all possible scratch registers are used.
	28	*/
	29	.text
	30	.balign 4
	31	.global ___TBICtxFPUSave
	32	.type ___TBICtxFPUSave,function
	33	___TBICtxFPUSave:
	34
	35	/* D1Ar1:D0Ar2 - State
	36	* D1Ar3 - pExt
	37	* D0Ar4 - Value of METAC_CORE_ID
	38	* D1Ar5 - Scratch
	39	* D0Ar6 - Scratch
	40	*/
	41
	42	/* If the FPAC bit isnt set then there is nothing to do */
	43	TSTT D0Ar2,#TBICTX_FPAC_BIT
	44	MOVZ PC, D1RtP
	45
	46	/* Obtain the Core config */
	47	MOVT D0Ar4, #HI(METAC_CORE_ID)
	48	ADD D0Ar4, D0Ar4, #LO(METAC_CORE_ID)
	49	GETD D0Ar4, [D0Ar4]
	50
	51	/* Detect FX.8 - FX.15 and add to core config */
	52	MOV D0Ar6, TXENABLE
	53	AND D0Ar6, D0Ar6, #(TXENABLE_CLASSALT_FPUR8 << TXENABLE_CLASS_S)
	54	AND D0Ar4, D0Ar4, #LO(0x0000FFFF)
	55	ORT D0Ar4, D0Ar4, #HI(TBICTX_CFGFPU_FX16_BIT)
	56	XOR D0Ar4, D0Ar4, D0Ar6
	57
	58	/* Save the relevant bits to the buffer */
	59	SETD [D1Ar3++], D0Ar4
	60
	61	/* Save the relevant bits of TXDEFR (Assumes TXDEFR is coherent) ... */
	62	MOV D0Ar6, TXDEFR
	63	LSR D0Re0, D0Ar6, #8
	64	AND D0Re0, D0Re0, #LO(TXDEFR_FPE_FE_BITS>>8)
65	AND D0Ar6, D0Ar6, #LO(TXDEFR_FPE_ICTRL_BITS)
66	OR D0Re0, D0Re0, D0Ar6
67
68	/* ... along with relevant bits of TXMODE to buffer */
69	MOV D0Ar6, TXMODE
70	ANDT D0Ar6, D0Ar6, #HI(TXMODE_FPURMODE_BITS)
71	ORT D0Ar6, D0Ar6, #HI(TXMODE_FPURMODEWRITE_BIT)
72	OR D0Ar6, D0Ar6, D0Re0
73	SETD [D1Ar3++], D0Ar6
74
75	GETD D0Ar6,[D1Ar1+#TBICTX_SaveMask-2] /* Get the current SaveMask */
76	/* D0Ar6 - pCtx->SaveMask */
77
78	TSTT D0Ar4, #HI(TBICTX_CFGFPU_FX16_BIT) /* Perform test here for extended FPU registers
79	* to avoid stalls
80	*/
81	/* Save the standard FPU registers */
82	F MSETL [D1Ar3++], FX.0, FX.2, FX.4, FX.6
83
84	/* Save the extended FPU registers if they are present */
85	BZ $Lskip_save_fx8_fx16
86	F MSETL [D1Ar3++], FX.8, FX.10, FX.12, FX.14
87	$Lskip_save_fx8_fx16:
88
89	/* Save the FPU Accumulator if it is present */
90	TST D0Ar4, #METAC_COREID_NOFPACC_BIT
91	BNZ $Lskip_save_fpacc
92	F SETL [D1Ar3++], ACF.0
93	F SETL [D1Ar3++], ACF.1
94	F SETL [D1Ar3++], ACF.2
95	$Lskip_save_fpacc:
96
97	/* Update pCtx->SaveMask */
98	ANDT D0Ar2, D0Ar2, #TBICTX_FPAC_BIT
99	OR D0Ar6, D0Ar6, D0Ar2
100	SETD [D1Ar1+#TBICTX_SaveMask-2],D0Ar6/* Add in XCBF bit to TBICTX */
101
102	MOV D0Re0, D1Ar3 /* Return end of save area */
103	MOV PC, D1RtP
104
105	.size ___TBICtxFPUSave,.-___TBICtxFPUSave
106
107	/*
108	* void __TBICtxFPURestore( TBIRES State, void pExt )
109	*
110	* D0Ar2 contains TBICTX_*_BIT values that control what
111	* extended data is to be recovered from D1Ar3 (pExt).
112	*
113	* Virtually all possible scratch registers are used.
114	*/
115	/*
116	* If TBICTX_XEXT_BIT is specified in State. Then the saved state of
117	* the orginal A0.2 and A1.2 is restored from pExt and the XEXT
118	* related flags are removed from State.pCtx->SaveMask.
119	*
120	*/
121	.balign 4
122	.global ___TBICtxFPURestore
123	.type ___TBICtxFPURestore,function
124	___TBICtxFPURestore:
125
126	/* D1Ar1:D0Ar2 - State
127	* D1Ar3 - pExt
128	* D0Ar4 - Value of METAC_CORE_ID
129	* D1Ar5 - Scratch
130	* D0Ar6 - Scratch
131	* D1Re0 - Scratch
132	*/
133
134	/* If the FPAC bit isnt set then there is nothing to do */
135	TSTT D0Ar2,#TBICTX_FPAC_BIT
136	MOVZ PC, D1RtP
137
138	/* Obtain the relevant bits of the Core config */
139	GETD D0Ar4, [D1Ar3++]
140
141	/* Restore FPU related parts of TXDEFR. Assumes TXDEFR is coherent */
142	GETD D1Ar5, [D1Ar3++]
143	MOV D0Ar6, D1Ar5
144	LSL D1Re0, D1Ar5, #8
145	ANDT D1Re0, D1Re0, #HI(TXDEFR_FPE_FE_BITS\|TXDEFR_FPE_ICTRL_BITS)
146	AND D1Ar5, D1Ar5, #LO(TXDEFR_FPE_FE_BITS\|TXDEFR_FPE_ICTRL_BITS)
147	OR D1Re0, D1Re0, D1Ar5
148
149	MOV D1Ar5, TXDEFR
150	ANDMT D1Ar5, D1Ar5, #HI(~(TXDEFR_FPE_FE_BITS\|TXDEFR_FPE_ICTRL_BITS))
151	ANDMB D1Ar5, D1Ar5, #LO(~(TXDEFR_FPE_FE_BITS\|TXDEFR_FPE_ICTRL_BITS))
152	OR D1Re0, D1Re0, D1Ar5
153	MOV TXDEFR, D1Re0
154
155	/* Restore relevant bits of TXMODE */
156	MOV D1Ar5, TXMODE
157	ANDMT D1Ar5, D1Ar5, #HI(~TXMODE_FPURMODE_BITS)
158	ANDT D0Ar6, D0Ar6, #HI(TXMODE_FPURMODE_BITS\|TXMODE_FPURMODEWRITE_BIT)
159	OR D0Ar6, D0Ar6, D1Ar5
160	MOV TXMODE, D0Ar6
161
162	TSTT D0Ar4, #HI(TBICTX_CFGFPU_FX16_BIT) /* Perform test here for extended FPU registers
163	* to avoid stalls
164	*/
165	/* Save the standard FPU registers */
166	F MGETL FX.0, FX.2, FX.4, FX.6, [D1Ar3++]
167
168	/* Save the extended FPU registers if they are present */
169	BZ $Lskip_restore_fx8_fx16
170	F MGETL FX.8, FX.10, FX.12, FX.14, [D1Ar3++]
171	$Lskip_restore_fx8_fx16:
172
173	/* Save the FPU Accumulator if it is present */
174	TST D0Ar4, #METAC_COREID_NOFPACC_BIT
175	BNZ $Lskip_restore_fpacc
176	F GETL ACF.0, [D1Ar3++]
177	F GETL ACF.1, [D1Ar3++]
178	F GETL ACF.2, [D1Ar3++]
179	$Lskip_restore_fpacc:
180
181	MOV D0Re0, D1Ar3 /* Return end of save area */
182	MOV PC, D1RtP
183
184	.size ___TBICtxFPURestore,.-___TBICtxFPURestore
185
186	#endif /* TBI_1_4 */
187
188	/*
189	* End of tbictx.S
190	*/