wdbdbgalib.s

VxWorks BSP框架源代码包含头文件和驱动

#endif	/* (CPU == PPC604) */

#if	(CPU == PPC403)
/*************************************************************************
*
* wdbDbgDbcrGet - read the value of the DBCR register
*
* RETURNS : the DBCR value
*
* NOMANUAL
*
* UINT wdbDbgDbcrGet (void)
*
*/

FUNC_BEGIN(wdbDbgDbcrGet)
	mfspr	p0, DBCR			/* read the DBCR value */
	blr					/* return to caller */
FUNC_END(wdbDbgDbcrGet)

/*************************************************************************
*
* wdbDbgDbcrSet - set the value of the DBCR register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgDbcrSet
*     (
*     UINT val				/@ DBCR value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgDbcrSet)
	mtspr	DBCR, p0			/* set the DBCR value */
	blr					/* return to caller */
FUNC_END(wdbDbgDbcrSet)

/*************************************************************************
*
* wdbDbgDbsrGet - read the value of the DBSR register
*
* RETURNS : the DBSR value
*
* NOMANUAL
*
* UINT wdbDbgDbsrGet (void)
*
*/

FUNC_BEGIN(wdbDbgDbsrGet)
	mfspr	p0, DBSR			/* read the DBSR value */
	blr					/* return to caller */
FUNC_END(wdbDbgDbsrGet)

/*************************************************************************
*
* wdbDbgDbsrSet - set the value of the DBSR register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgDbsrSet
*     (
*     UINT val				/@ DBSR value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgDbsrSet)
	mtspr	DBSR, p0			/* set the DBSR value */
	blr					/* return to caller */
FUNC_END(wdbDbgDbsrSet)

/*************************************************************************
*
* wdbDbgDac1Get - read the value of the DAC1 register
*
* RETURNS : the DAC1 value
*
* NOMANUAL
*
* UINT wdbDbgDac1Get (void)
*
*/

FUNC_BEGIN(wdbDbgDac1Get)
	mfspr	p0, DAC1			/* read the DAC1 value */
	blr					/* return to caller */
FUNC_END(wdbDbgDac1Get)

/*************************************************************************
*
* wdbDbgDac1Set - set the value of the DAC1 register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgDac1Set
*     (
*     UINT val				/@ DAC1 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgDac1Set)
	mtspr	DAC1, p0			/* set the DAC1 value */
	blr					/* return to caller */
FUNC_END(wdbDbgDac1Set)

/*************************************************************************
*
* wdbDbgDac2Get - read the value of the DAC2 register
*
* RETURNS : the DAC2 value
*
* NOMANUAL
*
* UINT wdbDbgDac2Get (void)
*
*/

FUNC_BEGIN(wdbDbgDac2Get)
	mfspr	p0, DAC2			/* read the DAC2 value */
	blr					/* return to caller */
FUNC_END(wdbDbgDac2Get)

/*************************************************************************
*
* wdbDbgDac2Set - set the value of the DAC2 register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgDac2Set
*     (
*     UINT val				/@ DAC2 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgDac2Set)
	mtspr	DAC2, p0			/* set the DAC2 value */
	blr					/* return to caller */
FUNC_END(wdbDbgDac2Set)

/*************************************************************************
*
* wdbDbgIac1Get - read the value of the IAC1 register
*
* RETURNS : the IAC1 value
*
* NOMANUAL
*
* UINT wdbDbgIac1Get (void)
*
*/

FUNC_BEGIN(wdbDbgIac1Get)
	mfspr	p0, IAC1			/* read the IAC1 value */
	blr					/* return to caller */
FUNC_END(wdbDbgIac1Get)

/*************************************************************************
*
* wdbDbgIac1Set - set the value of the IAC1 register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgIac1Set
*     (
*     UINT val				/@ IAC1 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgIac1Set)
	mtspr	IAC1, p0			/* set the IAC1 value */
	blr					/* return to caller */
FUNC_END(wdbDbgIac1Set)

/*************************************************************************
*
* wdbDbgIac2Get - read the value of the IAC2 register
*
* RETURNS : the IAC2 value
*
* NOMANUAL
*
* UINT wdbDbgIac2Get (void)
*
*/

FUNC_BEGIN(wdbDbgIac2Get)
	mfspr	p0, IAC2			/* read the IAC2 value */
	blr					/* return to caller */
FUNC_END(wdbDbgIac2Get)

/*************************************************************************
*
* wdbDbgIac2Set - set the value of the IAC2 register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgIac2Set
*     (
*     UINT val				/@ IAC2 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgIac2Set)
	mtspr	IAC2, p0			/* set the IAC2 value */
	blr					/* return to caller */
FUNC_END(wdbDbgIac2Set)
#endif	/* (CPU == PPC403) */

#if     ((CPU == PPC405) || (CPU == PPC405F) || (CPU == PPC440) || \
	 (CPU == PPC85XX))
/*************************************************************************
*
* wdbDbgDbcr0Get - read the value of the DBCR register
*
* RETURNS : the DBCR value
*
* NOMANUAL
*
* UINT wdbDbgDbcr0Get (void)
*
*/

FUNC_BEGIN(wdbDbgDbcr0Get)
        mfspr   p0, DBCR0                        /* read the DBCR value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDbcr0Get)

/*************************************************************************
*
* wdbDbgDbcr0Set - set the value of the DBCR register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgDbcr0Set
*     (
*     UINT val                          /@ DBCR value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgDbcr0Set)
        mtspr   DBCR0, p0                        /* set the DBCR value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDbcr0Set)

/*************************************************************************
*
* wdbDbgDbcr1Get - read the value of the DBCR1 register
*
* RETURNS : the DBCR value
*
* NOMANUAL
*
* UINT wdbDbgDbcr1Get (void)
*
*/

FUNC_BEGIN(wdbDbgDbcr1Get)
        mfspr   p0, DBCR1                        /* read the DBCR1 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDbcr1Get)

/*************************************************************************
*
* wdbDbgDbcr1Set - set the value of the DBCR register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgDbcr1Set
*     (
*     UINT val                          /@ DBCR1 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgDbcr1Set)
        mtspr   DBCR1, p0                        /* set the DBCR1 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDbcr1Set)

#  if	((CPU == PPC440) || (CPU == PPC85XX))
/*************************************************************************
*
* wdbDbgDbcr2Get - read the value of the DBCR2 register
*
* RETURNS : the DBCR value
*
* NOMANUAL
*
* UINT wdbDbgDbcr2Get (void)
*
*/

FUNC_BEGIN(wdbDbgDbcr2Get)
        mfspr   p0, DBCR2                        /* read the DBCR2 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDbcr2Get)

/*************************************************************************
*
* wdbDbgDbcr2Set - set the value of the DBCR register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgDbcr2Set
*     (
*     UINT val                          /@ DBCR2 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgDbcr2Set)
        mtspr   DBCR2, p0                        /* set the DBCR2 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDbcr2Set)
#  endif  /* CPU == PPC440, PPC85XX */

/*************************************************************************
*
* wdbDbgDbsrGet - read the value of the DBSR register
*
* RETURNS : the DBSR value
*
* NOMANUAL
*
* UINT wdbDbgDbsrGet (void)
*
*/

FUNC_BEGIN(wdbDbgDbsrGet)
        mfspr   p0, DBSR                        /* read the DBSR value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDbsrGet)

/*************************************************************************
*
* wdbDbgDbsrSet - set the value of the DBSR register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgDbsrSet
*     (
*     UINT val                          /@ DBSR value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgDbsrSet)
        mtspr   DBSR, p0                        /* set the DBSR value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDbsrSet)

/*************************************************************************
*
* wdbDbgDac1Get - read the value of the DAC1 register
*
* RETURNS : the DAC1 value
*
* NOMANUAL
*
* UINT wdbDbgDac1Get (void)
*
*/

FUNC_BEGIN(wdbDbgDac1Get)
        mfspr   p0, DAC1                        /* read the DAC1 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDac1Get)

/*************************************************************************
*
* wdbDbgDac1Set - set the value of the DAC1 register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgDac1Set
*     (
*     UINT val                          /@ DAC1 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgDac1Set)
        mtspr   DAC1, p0                        /* set the DAC1 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDac1Set)

/*************************************************************************
*
* wdbDbgDac2Get - read the value of the DAC2 register
*
* RETURNS : the DAC2 value
*
* NOMANUAL
*
* UINT wdbDbgDac2Get (void)
*
*/

FUNC_BEGIN(wdbDbgDac2Get)
        mfspr   p0, DAC2                        /* read the DAC2 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDac2Get)

/*************************************************************************
*
* wdbDbgDac2Set - set the value of the DAC2 register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgDac2Set
*     (
*     UINT val                          /@ DAC2 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgDac2Set)
        mtspr   DAC2, p0                        /* set the DAC2 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgDac2Set)

/*************************************************************************
*
* wdbDbgIac1Get - read the value of the IAC1 register
*
* RETURNS : the IAC1 value
*
* NOMANUAL
*
* UINT wdbDbgIac1Get (void)
*
*/

FUNC_BEGIN(wdbDbgIac1Get)
        mfspr   p0, IAC1                        /* read the IAC1 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgIac1Get)

/*************************************************************************
*
* wdbDbgIac1Set - set the value of the IAC1 register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgIac1Set
*     (
*     UINT val                          /@ IAC1 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgIac1Set)
        mtspr   IAC1, p0                        /* set the IAC1 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgIac1Set)

/*************************************************************************
*
* wdbDbgIac2Get - read the value of the IAC2 register
*
* RETURNS : the IAC2 value
*
* NOMANUAL
*
* UINT wdbDbgIac2Get (void)
*
*/

FUNC_BEGIN(wdbDbgIac2Get)
        mfspr   p0, IAC2                        /* read the IAC2 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgIac2Get)

/*************************************************************************
*
* wdbDbgIac2Set - set the value of the IAC2 register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgIac2Set
*     (
*     UINT val                          /@ IAC2 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgIac2Set)
        mtspr   IAC2, p0                        /* set the IAC2 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgIac2Set)

#  if	(CPU != PPC85XX)

/*************************************************************************
*
* wdbDbgIac3Get - read the value of the IAC1 register
*
* RETURNS : the IAC1 value
*
* NOMANUAL
*
* UINT wdbDbgIac3Get (void)
*
*/

FUNC_BEGIN(wdbDbgIac3Get)
        mfspr   p0, IAC3                        /* read the IAC3 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgIac3Get)

/*************************************************************************
*
* wdbDbgIac3Set - set the value of the IAC1 register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgIac3Set
*     (
*     UINT val                          /@ IAC3 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgIac3Set)
        mtspr   IAC3, p0                        /* set the IAC3 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgIac3Set)

/*************************************************************************
*
* wdbDbgIac4Get - read the value of the IAC4 register
*
* RETURNS : the IAC4 value
*
* NOMANUAL
*
* UINT wdbDbgIac4Get (void)
*
*/

FUNC_BEGIN(wdbDbgIac4Get)
        mfspr   p0, IAC4                        /* read the IAC4 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgIac4Get)

/*************************************************************************
*
* wdbDbgIac4Set - set the value of the IAC2 register
*
* RETURNS : N/A
*
* NOMANUAL
*
* void wdbDbgIac4Set
*     (
*     UINT val                          /@ IAC4 value @/
*     )
*
*/

FUNC_BEGIN(wdbDbgIac4Set)
        mtspr   IAC4, p0                        /* set the IAC4 value */
        blr                                     /* return to caller */
FUNC_END(wdbDbgIac4Set)

#  endif  /* CPU != PPC85XX */

#endif  /* CPU == PPC405, PPC405F, PPC440, PPC85XX */

/**************************************************************************
*
* wdbDbgHwBpStub - breakpoint handling (low level)
*
* NOMANUAL
*/

FUNC_BEGIN(wdbDbgHwBpStub)
	/* At the entry of this function, the following is done */
	/* mtspr	SPRG3, p0		/@ save P0 to SPRG3 */
	/* mflr		p0			/@ load LR to P0 */
	/* bla		excEnt			/@ call excEnt () */
	/* addi		r3, sp, 0		/@ save ESF pointer to r3 */
	/* addi 	sp, sp, -FRAMEBASESZ	/@ carve frame */
	/* bla 		wdbDbgHwBpStub		/@ branch to this stub */	
	lis	p1,HIADJ(wdbDbgHwBpHandle)
	addi	p1,p1,LO(wdbDbgHwBpHandle)
	mtlr	p1
	addi	p1, p0, _PPC_ESF_REG_BASE	/* pass REG_SET to P1 */
	blrl	/* do exception processing */
FUNC_END(wdbDbgHwBpStub)

#endif	/* DBG_HARDWARE_BP */