You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
230 lines
8.7 KiB
Plaintext
230 lines
8.7 KiB
Plaintext
16 years ago
|
; 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
|