sysalib.s

Vxworks的bsp软件开发包(基于wrPpmc74xx)

/* sysALib.s - PPMC74xx system-dependent assembly routines */

/* Copyright 1984-2002 Wind River Systems, Inc. */

/*

modification history
--------------------
01g,04apr02,pch  SPR 74348: Machine Check cleanup
01f,04feb02,g_h  Move sysL2crPut() & sysL2crGet() to sysACache.s
01e,07dec01,kab  Fixed decl to keep diab happy
01d,23oct01,g_h  Remove DIAB dependences.
01c,23may01,g_h	 Protected Vision-specific hooks w/ INCLUDE_VWARE_LAUNCH
01b,25aug97,dat  code review comments from thierrym
01a,08jul97,dat  written (from mv2603/sysALib.s,ver 01h)
*/

/*

DESCRIPTION
This module contains the entry code, sysInit(), for VxWorks images that start
running from RAM, such as 'vxWorks'. These images are loaded into memory
by some external program (e.g., a boot ROM) and then started.
The routine sysInit() must come first in the text segment. Its job is to perform
the minimal setup needed to call the generic C
routine usrInit() with parameter BOOT_COLD.

The routine sysInit() typically masks interrupts in the processor, sets the
initial stack pointer (to STACK_ADRS which is defined in configAll.h), 
then jumps to usrInit.
Most other hardware and device initialization is performed later by
sysHwInit().
*/

#define _ASMLANGUAGE 		/* Must be first */

/* includes */
#include "vxWorks.h"
#include "sysLib.h"
#include "config.h"
#include "regs.h"	
#include "asm.h"
#include "wrPpmc74xx.h"

/* defines */

        /* globals */
	FUNC_EXPORT(_sysInit)		/* start of system code */
	FUNC_EXPORT(sysInByte)
	FUNC_EXPORT(sysOutByte)
	FUNC_EXPORT(sysInWord)
	FUNC_EXPORT(sysOutWord)
        FUNC_EXPORT(sysInLong)
        FUNC_EXPORT(sysOutLong)
	FUNC_EXPORT(sysMemProbeSup)
        FUNC_EXPORT(sysProbeExc)
	FUNC_EXPORT(sysClearBATsInvalidateTLBs)
	FUNC_EXPORT(sysInvalidateTLBs)
	FUNC_EXPORT(sysMinimumBATsInit)

/* externals */
	FUNC_IMPORT(usrInit)

	_WRS_TEXT_SEG_START

/***************************************************************************
*
* sysInit - start after boot
*
* This is the system start-up entry point for VxWorks in RAM, the
* first code executed after booting.  It disables interrupts, sets up
* the stack, and jumps to the C routine usrInit() in usrConfig.c.
*
* The initial stack is set to grow down from the address of sysInit().  This
* stack is used only by usrInit() and is never used again.  Memory for the
* stack must be accounted for when determining the system load address.
*
* SYNOPSIS
* \ss
* sysInit
*     (
*     void     /@ THIS IS NOT A CALLABLE ROUTINE @/
*     )
* \se
*
* NOTE: This routine should not be called by the user.
*
* RETURNS: N/A
*/

FUNC_BEGIN(_sysInit)
	/* disable external interrupts (by zeroing out msr) */
	xor	r5,r5,r5
	isync
	mtmsr   r5
	isync  

#ifdef INCLUDE_VWARE_LAUNCH
	lis	r5,HI(sysPrivateVwareParams)
	ori	r5,r5,LO(sysPrivateVwareParams)
        stw     r4,0(r5)
        stw     r3,4(r5)
#endif /* INCLUDE_VWARE_LAUNCH */

	/* Zero-out registers: r0 & SPRGs */
	xor     r0,r0,r0
	isync
	mtspr   SPRG0,r0
	mtspr   SPRG1,r0
	mtspr   SPRG2,r0
	mtspr   SPRG3,r0

	/* Turn on FP (temporarily) */
	xor	r3, r3, r3
	sync
	ori     r3, r3, _PPC_MSR_FP
	sync
	mtmsr   r3
	isync

	/* Init the floating point control/status register */
	mtfsfi  7,0x0
	mtfsfi  6,0x0
	mtfsfi  5,0x0
	mtfsfi  4,0x0
	mtfsfi  3,0x0
	mtfsfi  2,0x0
	mtfsfi  1,0x0
	mtfsfi  0,0x0
	isync
	
	/* Initialize the floating point data registers to a known state */
	mfspr   r3,8
	lfs     f0,0(r3)
	lfs     f1,0(r3)
	lfs     f2,0(r3)
	lfs     f3,0(r3)
	lfs     f4,0(r3)
	lfs     f5,0(r3)
	lfs     f6,0(r3)
	lfs     f7,0(r3)
	lfs     f8,0(r3)
	lfs     f9,0(r3)
	lfs     f10,0(r3)
	lfs     f11,0(r3)
	lfs     f12,0(r3)
	lfs     f13,0(r3)
	lfs     f14,0(r3)
	lfs     f15,0(r3)
	lfs     f16,0(r3)
	lfs     f17,0(r3)
	lfs     f18,0(r3)
	lfs     f19,0(r3)
	lfs     f20,0(r3)
	lfs     f21,0(r3)
	lfs     f22,0(r3)
	lfs     f23,0(r3)
	lfs     f24,0(r3)
	lfs     f25,0(r3)
	lfs     f26,0(r3)
	lfs     f27,0(r3)
	lfs     f28,0(r3)
	lfs     f29,0(r3)
	lfs     f30,0(r3)
	lfs     f31,0(r3)
	sync
	
	/*	Turn off FP (by clearing MSR) */
	xor	r4,r4,r4
	isync  
	mtmsr   r4
	isync  

	/* Init the Segment registers */
	xor	r3, r3, r3
	isync
	mtsr    0,r3
	mtsr    1,r3
	mtsr    2,r3
	mtsr    3,r3
	mtsr    4,r3
	mtsr    5,r3
	mtsr    6,r3
	mtsr    7,r3
	mtsr    8,r3
	mtsr    9,r3
	mtsr    10,r3
	mtsr    11,r3
	mtsr    12,r3
	mtsr    13,r3
	mtsr    14,r3
	mtsr    15,r3
	isync

        /* Turn off data and instruction cache enable bits */
	xor	r4,r4,r4
	ori     r4, r4,(_PPC_HID0_ICE | _PPC_HID0_DCE)
	mfspr   r3, HID0
	andc    r3,r3,r4
	sync
	mtspr   HID0, r3
	isync

	/*
	 * Turn on FP and recoverable interrupt RI.
	 * Do not enable Machine Check until the vectors are set up.
	 */
	xor 	r4,r4,r4
	ori	r4,r4,(_PPC_MSR_FP | _PPC_MSR_RI) 
	sync
	mtmsr   r4
	isync 

	/* fake a Decrementer Exception Handler (i.e. rfi @ 0x900) */
	xor 	r0,r0,r0		/* clear r0 */
	lis 	r3,HI(0x4C000064)
	ori	r3,r3,LO(0x4C000064)	/* load rfi (0x4c000064) to */
	stw 	r3,0x900(r0)		/* store rfi at 0x00000900 */

	bl	sysClearBATs

        /* invalidate the MPU's data/instruction caches */

	mfspr	r4,HID0
	mr	r3,r4
	ori     r3, r3,(_PPC_HID0_ICE | _PPC_HID0_DCE | _PPC_HID0_ICFI | _PPC_HID0_DCFI)
	sync
	mtspr   HID0, r3
	mtspr   HID0, r4
	isync

	bl	sysMinimumBATsInit
	bl	sysInvalidateTLBs

	/* initialize Small Data Area (SDA) start address */
#if	FALSE	  			    /* XXX TPR NO SDA for now */
	lis     r2, HI(_SDA2_BASE_)
	ori 	r2, r2, LO(_SDA2_BASE_)

	lis     r13, HI(_SDA_BASE_)
	ori	r13, r13, LO(_SDA_BASE_)
#endif

	/* initialize the stack pointer */
	lis     sp, HI(RAM_LOW_ADRS)	/* NOTE:  sp = r1 */
	ori     sp, sp, LO(RAM_LOW_ADRS)
	sync
	isync

	addi	sp, sp, -FRAMEBASESZ	/* get frame stack */
	xor	r3,r3,r3
	isync
	li      r3, BOOT_WARM_AUTOBOOT
	isync
	b	usrInit		/* never returns - starts up kernel */
				/* (jumps to usrConfig.c )          */
FUNC_END(_sysInit)

/***************************************************************************
*
* sysClearBATsInvalidateTLBs - clear the BAT's register and invalidate the TLB's
*
* This routine will clear the BAT's register & invalidate the TLB's register. 
*
* SYNOPSIS
* \ss
* void sysClearBATsInvalidateTLBs
*     (
*     void
*     )
* \se
*
* SEE ALSO: sysClearBATs(), sysInvalidateTLBs(), sysMinimumBATsInit()
*
* RETURNS: N/A
*/

FUNC_BEGIN(sysClearBATsInvalidateTLBs)

	mfmsr	r3
	xor	r4,r4,r4
	ori	r4,r4,0x30
	andc    r3,r3,r4
	sync
	mtmsr	r3
	isync
	mflr	r4
	bl	sysClearBATs
	bl	sysInvalidateTLBs
	mtlr	r4
	blr
FUNC_END(sysClearBATsInvalidateTLBs)

/***************************************************************************
*
* sysClearBATs - clear all the BAT's register
*
* This routine will zero the BAT's register.
*
* SYNOPSIS
* \ss
* void sysClearBATs
*     (
*     void
*     )
* \se
*
* SEE ALSO: sysClearBATsInvalidateTLBs(), sysInvalidateTLBs(), sysMinimumBATsInit()
*
* RETURNS: N/A
*/

FUNC_BEGIN(sysClearBATs)

        /* zero out the BAT registers */
	xor	r3,r3,r3
	isync
	mtspr	IBAT0U,r3	/* clear all upper BATS first */
	mtspr	IBAT1U,r3
	mtspr	IBAT2U,r3
	mtspr	IBAT3U,r3
	mtspr	DBAT0U,r3
	mtspr	DBAT1U,r3
	mtspr	DBAT2U,r3
	mtspr	DBAT3U,r3

	mtspr	IBAT0L,r3	/* then clear lower BATS */
	mtspr	IBAT1L,r3
	mtspr	IBAT2L,r3
	mtspr	IBAT3L,r3
	mtspr	DBAT0L,r3
	mtspr	DBAT1L,r3
	mtspr	DBAT2L,r3
	mtspr	DBAT3L,r3
	isync

	mfspr	r3,287		# read PVR
	srwi	r3,r3,12
	andi.	r3,r3,0xff
	cmpwi	r3,0x83
	beq	is7x5
	blr
is7x5:
	xor	r3,r3,r3

	mtspr	IBAT4U,r3
	mtspr	IBAT5U,r3
	mtspr	IBAT6U,r3
	mtspr	IBAT7U,r3               

	mtspr	DBAT4U,r3
	mtspr	DBAT5U,r3
	mtspr	DBAT6U,r3
	mtspr	DBAT7U,r3

	mtspr	IBAT4L,r3
	mtspr	IBAT5L,r3
	mtspr	IBAT6L,r3
	mtspr	IBAT7L,r3

	mtspr	DBAT4L,r3
	mtspr	DBAT5L,r3
	mtspr	DBAT6L,r3
	mtspr	DBAT7L,r3

	isync
	sync
	blr