mirror of
https://github.com/FreeRTOS/FreeRTOS-Kernel.git
synced 2025-04-19 21:11:57 -04:00
New 78K0R first pass files added.
This commit is contained in:
parent
d62f5ef24a
commit
7551ede806
253
Source/portable/IAR/78K0R/port.c
Normal file
253
Source/portable/IAR/78K0R/port.c
Normal file
|
@ -0,0 +1,253 @@
|
|||
/*
|
||||
FreeRTOS.org V5.1.1 - Copyright (C) 2003-2009 Richard Barry.
|
||||
|
||||
This file is part of the FreeRTOS.org distribution.
|
||||
|
||||
FreeRTOS.org is free software; you can redistribute it and/or modify
|
||||
it under the terms of the GNU General Public License as published by
|
||||
the Free Software Foundation; either version 2 of the License, or
|
||||
(at your option) any later version.
|
||||
|
||||
FreeRTOS.org is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with FreeRTOS.org; if not, write to the Free Software
|
||||
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
|
||||
A special exception to the GPL can be applied should you wish to distribute
|
||||
a combined work that includes FreeRTOS.org, without being obliged to provide
|
||||
the source code for any proprietary components. See the licensing section
|
||||
of http://www.FreeRTOS.org for full details of how and when the exception
|
||||
can be applied.
|
||||
|
||||
***************************************************************************
|
||||
***************************************************************************
|
||||
* *
|
||||
* SAVE TIME AND MONEY! We can port FreeRTOS.org to your own hardware, *
|
||||
* and even write all or part of your application on your behalf. *
|
||||
* See http://www.OpenRTOS.com for details of the services we provide to *
|
||||
* expedite your project. *
|
||||
* *
|
||||
***************************************************************************
|
||||
***************************************************************************
|
||||
|
||||
Please ensure to read the configuration and relevant port sections of the
|
||||
online documentation.
|
||||
|
||||
http://www.FreeRTOS.org - Documentation, latest information, license and
|
||||
contact details.
|
||||
|
||||
http://www.SafeRTOS.com - A version that is certified for use in safety
|
||||
critical systems.
|
||||
|
||||
http://www.OpenRTOS.com - Commercial support, development, porting,
|
||||
licensing and training services.
|
||||
*/
|
||||
|
||||
/* Standard includes. */
|
||||
#include <stdlib.h>
|
||||
|
||||
/* Scheduler includes. */
|
||||
#include "FreeRTOS.h"
|
||||
#include "task.h"
|
||||
|
||||
#define portINITIAL_CRITICAL_NESTING (( unsigned portSHORT ) 10)
|
||||
|
||||
/* default Initialization of the PSW for the task:
|
||||
* 1100011000000000
|
||||
* ||||||||-------------- Fill byte
|
||||
* |||||||--------------- Cary Flag cleared
|
||||
* |||||----------------- In-service priority Flags set to low level
|
||||
* ||||------------------ Register bank Select 0 Flag cleared
|
||||
* |||------------------- Auxiliary Cary Flag cleared
|
||||
* ||-------------------- Register bank Select 1 Flag cleared
|
||||
* |--------------------- Zero Flag set
|
||||
* ---------------------- Global Interrupt Flag set
|
||||
*/
|
||||
#define portPSW (( portSTACK_TYPE ) 0xC600)
|
||||
|
||||
/* We require the address of the pxCurrentTCB variable, but don't want to know
|
||||
any details of its type. */
|
||||
typedef void tskTCB;
|
||||
extern volatile tskTCB * volatile pxCurrentTCB;
|
||||
|
||||
/* Most ports implement critical sections by placing the interrupt flags on
|
||||
* the stack before disabling interrupts. Exiting the critical section is then
|
||||
* simply a case of popping the flags from the stack. As 78K0 IAR does not use
|
||||
* a frame pointer this cannot be done as modifying the stack will clobber all
|
||||
* the stack variables. Instead each task maintains a count of the critical
|
||||
* section nesting depth. Each time a critical section is entered the count is
|
||||
* incremented. Each time a critical section is left the count is decremented -
|
||||
* with interrupts only being re-enabled if the count is zero.
|
||||
*
|
||||
* usCriticalNesting will get set to zero when the scheduler starts, but must
|
||||
* not be initialised to zero as this will cause problems during the startup
|
||||
* sequence.
|
||||
*/
|
||||
volatile unsigned portSHORT usCriticalNesting = portINITIAL_CRITICAL_NESTING;
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
__interrupt void MD_INTTM05( void );
|
||||
|
||||
/*
|
||||
* Sets up the periodic ISR used for the RTOS tick. This uses timer 0, but
|
||||
* could have alternatively used the watchdog timer or timer 1.
|
||||
*/
|
||||
static void prvSetupTimerInterrupt( void );
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/*
|
||||
* Initialise the stack of a task to look exactly as if a call to
|
||||
* portSAVE_CONTEXT had been called.
|
||||
*
|
||||
* See the header file portable.h.
|
||||
*/
|
||||
portSTACK_TYPE *pxPortInitialiseStack( portSTACK_TYPE *pxTopOfStack, pdTASK_CODE pxCode, void *pvParameters )
|
||||
{
|
||||
unsigned portLONG *pxLocal;
|
||||
|
||||
/*
|
||||
* The 78K0R/Kx3 automatically pushes the PSW then PC onto the stack before
|
||||
* executing an ISR. We want the stack to look just as if this has happened
|
||||
* so place a pointer to the start of the task on the stack first - followed
|
||||
* by the flags we want the task to use when it starts up.
|
||||
*/
|
||||
#if configMEMORY_MODE == 1
|
||||
pxTopOfStack--;
|
||||
pxLocal = (unsigned portLONG*) pxTopOfStack;
|
||||
*pxLocal = (unsigned portLONG) pvParameters;
|
||||
pxTopOfStack--;
|
||||
|
||||
/* dummy are on the stack cause there normaly the return adress of the funtion
|
||||
* is written. Can be a dummy cause the function will never end but only be
|
||||
* yielded an reentered
|
||||
*/
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) 0xcdcd;
|
||||
pxTopOfStack--;
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) 0xcdcd;
|
||||
pxTopOfStack--;
|
||||
pxTopOfStack--;
|
||||
|
||||
/* task function start address */
|
||||
pxLocal = (unsigned portLONG*) pxTopOfStack;
|
||||
*pxLocal = (unsigned portLONG) pxCode;
|
||||
pxTopOfStack--;
|
||||
|
||||
/* write initial value of the PSW */
|
||||
*pxTopOfStack = portPSW;
|
||||
pxTopOfStack--;
|
||||
|
||||
/* Next general purpose register AX */
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) 0x1111;
|
||||
pxTopOfStack--;
|
||||
|
||||
#else
|
||||
|
||||
pxTopOfStack--;
|
||||
|
||||
/* task function start address */
|
||||
pxLocal = (unsigned portLONG*) pxTopOfStack;
|
||||
*pxLocal = (unsigned portLONG) pxCode;
|
||||
pxTopOfStack--;
|
||||
|
||||
/* write initial value of the PSW */
|
||||
*pxTopOfStack = portPSW;
|
||||
pxTopOfStack--;
|
||||
|
||||
/* Next general purpose registers AX with the task function parameter start address */
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) pvParameters;
|
||||
pxTopOfStack--;
|
||||
|
||||
#endif
|
||||
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) 0x2222;
|
||||
pxTopOfStack--;
|
||||
|
||||
/* save the CS and ES register */
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) 0x0F00;
|
||||
pxTopOfStack--;
|
||||
|
||||
/* Next the remaining general purpose registers DE and BC */
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) 0xDEDE;
|
||||
pxTopOfStack--;
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) 0xBCBC;
|
||||
pxTopOfStack--;
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) portNO_CRITICAL_SECTION_NESTING;
|
||||
|
||||
/*
|
||||
* Return a pointer to the top of the stack we have generated so this can
|
||||
* be stored in the task control block for the task.
|
||||
*/
|
||||
return pxTopOfStack;
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
portBASE_TYPE xPortStartScheduler( void )
|
||||
{
|
||||
/* Setup the hardware to generate the tick. Interrupts are disabled when
|
||||
this function is called. */
|
||||
prvSetupTimerInterrupt();
|
||||
|
||||
/* Restore the context of the first task that is going to run. */
|
||||
vPortStart();
|
||||
|
||||
/* Should not get here as the tasks are now running! */
|
||||
return pdTRUE;
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
void vPortEndScheduler( void )
|
||||
{
|
||||
/* It is unlikely that the 78K0R/Kx3 port will get stopped. If required simply
|
||||
disable the tick interrupt here. */
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/*
|
||||
* Hardware initialisation to generate the RTOS tick. This uses Channel 5 of
|
||||
* the Timer Array Unit (TAU). Any other Channel could also be used.
|
||||
*/
|
||||
static void prvSetupTimerInterrupt( void )
|
||||
{
|
||||
/* First the Timer Array Unit has to be enabled */
|
||||
TAU0EN = 1;
|
||||
|
||||
/* To configure the Timer Array Unit all Channels have to been stopped */
|
||||
TT0 = 0xff;
|
||||
|
||||
/* Interrupt of Timer Array Unit Channel 5 disabled to set Interrupt Priority */
|
||||
TMMK05 = 1;
|
||||
|
||||
/* Clear Timer Array Unit Channel 5 Interrupt Flag */
|
||||
TMIF05 = 0;
|
||||
|
||||
/* Set Timer Array Unit Channel 5 Interrupt Priority */
|
||||
TMPR005 = 0;
|
||||
TMPR105 = 0;
|
||||
|
||||
/* Set Timer Array Unit Channel 5 Mode as Interval Timer */
|
||||
TMR05 = 0x0000;
|
||||
|
||||
/* Set the compare match value according to the tick rate we want. */
|
||||
TDR05 = (portTickType) (configCPU_CLOCK_HZ / configTICK_RATE_HZ);
|
||||
|
||||
/* Set Timer Array Unit Channel 5 Output Mode */
|
||||
TOM0 &= ~0x0020;
|
||||
|
||||
/* Set Timer Array Unit Channel 5 Output Level */
|
||||
TOL0 &= ~0x0020;
|
||||
|
||||
/* Set Timer Array Unit Channel 5 Output Enable */
|
||||
TOE0 &= ~0x0020;
|
||||
|
||||
/* Interrupt of Timer Array Unit Channel 5 enabled */
|
||||
TMMK05 = 0;
|
||||
|
||||
/* Set Timer Array Unit Channel 5 Start*/
|
||||
TS0 |= 0x0020;
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
|
165
Source/portable/IAR/78K0R/portmacro.h
Normal file
165
Source/portable/IAR/78K0R/portmacro.h
Normal file
|
@ -0,0 +1,165 @@
|
|||
/*
|
||||
FreeRTOS.org V5.1.1 - Copyright (C) 2003-2009 Richard Barry.
|
||||
|
||||
This file is part of the FreeRTOS.org distribution.
|
||||
|
||||
FreeRTOS.org is free software; you can redistribute it and/or modify
|
||||
it under the terms of the GNU General Public License as published by
|
||||
the Free Software Foundation; either version 2 of the License, or
|
||||
(at your option) any later version.
|
||||
|
||||
FreeRTOS.org is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with FreeRTOS.org; if not, write to the Free Software
|
||||
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
|
||||
A special exception to the GPL can be applied should you wish to distribute
|
||||
a combined work that includes FreeRTOS.org, without being obliged to provide
|
||||
the source code for any proprietary components. See the licensing section
|
||||
of http://www.FreeRTOS.org for full details of how and when the exception
|
||||
can be applied.
|
||||
|
||||
***************************************************************************
|
||||
***************************************************************************
|
||||
* *
|
||||
* SAVE TIME AND MONEY! We can port FreeRTOS.org to your own hardware, *
|
||||
* and even write all or part of your application on your behalf. *
|
||||
* See http://www.OpenRTOS.com for details of the services we provide to *
|
||||
* expedite your project. *
|
||||
* *
|
||||
***************************************************************************
|
||||
***************************************************************************
|
||||
|
||||
Please ensure to read the configuration and relevant port sections of the
|
||||
online documentation.
|
||||
|
||||
http://www.FreeRTOS.org - Documentation, latest information, license and
|
||||
contact details.
|
||||
|
||||
http://www.SafeRTOS.com - A version that is certified for use in safety
|
||||
critical systems.
|
||||
|
||||
http://www.OpenRTOS.com - Commercial support, development, porting,
|
||||
licensing and training services.
|
||||
*/
|
||||
|
||||
#ifndef PORTMACRO_H
|
||||
#define PORTMACRO_H
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/*-----------------------------------------------------------
|
||||
* Port specific definitions.
|
||||
*
|
||||
* The settings in this file configure FreeRTOS correctly for the
|
||||
* given hardware and compiler.
|
||||
*
|
||||
* These settings should not be altered.
|
||||
*-----------------------------------------------------------
|
||||
*/
|
||||
|
||||
/* Type definitions. */
|
||||
|
||||
#define portCHAR char
|
||||
#define portFLOAT float
|
||||
#define portDOUBLE double
|
||||
#define portLONG long
|
||||
#define portSHORT short
|
||||
#define portSTACK_TYPE unsigned int
|
||||
#define portBASE_TYPE int
|
||||
|
||||
#if (configUSE_16_BIT_TICKS==1)
|
||||
typedef unsigned int portTickType;
|
||||
#define portMAX_DELAY ( portTickType ) 0xffff
|
||||
#else
|
||||
typedef unsigned long portTickType;
|
||||
#define portMAX_DELAY ( portTickType ) 0xffffffff
|
||||
#endif
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/* Interrupt control macros. */
|
||||
#define portDISABLE_INTERRUPTS() __asm ( "DI" )
|
||||
#define portENABLE_INTERRUPTS() __asm ( "EI" )
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/* Critical section control macros. */
|
||||
#define portNO_CRITICAL_SECTION_NESTING ( ( unsigned portSHORT ) 0 )
|
||||
|
||||
#define portENTER_CRITICAL() \
|
||||
{ \
|
||||
extern volatile unsigned portSHORT usCriticalNesting; \
|
||||
\
|
||||
portDISABLE_INTERRUPTS(); \
|
||||
\
|
||||
/* Now interrupts are disabled ulCriticalNesting can be accessed */ \
|
||||
/* directly. Increment ulCriticalNesting to keep a count of how many */ \
|
||||
/* times portENTER_CRITICAL() has been called. */ \
|
||||
usCriticalNesting++; \
|
||||
}
|
||||
|
||||
#define portEXIT_CRITICAL() \
|
||||
{ \
|
||||
extern volatile unsigned portSHORT usCriticalNesting; \
|
||||
\
|
||||
if( usCriticalNesting > portNO_CRITICAL_SECTION_NESTING ) \
|
||||
{ \
|
||||
/* Decrement the nesting count as we are leaving a critical section. */ \
|
||||
usCriticalNesting--; \
|
||||
\
|
||||
/* If the nesting level has reached zero then interrupts should be */ \
|
||||
/* re-enabled. */ \
|
||||
if( usCriticalNesting == portNO_CRITICAL_SECTION_NESTING ) \
|
||||
{ \
|
||||
portENABLE_INTERRUPTS(); \
|
||||
} \
|
||||
} \
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/* Task utilities. */
|
||||
extern void vPortYield( void );
|
||||
extern void vPortStart( void );
|
||||
extern void portSAVE_CONTEXT( void );
|
||||
extern void portRESTORE_CONTEXT( void );
|
||||
#define portYIELD() vPortYield()
|
||||
#define portNOP() __asm ( "NOP" )
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/* Hardwware specifics. */
|
||||
#define portBYTE_ALIGNMENT 2
|
||||
#define portSTACK_GROWTH ( -1 )
|
||||
#define portTICK_RATE_MS ( ( portTickType ) 1000 / configTICK_RATE_HZ )
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/* Task function macros as described on the FreeRTOS.org WEB site. */
|
||||
#define portTASK_FUNCTION_PROTO( vFunction, pvParameters ) void vFunction( void *pvParameters )
|
||||
#define portTASK_FUNCTION( vFunction, pvParameters ) void vFunction( void *pvParameters )
|
||||
|
||||
|
||||
static __interrupt void P0_isr (void);
|
||||
|
||||
/* --------------------------------------------------------------------------*/
|
||||
/* Option-bytes and security ID */
|
||||
/* --------------------------------------------------------------------------*/
|
||||
#define OPT_BYTES_SIZE 4
|
||||
#define SECU_ID_SIZE 10
|
||||
#define WATCHDOG_DISABLED 0x00
|
||||
#define LVI_ENABLED 0xFE
|
||||
#define LVI_DISABLED 0xFF
|
||||
#define RESERVED_FF 0xFF
|
||||
#define OCD_DISABLED 0x04
|
||||
#define OCD_ENABLED 0x81
|
||||
#define OCD_ENABLED_ERASE 0x80
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* PORTMACRO_H */
|
||||
|
230
Source/portable/IAR/78K0R/portmacro.s26
Normal file
230
Source/portable/IAR/78K0R/portmacro.s26
Normal file
|
@ -0,0 +1,230 @@
|
|||
; FreeRTOS.org V5.1.1 - Copyright (C) 2003-2008 Richard Barry.
|
||||
;
|
||||
; This file is part of the FreeRTOS.org distribution.
|
||||
;
|
||||
; FreeRTOS.org is free software; you can redistribute it and/or modify
|
||||
; it under the terms of the GNU General Public License as published by
|
||||
; the Free Software Foundation; either version 2 of the License, or
|
||||
; (at your option) any later version.
|
||||
;
|
||||
; FreeRTOS.org is distributed in the hope that it will be useful,
|
||||
; but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
; GNU General Public License for more details.
|
||||
;
|
||||
; You should have received a copy of the GNU General Public License
|
||||
; along with FreeRTOS.org; if not, write to the Free Software
|
||||
; Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
;
|
||||
; A special exception to the GPL can be applied should you wish to distribute
|
||||
; a combined work that includes FreeRTOS.org, without being obliged to provide
|
||||
; the source code for any proprietary components. See the licensing section
|
||||
; of http://www.FreeRTOS.org for full details of how and when the exception
|
||||
; can be applied.
|
||||
;
|
||||
; ***************************************************************************
|
||||
; See http://www.FreeRTOS.org for documentation, latest information, license
|
||||
; and contact details. Please ensure to read the configuration and relevant
|
||||
; port sections of the online documentation.
|
||||
; ***************************************************************************
|
||||
;
|
||||
;------------------------------------------------------------------------------
|
||||
; Note: Select the correct include files for the device used by the application.
|
||||
#include "FreeRTOSConfig.h"
|
||||
;------------------------------------------------------------------------------
|
||||
|
||||
#if __CORE__ != __78K0R__
|
||||
#error "This file is only for 78K0R Devices"
|
||||
#endif
|
||||
|
||||
#define CS 0xFFFFC
|
||||
#define ES 0xFFFFD
|
||||
|
||||
; Functions implemented in this file
|
||||
;------------------------------------------------------------------------------
|
||||
|
||||
PUBLIC vPortYield
|
||||
PUBLIC vPortStart
|
||||
|
||||
; Functions used by scheduler
|
||||
;------------------------------------------------------------------------------
|
||||
EXTERN vTaskSwitchContext
|
||||
EXTERN vTaskIncrementTick
|
||||
|
||||
; Variables used by scheduler
|
||||
;------------------------------------------------------------------------------
|
||||
EXTERN pxCurrentTCB
|
||||
EXTERN usCriticalNesting
|
||||
|
||||
|
||||
; Tick ISR Prototype
|
||||
;------------------------------------------------------------------------------
|
||||
EXTERN ?CL78K0R_V2_L00
|
||||
|
||||
PUBWEAK `??MD_INTTM05??INTVEC 68`
|
||||
PUBLIC MD_INTTM05
|
||||
|
||||
MD_INTTM05 SYMBOL "MD_INTTM05"
|
||||
`??MD_INTTM05??INTVEC 68` SYMBOL "??INTVEC 68", MD_INTTM05
|
||||
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
; portSAVE_CONTEXT MACRO
|
||||
; Saves the context of the remaining general purpose registers, CS and ES
|
||||
; (only in far memory mode) registers
|
||||
; the usCriticalNesting Value and the Stack Pointer
|
||||
; of the active Task onto the task stack
|
||||
;------------------------------------------------------------------------------
|
||||
portSAVE_CONTEXT MACRO
|
||||
|
||||
PUSH HL
|
||||
#if configMEMORY_MODE == 1
|
||||
MOV A, CS ; save CS register
|
||||
XCH A, X
|
||||
MOV A, ES ; save ES register
|
||||
PUSH AX
|
||||
#else
|
||||
MOV A, CS ; save CS register
|
||||
PUSH AX
|
||||
#endif
|
||||
PUSH DE ; save the remaining general purpose registers
|
||||
PUSH BC
|
||||
MOVW AX, usCriticalNesting ; save the usCriticalNesting value
|
||||
PUSH AX
|
||||
MOVW AX, pxCurrentTCB ; save the Stack pointer
|
||||
MOVW HL, AX
|
||||
MOVW AX, SP
|
||||
MOVW [HL], AX
|
||||
ENDM
|
||||
;------------------------------------------------------------------------------
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
; portRESTORE_CONTEXT MACRO
|
||||
; Restores the context of the Stack Pointer, usCriticalNesting
|
||||
; value, general purpose registers and the CS and ES (only in far memory mode)
|
||||
; of the selected task from the task stack
|
||||
;------------------------------------------------------------------------------
|
||||
|
||||
portRESTORE_CONTEXT MACRO
|
||||
MOVW AX, pxCurrentTCB ; restore the Stack pointer
|
||||
MOVW HL, AX
|
||||
MOVW AX, [HL]
|
||||
MOVW SP, AX
|
||||
POP AX ; restore usCriticalNesting value
|
||||
MOVW usCriticalNesting, AX
|
||||
POP BC ; restore the necessary general purpose registers
|
||||
POP DE
|
||||
#if configMEMORY_MODE == 1
|
||||
POP AX ; restore the ES register
|
||||
MOV ES, A
|
||||
XCH A, X ; restore the CS register
|
||||
MOV CS, A
|
||||
#else
|
||||
POP AX
|
||||
MOV CS, A ; restore CS register
|
||||
#endif
|
||||
POP HL ; restore general purpose register HL
|
||||
ENDM
|
||||
;------------------------------------------------------------------------------
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
; Port Yield function to check for a Task switch in the cooperative mode
|
||||
;
|
||||
; Input: NONE
|
||||
;
|
||||
; Call: CALL vPortYield
|
||||
;
|
||||
; Output: NONE
|
||||
;
|
||||
;------------------------------------------------------------------------------
|
||||
RSEG CODE:CODE
|
||||
vPortYield:
|
||||
PUSH PSW ; save Task PSW (Program Status Word)
|
||||
DI ; global disable interrupt
|
||||
PUSH AX
|
||||
portSAVE_CONTEXT ; Save the context of the current task.
|
||||
CALL vTaskSwitchContext ; Call the scheduler.
|
||||
portRESTORE_CONTEXT ; Restore the context of whichever task the ...
|
||||
POP AX
|
||||
EI ; (re-)enable global interrupts
|
||||
POP PSW ; restore active task PSW
|
||||
RET ; ... scheduler decided should run.
|
||||
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
; Restore the context of the first task that is going to run.
|
||||
;
|
||||
; Input: NONE
|
||||
;
|
||||
; Call: CALL vPortStart
|
||||
;
|
||||
; Output: NONE
|
||||
;
|
||||
;------------------------------------------------------------------------------
|
||||
RSEG CODE:CODE
|
||||
vPortStart:
|
||||
portRESTORE_CONTEXT ; Restore the context of whichever task the ...
|
||||
POP AX
|
||||
EI ; enable global interrupts
|
||||
POP PSW ; restore active task PSW
|
||||
ret ; ... scheduler decided should run.
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
; Perform the necessary steps of the Tick Count Increment and Task Switch
|
||||
; depending on the chosen kernel configuration
|
||||
;
|
||||
; Input: NONE
|
||||
;
|
||||
; Call: ISR
|
||||
;
|
||||
; Output: NONE
|
||||
;
|
||||
;------------------------------------------------------------------------------
|
||||
#if configUSE_PREEMPTION == 1
|
||||
|
||||
MD_INTTM05:
|
||||
PUSH AX ; create temporary dummy area on stack
|
||||
PUSH AX ; save AX Register to stack
|
||||
MOVW AX, [SP+6] ; get PSW
|
||||
MOVW [SP+2], AX ; write PSW into dummy area on the stack
|
||||
|
||||
portSAVE_CONTEXT ; Save the context of the current task.
|
||||
call vTaskIncrementTick ; Call the timer tick function.
|
||||
call vTaskSwitchContext ; Call the scheduler.
|
||||
portRESTORE_CONTEXT ; Restore the context of whichever task the ...
|
||||
; ... scheduler decided should run.
|
||||
|
||||
MOVW AX, [SP+2] ; get PSW from stack
|
||||
MOVW [SP+6], AX ; write PSW to expected location for reti
|
||||
POP AX ; restore AX
|
||||
MOVW [SP+0], AX ; rewrite dummy stack area to expected value
|
||||
POP AX
|
||||
RETI
|
||||
#else
|
||||
|
||||
MD_INTTM05:
|
||||
PUSH AX ; save necessary general purpose register...
|
||||
PUSH HL ; ...used by the ISR
|
||||
MOVW AX, CS ; save CS register
|
||||
PUSH AX
|
||||
CALL vTaskIncrementTick ; Call the timer tick function.
|
||||
POP AX
|
||||
MOVW CS, AX ; restore CS register
|
||||
POP HL ; restore used general purpose registers
|
||||
POP AX
|
||||
RETI
|
||||
#endif
|
||||
|
||||
REQUIRE ?CL78K0R_V2_L00
|
||||
COMMON INTVEC:CODE:ROOT(1) ; set ISR location to the Interrupt vector table
|
||||
ORG 68
|
||||
`??MD_INTTM05??INTVEC 68`:
|
||||
DW MD_INTTM05
|
||||
; set value for the usCriticalNesting
|
||||
RSEG NEAR_ID:CONST:SORT:NOROOT(1)
|
||||
`?<Initializer for usCriticalNesting>`:
|
||||
DW 10
|
||||
|
||||
;#endif
|
||||
|
||||
END
|
Loading…
Reference in a new issue