WebSVN – HelenOS-historic – Diff – /kernel/trunk/arch/ppc32/src/fpu_context.S


#
# Copyright (C) 2006 Martin Decky
# All rights reserved.
#
# Redistribution and use in source and binary forms, with or without
# modification, are permitted provided that the following conditions
# are met:
#
# - Redistributions of source code must retain the above copyright
#   notice, this list of conditions and the following disclaimer.
# - Redistributions in binary form must reproduce the above copyright
#   notice, this list of conditions and the following disclaimer in the
#   documentation and/or other materials provided with the distribution.
# - The name of the author may not be used to endorse or promote products
#   derived from this software without specific prior written permission.
#
# THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
# NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
# DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
# THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
# (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
#
 
#include <arch/asm/regname.h>
#include <arch/context_offset.h>
 
.text   
 
.global fpu_context_save
.global fpu_context_restore
.global fpu_init
.global fpu_enable
.global fpu_disable
 
.macro FPU_CONTEXT_STORE r
	stfd fr14, OFFSET_FR14(\r)
	stfd fr15, OFFSET_FR15(\r)
	stfd fr16, OFFSET_FR16(\r)
	stfd fr17, OFFSET_FR17(\r)
	stfd fr18, OFFSET_FR18(\r)
	stfd fr19, OFFSET_FR19(\r)
	stfd fr20, OFFSET_FR20(\r)
	stfd fr21, OFFSET_FR21(\r)
	stfd fr22, OFFSET_FR22(\r)
	stfd fr23, OFFSET_FR23(\r)
	stfd fr24, OFFSET_FR24(\r)
	stfd fr25, OFFSET_FR25(\r)
	stfd fr26, OFFSET_FR26(\r)
	stfd fr27, OFFSET_FR27(\r)
	stfd fr28, OFFSET_FR28(\r)
	stfd fr29, OFFSET_FR29(\r)
	stfd fr30, OFFSET_FR30(\r)
	stfd fr31, OFFSET_FR31(\r)
.endm
 
.macro FPU_CONTEXT_LOAD r
	lfd fr14, OFFSET_FR14(\r)
	lfd fr15, OFFSET_FR15(\r)
	lfd fr16, OFFSET_FR16(\r)
	lfd fr17, OFFSET_FR17(\r)
	lfd fr18, OFFSET_FR18(\r)
	lfd fr19, OFFSET_FR19(\r)
	lfd fr20, OFFSET_FR20(\r)
	lfd fr21, OFFSET_FR21(\r)
	lfd fr22, OFFSET_FR22(\r)
	lfd fr23, OFFSET_FR23(\r)
	lfd fr24, OFFSET_FR24(\r)
	lfd fr25, OFFSET_FR25(\r)
	lfd fr26, OFFSET_FR26(\r)
	lfd fr27, OFFSET_FR27(\r)
	lfd fr28, OFFSET_FR28(\r)
	lfd fr29, OFFSET_FR29(\r)
	lfd fr30, OFFSET_FR30(\r)
	lfd fr31, OFFSET_FR31(\r)
.endm
 
fpu_context_save:
	FPU_CONTEXT_STORE r3
	
	mffs fr0
	stfd fr0, OFFSET_FPSCR(r3)
	
	blr
	
fpu_context_restore:
	FPU_CONTEXT_LOAD r3
	
	lfd fr0, OFFSET_FPSCR(r3)
	mtfsf 7, fr0
	
	blr
 
fpu_init:
	blr
 
fpu_enable:
	blr
 
fpu_disable:
	blr
 

Rev 860	Rev 982
1	#	1	#
2	# Copyright (C) 2006 Martin Decky	2	# Copyright (C) 2006 Martin Decky
3	# All rights reserved.	3	# All rights reserved.
4	#	4	#
5	# Redistribution and use in source and binary forms, with or without	5	# Redistribution and use in source and binary forms, with or without
6	# modification, are permitted provided that the following conditions	6	# modification, are permitted provided that the following conditions
7	# are met:	7	# are met:
8	#	8	#
9	# - Redistributions of source code must retain the above copyright	9	# - Redistributions of source code must retain the above copyright
10	# notice, this list of conditions and the following disclaimer.	10	# notice, this list of conditions and the following disclaimer.
11	# - Redistributions in binary form must reproduce the above copyright	11	# - Redistributions in binary form must reproduce the above copyright
12	# notice, this list of conditions and the following disclaimer in the	12	# notice, this list of conditions and the following disclaimer in the
13	# documentation and/or other materials provided with the distribution.	13	# documentation and/or other materials provided with the distribution.
14	# - The name of the author may not be used to endorse or promote products	14	# - The name of the author may not be used to endorse or promote products
15	# derived from this software without specific prior written permission.	15	# derived from this software without specific prior written permission.
16	#	16	#
17	# THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	# THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	# NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	# NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	# DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	# DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	# THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	# THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	# (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	# (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	#	27	#
28		28
29	#include <arch/asm/regname.h>	29	#include <arch/asm/regname.h>
30	#include <arch/context_offset.h>	30	#include <arch/context_offset.h>
31		31
32	.text	32	.text
33		33
34	.global fpu_context_save	34	.global fpu_context_save
35	.global fpu_context_restore	35	.global fpu_context_restore
-		36	.global fpu_init
-		37	.global fpu_enable
-		38	.global fpu_disable
36		39
37	.macro FPU_CONTEXT_STORE r	40	.macro FPU_CONTEXT_STORE r
38	stfd fr14, OFFSET_FR14(\r)	41	stfd fr14, OFFSET_FR14(\r)
39	stfd fr15, OFFSET_FR15(\r)	42	stfd fr15, OFFSET_FR15(\r)
40	stfd fr16, OFFSET_FR16(\r)	43	stfd fr16, OFFSET_FR16(\r)
41	stfd fr17, OFFSET_FR17(\r)	44	stfd fr17, OFFSET_FR17(\r)
42	stfd fr18, OFFSET_FR18(\r)	45	stfd fr18, OFFSET_FR18(\r)
43	stfd fr19, OFFSET_FR19(\r)	46	stfd fr19, OFFSET_FR19(\r)
44	stfd fr20, OFFSET_FR20(\r)	47	stfd fr20, OFFSET_FR20(\r)
45	stfd fr21, OFFSET_FR21(\r)	48	stfd fr21, OFFSET_FR21(\r)
46	stfd fr22, OFFSET_FR22(\r)	49	stfd fr22, OFFSET_FR22(\r)
47	stfd fr23, OFFSET_FR23(\r)	50	stfd fr23, OFFSET_FR23(\r)
48	stfd fr24, OFFSET_FR24(\r)	51	stfd fr24, OFFSET_FR24(\r)
49	stfd fr25, OFFSET_FR25(\r)	52	stfd fr25, OFFSET_FR25(\r)
50	stfd fr26, OFFSET_FR26(\r)	53	stfd fr26, OFFSET_FR26(\r)
51	stfd fr27, OFFSET_FR27(\r)	54	stfd fr27, OFFSET_FR27(\r)
52	stfd fr28, OFFSET_FR28(\r)	55	stfd fr28, OFFSET_FR28(\r)
53	stfd fr29, OFFSET_FR29(\r)	56	stfd fr29, OFFSET_FR29(\r)
54	stfd fr30, OFFSET_FR30(\r)	57	stfd fr30, OFFSET_FR30(\r)
55	stfd fr31, OFFSET_FR31(\r)	58	stfd fr31, OFFSET_FR31(\r)
56	.endm	59	.endm
57		60
58	.macro FPU_CONTEXT_LOAD r	61	.macro FPU_CONTEXT_LOAD r
59	lfd fr14, OFFSET_FR14(\r)	62	lfd fr14, OFFSET_FR14(\r)
60	lfd fr15, OFFSET_FR15(\r)	63	lfd fr15, OFFSET_FR15(\r)
61	lfd fr16, OFFSET_FR16(\r)	64	lfd fr16, OFFSET_FR16(\r)
62	lfd fr17, OFFSET_FR17(\r)	65	lfd fr17, OFFSET_FR17(\r)
63	lfd fr18, OFFSET_FR18(\r)	66	lfd fr18, OFFSET_FR18(\r)
64	lfd fr19, OFFSET_FR19(\r)	67	lfd fr19, OFFSET_FR19(\r)
65	lfd fr20, OFFSET_FR20(\r)	68	lfd fr20, OFFSET_FR20(\r)
66	lfd fr21, OFFSET_FR21(\r)	69	lfd fr21, OFFSET_FR21(\r)
67	lfd fr22, OFFSET_FR22(\r)	70	lfd fr22, OFFSET_FR22(\r)
68	lfd fr23, OFFSET_FR23(\r)	71	lfd fr23, OFFSET_FR23(\r)
69	lfd fr24, OFFSET_FR24(\r)	72	lfd fr24, OFFSET_FR24(\r)
70	lfd fr25, OFFSET_FR25(\r)	73	lfd fr25, OFFSET_FR25(\r)
71	lfd fr26, OFFSET_FR26(\r)	74	lfd fr26, OFFSET_FR26(\r)
72	lfd fr27, OFFSET_FR27(\r)	75	lfd fr27, OFFSET_FR27(\r)
73	lfd fr28, OFFSET_FR28(\r)	76	lfd fr28, OFFSET_FR28(\r)
74	lfd fr29, OFFSET_FR29(\r)	77	lfd fr29, OFFSET_FR29(\r)
75	lfd fr30, OFFSET_FR30(\r)	78	lfd fr30, OFFSET_FR30(\r)
76	lfd fr31, OFFSET_FR31(\r)	79	lfd fr31, OFFSET_FR31(\r)
77	.endm	80	.endm
78		81
79	fpu_context_save:	82	fpu_context_save:
80	FPU_CONTEXT_STORE r3	83	FPU_CONTEXT_STORE r3
81		84
82	mffs fr0	85	mffs fr0
83	stfd fr0, OFFSET_FPSCR(r3)	86	stfd fr0, OFFSET_FPSCR(r3)
84		87
85	blr	88	blr
86		89
87	fpu_context_restore:	90	fpu_context_restore:
88	FPU_CONTEXT_LOAD r3	91	FPU_CONTEXT_LOAD r3
89		92
90	lfd fr0, OFFSET_FPSCR(r3)	93	lfd fr0, OFFSET_FPSCR(r3)
91	mtfsf 7, fr0	94	mtfsf 7, fr0
92		95
93	blr	96	blr
-		97
-		98	fpu_init:
-		99	blr
-		100
-		101	fpu_enable:
-		102	blr
-		103
-		104	fpu_disable:
-		105	blr
94		106

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/arch/ppc32/src/fpu_context.S – Rev 860 → 982