Subversion Repositories HelenOS

Rev

Rev 2787 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 2787 Rev 4377
Line 26... Line 26...
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 "asm.h"
29
#include "asm.h"
30
#include "regname.h"
30
#include "regname.h"
-
 
31
 
-
 
32
.macro SMC_COHERENCY addr
-
 
33
	dcbst 0, \addr
-
 
34
	sync
-
 
35
	icbi 0, \addr
-
 
36
	sync
-
 
37
	isync
-
 
38
.endm
-
 
39
 
-
 
40
.macro FLUSH_DCACHE addr
-
 
41
	dcbst 0, \addr
-
 
42
	sync
-
 
43
	isync
-
 
44
.endm
-
 
45
 
-
 
46
.macro TLB_FLUSH reg
31
#include "debug.inc"
47
	tlbie \reg
-
 
48
	addi \reg, \reg, 0x1000
-
 
49
.endm
32
 
50
 
33
.text
51
.text
34
 
52
 
35
.global halt
53
.global halt
36
.global memcpy
54
.global memcpy
Line 138... Line 156...
138
.align PAGE_WIDTH
156
.align PAGE_WIDTH
139
.global real_mode
157
.global real_mode
140
 
158
 
141
real_mode:
159
real_mode:
142
	
160
	
143
	DEBUG_INIT
-
 
144
	DEBUG_real_mode
-
 
145
	
-
 
146
	# copy kernel to proper location
161
	# copy kernel to proper location
147
	#
162
	#
148
	# r5 = trans (pa)
163
	# r5 = trans (pa)
149
	# r6 = bytes to copy
164
	# r6 = bytes to copy
150
	# r8 = framebuffer (pa)
165
	# r8 = framebuffer (pa)
Line 161... Line 176...
161
		# copy page
176
		# copy page
162
		
177
		
163
		mtctr r31
178
		mtctr r31
164
		lwz r29, 0(r5)
179
		lwz r29, 0(r5)
165
		
180
		
166
		DEBUG_INIT
-
 
167
		DEBUG_copy_loop
-
 
168
		
-
 
169
		copy_loop:
181
		copy_loop:
170
			
182
			
171
			lwz r28, 0(r29)
183
			lwz r28, 0(r29)
172
			stw r28, 0(r30)
184
			stw r28, 0(r30)
173
			
185
			
-
 
186
			SMC_COHERENCY r30
-
 
187
			
174
			addi r29, r29, 4
188
			addi r29, r29, 4
175
			addi r30, r30, 4
189
			addi r30, r30, 4
176
			subi r6, r6, 4
190
			subi r6, r6, 4
177
			
191
			
178
			cmpwi r6, 0
192
			cmpwi r6, 0
179
			beq copy_end
193
			beq copy_end
180
			
194
			
181
			bdnz copy_loop
195
			bdnz copy_loop
182
			
196
			
183
			DEBUG_end_copy_loop
-
 
184
		
-
 
185
		addi r5, r5, 4
197
		addi r5, r5, 4
186
		b page_copy
198
		b page_copy
187
	
199
	
188
	copy_end:
200
	copy_end:
189
	
201
	
190
	DEBUG_segments
-
 
191
	
-
 
192
	# initially fill segment registers
202
	# initially fill segment registers
193
	
203
	
194
	li r31, 0
204
	li r31, 0
195
	
205
	
196
	li r29, 8
206
	li r29, 8
197
	mtctr r29
207
	mtctr r29
198
	li r30, 0                     # ASID 0 (VSIDs 0 .. 7)
208
	li r30, 0                     # ASID 0 (VSIDs 0 .. 7)
199
 
209
	
200
	seg_fill_uspace:
210
	seg_fill_uspace:
201
	
211
	
202
		mtsrin r30, r31
212
		mtsrin r30, r31
203
		addi r30, r30, 1
213
		addi r30, r30, 1
204
		addis r31, r31, 0x1000    # move to next SR
214
		addis r31, r31, 0x1000    # move to next SR
Line 218... Line 228...
218
		
228
		
219
		bdnz seg_fill_kernel
229
		bdnz seg_fill_kernel
220
	
230
	
221
	# invalidate block address translation registers
231
	# invalidate block address translation registers
222
	
232
	
223
	DEBUG_bat
-
 
224
	
-
 
225
	li r30, 0
233
	li r30, 0
226
	
234
	
227
	mtspr ibat0u, r30
235
	mtspr ibat0u, r30
228
	mtspr ibat0l, r30
236
	mtspr ibat0l, r30
229
	
237
	
Line 249... Line 257...
249
	mtspr dbat3l, r30
257
	mtspr dbat3l, r30
250
	
258
	
251
	# create empty Page Hash Table
259
	# create empty Page Hash Table
252
	# on top of memory, size 64 KB
260
	# on top of memory, size 64 KB
253
	
261
	
254
	DEBUG_pht
-
 
255
	
-
 
256
	lwz r31, 0(r3)                # r31 = memory size
262
	lwz r31, 0(r3)                # r31 = memory size
257
	
263
	
258
	lis r30, 65536@h
264
	lis r30, 65536@h
259
	ori r30, r30, 65536@l         # r30 = 65536
265
	ori r30, r30, 65536@l         # r30 = 65536
260
	
266
	
Line 272... Line 278...
272
	pht_clear:
278
	pht_clear:
273
		
279
		
274
		# write zeroes
280
		# write zeroes
275
		
281
		
276
		stw r29, 0(r31)
282
		stw r29, 0(r31)
-
 
283
		FLUSH_DCACHE r31
277
		
284
		
278
		addi r31, r31, 4
285
		addi r31, r31, 4
279
		subi r30, r30, 4
286
		subi r30, r30, 4
280
		
287
		
281
		cmpwi r30, 0
288
		cmpwi r30, 0
282
		beq clear_end
289
		beq clear_end
283
		
290
		
284
		bdnz pht_clear
291
		bdnz pht_clear
285
 
-
 
286
		DEBUG_end_pht_clear
-
 
287
		
292
		
288
	clear_end:
293
	clear_end:
289
	
294
	
290
#ifdef CONFIG_BAT
295
#ifdef CONFIG_BAT
291
	
296
	
292
	# create BAT identity mapping
297
	# create BAT identity mapping
293
	
298
	
294
	DEBUG_mapping
-
 
295
	
-
 
296
	lwz r31, 0(r3)                # r31 = memory size
299
	lwz r31, 0(r3)                # r31 = memory size
297
	
300
	
298
	lis r29, 0x0002
301
	lis r29, 0x0002
299
	cmpw r31, r29
302
	cmpw r31, r29
300
	blt no_bat                    # less than 128 KB -> no BAT
303
	blt no_bat                    # less than 128 KB -> no BAT
Line 313... Line 316...
313
		srw r30, r31, r29         # r30 = mask >> 1
316
		srw r30, r31, r29         # r30 = mask >> 1
314
		or r31, r31, r30          # mask = mask | r30
317
		or r31, r31, r30          # mask = mask | r30
315
		
318
		
316
		bdnz bat_mask
319
		bdnz bat_mask
317
	
320
	
318
	DEBUG_bat_mask
-
 
319
	
-
 
320
	andi. r31, r31, 0x07ff        # mask = mask & 0x07ff (BAT can map up to 256 MB)
321
	andi. r31, r31, 0x07ff        # mask = mask & 0x07ff (BAT can map up to 256 MB)
321
	
322
	
322
	li r29, 2
323
	li r29, 2
323
	slw r31, r31, r29             # mask = mask << 2
324
	slw r31, r31, r29             # mask = mask << 2
324
	ori r31, r31, 0x0002          # mask = mask | 0x0002 (priviledged access only)
325
	ori r31, r31, 0x0002          # mask = mask | 0x0002 (priviledged access only)
Line 334... Line 335...
334
	
335
	
335
	mtspr dbat0u, r29
336
	mtspr dbat0u, r29
336
	mtspr dbat0l, r30
337
	mtspr dbat0l, r30
337
	
338
	
338
	no_bat:
339
	no_bat:
339
 
340
	
340
#endif
341
#endif
341
	
342
	
342
	DEBUG_tlb
343
	# flush TLB
343
	
344
	
344
	tlbia
345
	li r31, 0
345
	tlbsync
346
	sync
346
	
347
	
-
 
348
	TLB_FLUSH r31
-
 
349
	TLB_FLUSH r31
-
 
350
	TLB_FLUSH r31
-
 
351
	TLB_FLUSH r31
-
 
352
	TLB_FLUSH r31
-
 
353
	TLB_FLUSH r31
-
 
354
	TLB_FLUSH r31
-
 
355
	TLB_FLUSH r31
-
 
356
	
-
 
357
	TLB_FLUSH r31
-
 
358
	TLB_FLUSH r31
-
 
359
	TLB_FLUSH r31
-
 
360
	TLB_FLUSH r31
-
 
361
	TLB_FLUSH r31
-
 
362
	TLB_FLUSH r31
-
 
363
	TLB_FLUSH r31
-
 
364
	TLB_FLUSH r31
-
 
365
	
-
 
366
	TLB_FLUSH r31
-
 
367
	TLB_FLUSH r31
-
 
368
	TLB_FLUSH r31
-
 
369
	TLB_FLUSH r31
-
 
370
	TLB_FLUSH r31
-
 
371
	TLB_FLUSH r31
-
 
372
	TLB_FLUSH r31
-
 
373
	TLB_FLUSH r31
-
 
374
	
-
 
375
	TLB_FLUSH r31
-
 
376
	TLB_FLUSH r31
-
 
377
	TLB_FLUSH r31
-
 
378
	TLB_FLUSH r31
-
 
379
	TLB_FLUSH r31
-
 
380
	TLB_FLUSH r31
-
 
381
	TLB_FLUSH r31
-
 
382
	TLB_FLUSH r31
-
 
383
	
-
 
384
	TLB_FLUSH r31
-
 
385
	TLB_FLUSH r31
-
 
386
	TLB_FLUSH r31
-
 
387
	TLB_FLUSH r31
-
 
388
	TLB_FLUSH r31
-
 
389
	TLB_FLUSH r31
-
 
390
	TLB_FLUSH r31
-
 
391
	TLB_FLUSH r31
-
 
392
	
-
 
393
	TLB_FLUSH r31
-
 
394
	TLB_FLUSH r31
-
 
395
	TLB_FLUSH r31
-
 
396
	TLB_FLUSH r31
-
 
397
	TLB_FLUSH r31
-
 
398
	TLB_FLUSH r31
-
 
399
	TLB_FLUSH r31
-
 
400
	TLB_FLUSH r31
-
 
401
	
-
 
402
	TLB_FLUSH r31
-
 
403
	TLB_FLUSH r31
-
 
404
	TLB_FLUSH r31
-
 
405
	TLB_FLUSH r31
-
 
406
	TLB_FLUSH r31
-
 
407
	TLB_FLUSH r31
-
 
408
	TLB_FLUSH r31
-
 
409
	TLB_FLUSH r31
-
 
410
	
-
 
411
	TLB_FLUSH r31
-
 
412
	TLB_FLUSH r31
-
 
413
	TLB_FLUSH r31
-
 
414
	TLB_FLUSH r31
-
 
415
	TLB_FLUSH r31
-
 
416
	TLB_FLUSH r31
-
 
417
	TLB_FLUSH r31
347
	DEBUG_prepare
418
	TLB_FLUSH r31
-
 
419
	
-
 
420
	eieio
-
 
421
	tlbsync
-
 
422
	sync
348
	
423
	
349
	# start the kernel
424
	# start the kernel
350
	#
425
	#
351
	# pc = KERNEL_START_ADDR
426
	# pc = KERNEL_START_ADDR
352
	# r3 = bootinfo (pa)
427
	# r3 = bootinfo (pa)
Line 371... Line 446...
371
	ori r31, r31, (msr_ir | msr_dr)@l
446
	ori r31, r31, (msr_ir | msr_dr)@l
372
	mtspr srr1, r31
447
	mtspr srr1, r31
373
	
448
	
374
	sync
449
	sync
375
	isync
450
	isync
376
	
-
 
377
	DEBUG_rfi
-
 
378
	rfi
451
	rfi
379
 
452
 
380
.align PAGE_WIDTH
453
.align PAGE_WIDTH
381
.global trans
454
.global trans
382
trans:
455
trans: