/*----------------------------------------------------------------------------
 *      A R T X  -  K e r n e l
 *----------------------------------------------------------------------------
 *      Name:    ARTX_CONFIG.C
 *      Purpose: Configuration of ARTX Kernel for Philips LPC21xx
 *      Rev.:    V2.02 / 6-feb-2006
 *----------------------------------------------------------------------------
 *      This code is part of the ARTX-ARM kernel package of Keil Software.
 *      Copyright (c) 2004-2006 Keil Software. All rights reserved. 
 *---------------------------------------------------------------------------*/

#pragma INTERWORK
#define NOFRAME    __arm __task

#include <LPC21xx.H>                     /* LPC21xx definitions              */
#include <ARTX_Config.h>                 /* ARTX user configuration header   */

/*----------------------------------------------------------------------------
 *      ARTX User configuration part BEGIN
 *---------------------------------------------------------------------------*/

//-------- <<< Use Configuration Wizard in Context Menu >>> -----------------
//
// <h>Task Definitions
// ===================
//
//   <o>Number of concurrent running tasks <0-250>
//   <i> Define max. number of tasks that will run at the same time.
//   <i> Default: 6
#ifndef OS_TASKCNT
 #define OS_TASKCNT     6
#endif

//   <o>Number of tasks with user-provided stack <0-250>
//   <i> Define the number of tasks that will use a bigger stack.
//   <i> The memory space for the stack is provided by the user.
//   <i> Default: 0
#ifndef OS_PRIVCNT
 #define OS_PRIVCNT     0
#endif

//   <o>Task stack size [bytes] <20-4096:4><#/4>
//   <i> Set the stack size for tasks which is assigned by the system.
//   <i> Default: 200
#ifndef OS_STKSIZE
 #define OS_STKSIZE     50
#endif

// <q>Check for the stack overflow
// ===============================
// <i> Include the stack checking code for a stack overflow.
// <i> Note that additional code reduces the Kernel performance.
#ifndef OS_STKCHECK
 #define OS_STKCHECK    1
#endif

//   <o>Number of user timers <0-250>
//   <i> Define max. number of user timers that will run at the same time.
//   <i> Default: 0  (User timers disabled)
#ifndef OS_TIMERCNT
 #define OS_TIMERCNT    0
#endif

// </h>
// <h>System Timer Configuration
// =============================
//   <o>ARTX Kernel timer number <0=> Timer 0 <1=> Timer 1
//   <i> Define the ARM timer used as a system tick timer.
//   <i> Default: Timer 0
#ifndef OS_TIMER
 #define OS_TIMER       1
#endif

//   <o>Timer clock value [Hz] <1-1000000000>
//   <i> Set the timer clock value for selected timer.
//   <i> Default: 15000000  (15MHz at 60MHz CCLK and VPBDIV = 4)
#ifndef OS_CLOCK
 #define OS_CLOCK       15000000
#endif

//   <o>Timer tick value [us] <1-1000000>
//   <i> Set the timer tick value for selected timer.
//   <i> Default: 10000  (10ms)
#ifndef OS_TICK
 #define OS_TICK        10000
#endif

// </h>
// <e>Round-Robin Task switching
// =============================
// <i> Enable Round-Robin Task switching.
#ifndef OS_ROBIN
 #define OS_ROBIN       1
#endif

//   <o>Round-Robin Timeout [ticks] <1-1000>
//   <i> Define how long a task will execute before a task switch.
//   <i> Default: 5
#ifndef OS_ROBINTOUT
 #define OS_ROBINTOUT   5
#endif

// </e>

//------------- <<< end of configuration section >>> -----------------------

/*----------------------------------------------------------------------------
 *      ARTX User configuration part END
 *---------------------------------------------------------------------------*/

#if   (OS_TIMER == 0)                                   /* Timer 0          */
  #define OS_TID_       4                               /*  Timer ID        */
  #define OS_TIM_       (1 << OS_TID_)                  /*  Interrupt Mask  */
  #define OS_TRV        ((U32)(((double)OS_CLOCK*(double)OS_TICK)/1E6)-1)
  #define OS_TVAL       T0TC                            /*  Timer Value     */
  #define OS_TOVF       (T0IR & 1)                      /*  Overflow Flag   */
  #define OS_TREL()     ;                               /*  Timer Reload    */
  #define OS_TFIRQ()    VICSoftInt   |= OS_TIM_;        /*  Force Interrupt */
  #define OS_TIACK()    T0IR = 1;                       /*  Interrupt Ack   */ \
                        VICSoftIntClr = OS_TIM_;                               \
                        VICVectAddr   = 0;
  #define OS_TINIT()    T0MR0 = OS_TRV;                 /*  Initialization  */ \
                        T0MCR = 3;                                             \
                        T0TCR = 1;                                             \
                        VICDefVectAddr = (U32)os_def_interrupt;                \
                        VICVectAddr15  = (U32)os_clock_interrupt;              \
                        VICVectCntl15  = 0x20 | OS_TID_;
#elif (OS_TIMER == 1)                                   /* Timer 1          */
  #define OS_TID_       5                               /*  Timer ID        */
  #define OS_TIM_       (1 << OS_TID_)                  /*  Interrupt Mask  */
  #define OS_TRV        ((U32)(((double)OS_CLOCK*(double)OS_TICK)/1E6)-1)
  #define OS_TVAL       T1TC                            /*  Timer Value     */
  #define OS_TOVF       (T1IR & 1)                      /*  Overflow Flag   */
  #define OS_TREL()     ;                               /*  Timer Reload    */
  #define OS_TFIRQ()    VICSoftInt   |= OS_TIM_;        /*  Force Interrupt */
  #define OS_TIACK()    T1IR = 1;                       /*  Interrupt Ack   */ \
                        VICSoftIntClr = OS_TIM_;                               \
                        VICVectAddr   = 0;
  #define OS_TINIT()    T1MR0 = OS_TRV;                 /*  Initialization  */ \
                        T1MCR = 3;                                             \
                        T1TCR = 1;                                             \
                        VICDefVectAddr = (U32)os_def_interrupt;                \
                        VICVectAddr15  = (U32)os_clock_interrupt;              \
                        VICVectCntl15  = 0x20 | OS_TID_;
#else
  #error OS_TIMER invalid
#endif

#define OS_IACK()       VICVectAddr   = 0;              /* Interrupt Ack    */

#define OS_LOCK()       VICIntEnClr   = OS_TIM_;        /* Task Lock        */
#define OS_UNLOCK()     VICIntEnable |= OS_TIM_;        /* Task Unlock      */

/* WARNING ! Do not use IDLE mode if you are using a JTAG interface  */
/*           for debugging your application.                         */
#define _idle_()        PCON = 1;
#define INITIAL_CPSR    0x40000010
#define MAGIC_WORD      0xE25A2EA5

/*----------------------------------------------------------------------------
 *      Global Variables
 *---------------------------------------------------------------------------*/

extern P_TCB os_runtask;
extern struct OS_XCB os_rdy;
extern struct OS_TCB os_clock_TCB;
extern U16 os_time;
U16 const os_maxtaskrun = OS_TASKCNT;
/* Export following defines to uVision debugger. */
U32 const os_stackinfo = (OS_STKCHECK<<24) | (OS_PRIVCNT<<16) | (OS_STKSIZE*4);
U32 const os_clockrate  = OS_TICK;
U32 const os_timernum   = (OS_TIMER << 16) | OS_TIMERCNT;
U32 const os_rrobin     = (OS_ROBIN << 16) | OS_ROBINTOUT;

/*----------------------------------------------------------------------------
 *      Local Variables
 *---------------------------------------------------------------------------*/
/* Memory pool for TCB allocation    */
static U32 m_tcb[(sizeof(struct OS_TCB) * OS_TASKCNT)/4 + 3];

/* Memory pool for System stack allocation. Need to allocate 2 additional  */
/* entries for 'os_clock_demon()' and 'os_idle_demon()'.                   */
static U32 m_stk[OS_STKSIZE * (OS_TASKCNT-OS_PRIVCNT+2) + 3];

/* An array of Active task pointers.                                       */
P_TCB os_active_TCB[OS_TASKCNT];

#if (OS_ROBIN == 1)
  static U16  os_robin_time;
  static P_TCB os_tsk_robin;
#endif

#if (OS_TIMERCNT != 0)
  /* Memory pool for User Timer allocation                                 */
  static U32 m_tmr[(sizeof(struct OS_TMR) * OS_TIMERCNT)/4 + 3];
#endif

#if (OS_STKCHECK == 1)
  static BIT os_del_flag;
#endif

/*----------------------------------------------------------------------------
 *      Global Functions
 *---------------------------------------------------------------------------*/

/*--------------------------- os_idle_demon ---------------------------------*/

void os_idle_demon (void) __task {
   /* The idle demon is a system task. It is running when no other task is   */
   /* ready to run (idle situation). It must not terminate. Therefore it     */
   /* should contain at least an endless loop.                               */

   for (;;) {
   /* HERE: include here optional user code to be executed when no task runs.*/
   }
} /* end of os_idle_demon */


/*--------------------------- os_tmr_call -----------------------------------*/

void os_tmr_call (U16 info) {
   /* This function is called when the user timer has expired.               */
   /* Parameter "info" is the parameter defined when the timer was created.  */
   /* HERE: include here optional user code to be executed on timeout.       */
   info = info;
} /* end of os_tmr_call */

/*--------------------------- os_stk_overflow -------------------------------*/

#if (OS_STKCHECK == 1)
static void os_stk_overflow (void) {
   /* This function is called when a stack overflow is detected.             */
   /*  'os_runtask' points to a TCB of a task which has a stack overflow     */
   /*  'task_id'    holds a task id for this task                            */
   /* HERE: include here optional code to be executed on stack overflow.     */
   static OS_TID task_id;

   /* Get a task identification for a task with stack problem to 'task_id'.*/
   task_id = os_get_TID (os_runtask);
   /* Use a uVision 'Advanced RTX' debug dialog page 'Active Tasks' to    */
   /* check which task has got a stack overflow and needs a bigger stack. */
   for (;;);
}
#endif

/*--------------------------- os_clock_interrupt ----------------------------*/

void os_clock_interrupt (void) NOFRAME {
   /* Do task switch to clock demon: entered upon a clock interrupt. */
   __asm {
        STMDB   SP!,{R0-R1}                 ; Save Full Context
        STMDB   SP,{SP}^                    ; User SP
        LDMDB   SP,{R0}
        MRS     R1,SPSR                     ; User CPSR
        SUB     LR,LR,#0x4
        STMDB   R0!,{R1,LR}                 ; Push PC, CPSR
        STMDB   R0,{LR}^                    ; Push User LR
        SUB     R0,R0,#0x4                  ; Write back problem !!
        STMDB   R0!,{R2-R12}                ; Push R12-R2
        LDMIA   SP!,{R2-R3}
        STMDB   R0!,{R2-R3}                 ; Push R1-R0

        LDR     R1,=os_runtask              ; os_runtask
        LDR     R1,[R1,#0x0]                ; os_runtask
        STR     R0,[R1,#TCB_TSTACK]         ; os_runtask->tsk_stack
   }
   OS_TIACK();
   tsk_lock ();
   os_runtask->full_ctx = __TRUE;
   os_runtask->state  = READY;
   os_put_rdy_first (os_runtask);