Subversion Repositories HelenOS

Rev

Rev 3398 | Rev 3549 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1018 decky 1
#
2071 jermar 2
# Copyright (c) 2006 Martin Decky
3
# Copyright (c) 2006 Jakub Jermar 
1018 decky 4
# All rights reserved.
5
#
6
# Redistribution and use in source and binary forms, with or without
7
# modification, are permitted provided that the following conditions
8
# are met:
9
#
10
# - Redistributions of source code must retain the above copyright
11
#   notice, this list of conditions and the following disclaimer.
12
# - Redistributions in binary form must reproduce the above copyright
13
#   notice, this list of conditions and the following disclaimer in the
14
#   documentation and/or other materials provided with the distribution.
15
# - The name of the author may not be used to endorse or promote products
16
#   derived from this software without specific prior written permission.
17
#
18
# THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19
# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20
# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21
# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23
# NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24
# DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25
# THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26
# (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27
# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28
#
29
 
1791 jermar 30
#include <stack.h>
31
#include <register.h>
1783 jermar 32
 
3274 jermar 33
.register       %g2, #scratch
34
.register       %g3, #scratch
35
 
1018 decky 36
.text
37
 
38
.global halt
1685 decky 39
.global memcpy
1018 decky 40
.global jump_to_kernel
41
 
42
halt:
43
	b halt
44
	nop
1685 decky 45
 
46
memcpy:
3274 jermar 47
	mov	%o0, %o3		! save dst
1773 jermar 48
	add	%o1, 7, %g1
49
	and	%g1, -8, %g1
50
	cmp	%o1, %g1
51
	be,pn	%xcc, 3f
52
	add	%o0, 7, %g1
53
	mov	0, %g3
54
0:
55
	brz,pn	%o2, 2f
56
	mov	0, %g2
57
1:
58
	ldub	[%g3 + %o1], %g1
59
	add	%g2, 1, %g2
60
	cmp	%o2, %g2
61
	stb	%g1, [%g3 + %o0]
62
	bne,pt	%xcc, 1b
63
	mov	%g2, %g3
64
2:
65
	jmp	%o7 + 8			! exit point
3274 jermar 66
	mov	%o3, %o0
1773 jermar 67
3:
68
	and	%g1, -8, %g1
69
	cmp	%o0, %g1
70
	bne,pt	%xcc, 0b
71
	mov	0, %g3
72
	srlx	%o2, 3, %g4
73
	brz,pn	%g4, 5f
74
	mov	0, %g5
75
4:
76
	sllx	%g3, 3, %g2
77
	add	%g5, 1, %g3
78
	ldx	[%o1 + %g2], %g1
79
	mov	%g3, %g5
80
	cmp	%g4, %g3
81
	bne,pt	%xcc, 4b
82
	stx	%g1, [%o0 + %g2]
83
5:
84
	and	%o2, 7, %o2
85
	brz,pn	%o2, 2b
86
	sllx	%g4, 3, %g1
87
	mov	0, %g2
88
	add	%g1, %o0, %o0
89
	add	%g1, %o1, %g4
90
	mov	0, %g3
91
6:
92
	ldub	[%g2 + %g4], %g1
93
	stb	%g1, [%g2 + %o0]
94
	add	%g3, 1, %g2
95
	cmp	%o2, %g2
96
	bne,pt	%xcc, 6b
97
	mov	%g2, %g3
1685 decky 98
 
1773 jermar 99
	jmp	%o7 + 8			! exit point
3274 jermar 100
	mov	%o3, %o0
1773 jermar 101
 
1018 decky 102
jump_to_kernel:
3144 jermar 103
	/*
3146 jermar 104
	 * We have copied code and now we need to guarantee cache coherence.
105
	 * 1. Make sure that the code we have moved has drained to main memory.
106
	 * 2. Invalidate I-cache.
107
	 * 3. Flush instruction pipeline.
3365 rimsky 108
	 */
109
 
110
	/*
3479 rimsky 111
	 * US3 processors have a write-invalidate cache, so explicitly
112
	 * invalidating it is not required. Whether to invalidate I-cache
113
	 * or not is decided according to the value of the ver.impl bits
114
	 * in the Version register.
115
	 */
116
	sethi 0x40000, %g0
117
! the lowest/greatest value of ver.impl for US3
118
#define FIRST_US3_CPU 0x14
119
#define LAST_US3_CPU 0x19
120
	rdpr %ver, %g2			! autodetect CPU using the Version register
121
	sllx %g2, 16, %g2		! extract ver.impl bits
122
	srlx %g2, 48, %g2
123
	addcc %g2, -FIRST_US3_CPU, %g0	! flush if ver.impl < FISRT_US3_CPU
124
	bl 0f
125
	nop
126
	addcc %g2, -LAST_US3_CPU, %g0	! flush if ver.impl > LAST_US3_CPU
127
	bg 0f
128
	nop
129
	ba 1f
130
	nop
131
0:
132
	call icache_flush
133
	nop
134
1:
3365 rimsky 135
 
3479 rimsky 136
	membar #StoreStore
137
 
138
	/*
139
	 * Flush the instruction pipeline.
140
	 */
3146 jermar 141
	flush	%i7
3144 jermar 142
 
1790 jermar 143
	mov %o0, %l1
144
	mov %o1, %o0
145
	mov %o2, %o1
1899 jermar 146
	mov %o3, %o2
1790 jermar 147
	jmp %l1				! jump to kernel
148
	nop
1783 jermar 149
 
3146 jermar 150
#define ICACHE_SIZE		8192
151
#define ICACHE_LINE_SIZE	32
152
#define ICACHE_SET_BIT		(1 << 13)
153
#define ASI_ICACHE_TAG		0x67
154
 
155
# Flush I-cache
156
icache_flush:
157
	set	((ICACHE_SIZE - ICACHE_LINE_SIZE) | ICACHE_SET_BIT), %g1
158
	stxa	%g0, [%g1] ASI_ICACHE_TAG
159
0:	membar	#Sync
160
	subcc	%g1, ICACHE_LINE_SIZE, %g1
161
	bnz,pt	%xcc, 0b
162
	stxa	%g0, [%g1] ASI_ICACHE_TAG
163
	membar	#Sync
164
	retl
165
	! SF Erratum #51
166
	nop
1783 jermar 167
.global ofw
168
ofw:
169
	save %sp, -STACK_WINDOW_SAVE_AREA_SIZE, %sp
170
	set ofw_cif, %l0
171
	ldx [%l0], %l0
172
 
173
	rdpr  %pstate, %l1
174
	and  %l1, ~PSTATE_AM_BIT, %l2
175
	wrpr  %l2, 0, %pstate
176
 
177
	jmpl %l0, %o7
178
	mov %i0, %o0
179
 
180
	wrpr %l1, 0, %pstate
181
 
182
	ret
183
	restore %o0, 0, %o0