/* taskArchLib.c - HITACHI SH-specific task management routines */ /* Copyright 1994-2000 Wind River Systems, Inc. */ #include "copyright_wrs.h" /* modification history -------------------- 01n,05apr02,h_k changed taskArgsSet() to store 1st-4th args into stack (SPR #75153). 01m,30aug00,hk change taskRegsInit() to import intUnlockSR (ex-brandNewTaskSR) 01l,21aug00,hk merge SH7729 to SH7700. 01k,14sep98,hk cleaned up taskRegsInit(). 01j,16jul98,st added SH7750 support. 01j,08may98,jmc added support for SH-DSP and SH3-DSP. 01i,14dec96,hk changed magic number 6 in taskArgsGet to MAX_TASK_ARGS-4 (wt). 01h,21sep96,hk moved sr in taskRegName[] next to pr for nicer register dump. 01g,28jul96,hk renamed BrandNewTaskSR to brandNewTaskSR. 01f,13jun96,hk changed taskRegsInit() to refer BrandNewTaskSR. 01e,07jun96,hk added SH7700 support to taskRegsInit(). 01d,02jul95,hk cleaned vbr,gbr,pr,mac[0],mac[1] in taskRegsInit(). 01c,07mar95,hk used MAX_TASK_ARGS for sp in taskArgsSet(). copyright 1995. 01b,07oct94,hk changed to match the new regsSh.h definition. 01a,22jul94,hk derived from 01o of mc68k. */ /* DESCRIPTION This library provides an interface to SH-specific task management routines. SEE ALSO: taskLib */ /* LINTLIBRARY */ #include "vxWorks.h" #include "string.h" #include "taskArchLib.h" #include "regs.h" #include "private/taskLibP.h" #include "private/windLibP.h" /* globals */ REG_INDEX taskRegName[] = { {"r0", REG_SET_R0}, {"r1", REG_SET_R1}, {"r2", REG_SET_R2}, {"r3", REG_SET_R3}, {"r4", REG_SET_R4}, {"r5", REG_SET_R5}, {"r6", REG_SET_R6}, {"r7", REG_SET_R7}, {"r8", REG_SET_R8}, {"r9", REG_SET_R9}, {"r10", REG_SET_R10}, {"r11", REG_SET_R11}, {"r12", REG_SET_R12}, {"r13", REG_SET_R13}, {"r14", REG_SET_R14}, {"r15/sp", REG_SET_R15}, {"gbr", REG_SET_GBR}, {"vbr", REG_SET_VBR}, {"mach",REG_SET_MACH}, {"macl",REG_SET_MACL}, {"pr", REG_SET_PR}, {"sr", REG_SET_SR}, {"pc", REG_SET_PC}, {NULL, 0}, }; /****************************************************************************** * * 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 */ ) { #if (CPU==SH7750 || CPU==SH7700) IMPORT UINT32 intUnlockSR; /* from intArchLib */ #endif bzero ((char *)(&pTcb->regs), sizeof(REG_SET)); /* clear everything */ #if (CPU==SH7750 || CPU==SH7700) pTcb->regs.sr = intUnlockSR; /* set status register */ #endif pTcb->regs.pc = (INSTR *)vxTaskEntry; /* set entry point */ /* initial stack pointer is after MAX_TASK_ARGS task arguments */ pTcb->regs.nvreg[7] = (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 * * INTERNAL * * | | * pArgs [3] --> | | * pArgs [2] --> | | * pArgs [1] --> | | * pArgs [0] --> | | * pArgs [9] --> | | * pArgs [8] --> | | NOTE: MAX_TASK_ARGS is defined * pArgs [7] --> | | as '10' in taskLib.h. * pArgs [6] --> | | / * pArgs [5] --> | | / * pArgs [4] --> | | * 0 | * * pArgs [3] --> voreg [7] --> r7 * pArgs [2] --> voreg [6] --> r6 * pArgs [1] --> voreg [5] --> r5 * pArgs [0] --> voreg [4] --> r4 */ 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 - MAX_TASK_ARGS * (sizeof(int))); for (ix = 4; ix < MAX_TASK_ARGS; ++ix) { *sp++ = pArgs [ix]; /* Args beyond 4th into stack */ } for (ix = 0; ix < 4; ++ix) { pTcb->regs.voreg [ix+4] = pArgs [ix]; /* 1st 4 args into registers */ *sp++ = pArgs [ix]; /* 1st 4 args into stack */ } } /****************************************************************************** * * 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; /* pop args from the stack */ sp = (int *) (pStackBase - MAX_TASK_ARGS * (sizeof(int))); for (ix = 4; ix < MAX_TASK_ARGS; ++ix) { pArgs [ix] = *sp++; /* Args beyond 4th from stack */ } for (ix = 0; ix < 4; ++ix) { pArgs [ix] = *sp++; /* 1st 4 args from stack */ } } /****************************************************************************** * * taskRtnValueSet - set a task's subroutine return value * * This routine sets register r0, 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.voreg [0] = returnValue; }
