initstack.c

zilog的实时操作系统RZK,可以移植到多种处理器上

/*
* File				:	InitStack.c
*
* Description		:	Defines DeleteThread and RZKInitStack routines.
* 
* Copyright 2004 ZiLOG Inc.  ALL RIGHTS RESERVED.
*
* This file contains unpublished confidential and proprietary information
* of ZiLOG, Inc.
* NO PART OF THIS WORK MAY BE DUPLICATED, STORED, PUBLISHED OR DISCLOSED 
* IN ANY FORM WITHOUT THE PRIOR WRITTEN CONSENT OF ZiLOG, INC.
* This is not a license and no use of any kind of this work is authorized
* in the absence of a written license granted by ZiLOG, Inc. in ZiLOG's 
* sole discretion 
*/
#include "ZSysgen.h"
#include "ZTypes.h"
#include "ZThread.h"

/** extern functions */
extern void StartThread(void);
extern RZK_STATUS_t RZKDeleteThread(RZK_THREADHANDLE_t);

/** extern variables */
extern RZK_THREADHANDLE_t hCurrentThread;

static void DeleteThread()
{
	RZKDeleteThread(hCurrentThread);
}


/* Function			:	RZKInitStack
*
* Description		:	Initializes RZK stack
* 
* Inputs			:	sp - pointer to stack area
*						pTCB - pointer to thread control block
*							
* Outputs			:	void.
*							
*
* Dependencies		:	None.
*/
void RZKInitStack(RZK_HANDLE_t *sp, RZK_TCB_t *pTCB, UINT8 nArgs, RZK_HANDLE_t *Args)
{
	pTCB->RZK_CONTEXT.regSPz = ( UINT32 ) sp ;

    *sp++ = (RZK_HANDLE_t) &StartThread;

#ifdef RZK_TOOLSMITH
	sp += 6 ;	// reserve space for all registers AF, BC, DE, HL, IX, IY
#else
	sp += 3 ;
        {	
            if( nArgs > 0 )
            {
                UINT8 nCounter = 0;
                while( nArgs != 0 )
                {
                    nArgs--;
                    *sp++ = *Args++;
                    nCounter++;
                    if(nCounter == 3)
                    break;
                }
                if(nCounter == 1)
                  sp+=2;
                if(nCounter == 2)
                  sp+=1;                  
            }
            else
            {
                  sp+=3;
            }
        }
#endif
    *sp++ = (RZK_HANDLE_t) pTCB->pFuncEntryPoint;
    *sp++ = (RZK_HANDLE_t) &DeleteThread;

    {	
	if(nArgs > 0)
	{
//	    *sp++ = (RZK_HANDLE_t)nArgs;
            while( nArgs-- != 0 )
		*sp++ = *Args++;
	}
    }
}