sysalib.s

基于如何开发MPC860处理器系统的核心业务模块QMC的开发程序

   .data
	.globl	copyright_wind_river
	.long	copyright_wind_river

#define _ASMLANGUAGE
#include "vxWorks.h"
#include "asm.h"
#include "cacheLib.h"
#include "config.h"
#include "regs.h"	
#include "sysLib.h"

	.globl	_sysInit

	.extern usrInit
	
	.text

_sysInit:

        mfmsr   p0
        INT_MASK(p0, p1)
	rlwinm	p1, p1, 0, _PPC_MSR_BIT_DR + 1, _PPC_MSR_BIT_IR - 1
	rlwinm  p1, p1, 0, _PPC_MSR_BIT_IP + 1, _PPC_MSR_BIT_IP - 1
        mtmsr   p1
	isync

	lis	p1, HIADJ ( CACHE_CMD_DISABLE)
	addi	p1, p1, LO (CACHE_CMD_DISABLE)
	mtspr	IC_CST, p1
	mtspr	DC_CST, p1

	lis     p1, HIADJ ( CACHE_CMD_UNLOCK_ALL)
	addi	p1, p1, LO (CACHE_CMD_UNLOCK_ALL)
        mtspr   IC_CST, p1
        mtspr   DC_CST, p1

        lis     p1, HIADJ ( CACHE_CMD_INVALIDATE)
	addi	p1, p1, LO (CACHE_CMD_INVALIDATE)
        mtspr   IC_CST, p1
        mtspr   DC_CST, p1

	tlbia
	
	lis     sp, HIADJ( RAM_LOW_ADRS)
	addi    sp, sp, LO(RAM_LOW_ADRS)
	
	lis	r3, HIADJ( BOOT_WARM_AUTOBOOT)
	addi	r3, r3, LO(BOOT_WARM_AUTOBOOT)

	addi	sp, sp, -FRAMEBASESZ
	b	usrInit