/*
*********************************************************************************************************
*                                                uC/OS
*                                         The Real-Time Kernel
*
*                      (c) Copyright 1992, 1993, Jean J. Labrosse, Plantation, FL
*                                          All Rights Reserved
*
*
*                                       80x86/80x88 Specific code
*                                          SMALL MEMORY MODEL
*
* File : Ix86S_C.C
* By   : Jean J. Labrosse
*********************************************************************************************************
*/

#include "INCLUDES.H"

/*
*********************************************************************************************************
*                                           CREATE A TASK
*********************************************************************************************************
*/
UBYTE OSTaskCreate(void (far *task)(void *pd), void *pdata, void *pstk, UBYTE p)
{
    UWORD *stk;
    UBYTE  err;


    OS_ENTER_CRITICAL();
    if (OSTCBPrioTbl[p] == (OS_TCB *)0) {   /* Make sure task doesn't already exist at this priority   */
        OSTCBPrioTbl[p] = (OS_TCB *)1;      /* Reserve the priority to prevent others from doing ...   */
                                            /* ... the same thing until task is created.               */
        OS_EXIT_CRITICAL();
        stk      = (UWORD *)pstk;           /* Load stack pointer                                      */
        *--stk   = (UWORD)FP_OFF(pdata);    /* Simulate call to function with argument                 */
        *--stk   = (UWORD)FP_SEG(task);
        *--stk   = (UWORD)FP_OFF(task);
        *--stk   = (UWORD)0x0202;           /* PSW = Interrupts enabled                                */
        *--stk   = (UWORD)FP_SEG(task);     /* Put pointer to task   on top of stack                   */
        *--stk   = (UWORD)FP_OFF(task);
        *--stk   = (UWORD)0x0000;           /* AX = 0                                                  */
        *--stk   = (UWORD)0x0000;           /* CX = 0                                                  */
        *--stk   = (UWORD)0x0000;           /* DX = 0                                                  */
        *--stk   = (UWORD)0x0000;           /* BX = 0                                                  */
        *--stk   = (UWORD)0x0000;           /* SP = 0                                                  */
        *--stk   = (UWORD)0x0000;           /* BP = 0                                                  */
        *--stk   = (UWORD)0x0000;           /* SI = 0                                                  */
        *--stk   = (UWORD)0x0000;           /* DI = 0                                                  */
        *--stk   = (UWORD)0x0000;           /* ES = 0                                                  */
        *--stk   = _DS;                     /* DS = Current value of DS                                */
        err      = OSTCBInit(p, (void far *)stk);     /* Get and initialize a TCB                      */
        if (err == OS_NO_ERR) {
            if (OSRunning) {                /* Find highest priority task if multitasking has started  */
                OSSched();
            }
        } else {
            OSTCBPrioTbl[p] = (OS_TCB *)0;  /* Make this priority available to others                  */
        }
        return (err);
    } else {
        OS_EXIT_CRITICAL();
        return (OS_PRIO_EXIST);
    }
}