taskarchlib.c

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

/* taskArchLib.c - ColdFire-specific task management routines */

/* Copyright 1984-2000 Wind River Systems, Inc. */
#include "copyright_wrs.h"

/*
modification history
--------------------
01e,17dec02,dee  fix for SPR 85105
01c,26nov01,dee  remove references to MCF5200
01b,19jun00,ur   Removed all non-Coldfire stuff.
01a,17mar00,dra  Created from T1.0.1 ColdFire and T2 m68k ports.
*/

/*
DESCRIPTION
This library provides an interface to ColdFire-specific task management
routines.

SEE ALSO: taskLib
*/

/* LINTLIBRARY */

#include "vxWorks.h"
#include "taskArchLib.h"
#include "regs.h"
#include "private/taskLibP.h"
#include "private/windLibP.h"


/*******************************************************************************
*
* taskRegsInit - initialize a task's registers
*
* During task initialization this routine is called to initialize the specified
* task's registers to the default values.
*
* NOMANUAL
* ARGSUSED
*/

void taskRegsInit
    (
    WIND_TCB    *pTcb,          /* pointer TCB to initialize */
    char        *pStackBase     /* bottom of task's stack */
    )
    {
    FAST int ix;

    pTcb->regs.sr = 0x3000;			/* set status register */
    pTcb->regs.hasMac = 0x4000;                 /* set default format field */
    pTcb->regs.mac = 0;				/* clear mac */
    pTcb->regs.macsr = 0;			/* clear mac status register */
    pTcb->regs.mask = 0;			/* clear mac mask register */
    pTcb->regs.pc = (INSTR *)vxTaskEntry;	/* set entry point */

    for (ix = 0; ix < 8; ++ix)
	pTcb->regs.dataReg[ix] = 0;		/* initialize d0 - d7 */

    for (ix = 0; ix < 7; ++ix)
	pTcb->regs.addrReg[ix] = 0;		/* initialize a0 - a6 */

    /* initial stack pointer is just after MAX_TASK_ARGS task arguments */

    pTcb->regs.spReg = (int) (pStackBase - (MAX_TASK_ARGS * sizeof (int)));
    }

/*******************************************************************************
*
* taskArgsSet - set a task's arguments
*
* During task initialization this routine is called to push the specified
* arguments onto the task's stack.
*
* NOMANUAL
* ARGSUSED
*/

void taskArgsSet
    (
    WIND_TCB    *pTcb,          /* pointer TCB to initialize */
    char        *pStackBase,    /* bottom of task's stack */
    int         pArgs[]         /* array of startup arguments */
    )
    {
    FAST int ix;
    FAST int *sp;

    /* push args on the stack */

    sp = (int *) pStackBase;			/* start at bottom of stack */

    for (ix = MAX_TASK_ARGS - 1; ix >= 0; --ix)
	*--sp = pArgs[ix];			/* put arguments onto stack */
    }

/*******************************************************************************
*
* taskRtnValueSet - set a task's subroutine return value
*
* This routine sets register d0, the return code, to the specified value.  It
* may only be called for tasks other than the executing task.
*
* NOMANUAL
* ARGSUSED
*/

void taskRtnValueSet
    (
    WIND_TCB    *pTcb,          /* pointer TCB for return value */
    int         returnValue     /* return value to fill into WIND_TCB */
    )
    {
    pTcb->regs.dataReg [0] = returnValue;
    }

/*******************************************************************************
*
* taskArgsGet - get a task's arguments
*
* This routine is utilized during task restart to recover the original task
* arguments.
*
* NOMANUAL
* ARGSUSED
*/

void taskArgsGet
    (
    WIND_TCB *pTcb,             /* pointer TCB to initialize */
    char *pStackBase,           /* bottom of task's stack */
    int  pArgs[]                /* array of arguments to fill */
    )
    {
    FAST int ix;
    FAST int *sp;

    /* push args on the stack */

    sp = (int *) pStackBase;			/* start at bottom of stack */

    for (ix = MAX_TASK_ARGS - 1; ix >= 0; --ix)
	pArgs[ix] = *--sp;			/* fill arguments from stack */
    }
/*******************************************************************************
*
* taskSRSet - set task status register
*
* This routine sets the status register of a specified task that is not
* running (i.e., the TCB must not be that of the calling task).  Debugging
* facilities use this routine to set the trace bit in the status register of
* a task that is being single-stepped.
*
* RETURNS: OK, or ERROR if the task ID is invalid.
*/

STATUS taskSRSet
    (
    int    tid,         /* task ID */
    UINT16 sr           /* new SR */
    )
    {
    FAST WIND_TCB *pTcb = taskTcb (tid);

    if (pTcb == NULL)		/* task non-existent */
	return (ERROR);

    pTcb->regs.sr = sr;

    return (OK);
    }