/* | |
* FreeRTOS Kernel <DEVELOPMENT BRANCH> | |
* Copyright (C) 2021 Amazon.com, Inc. or its affiliates. All Rights Reserved. | |
* | |
* SPDX-License-Identifier: MIT | |
* | |
* Permission is hereby granted, free of charge, to any person obtaining a copy of | |
* this software and associated documentation files (the "Software"), to deal in | |
* the Software without restriction, including without limitation the rights to | |
* use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of | |
* the Software, and to permit persons to whom the Software is furnished to do so, | |
* subject to the following conditions: | |
* | |
* The above copyright notice and this permission notice shall be included in all | |
* copies or substantial portions of the Software. | |
* | |
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS | |
* FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR | |
* COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER | |
* IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | |
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. | |
* | |
* https://www.FreeRTOS.org | |
* https://github.com/FreeRTOS | |
* | |
*/ | |
/* Variables used by scheduler */ | |
.extern _pxCurrentTCB | |
.extern _usCriticalNesting | |
/* | |
* portSAVE_CONTEXT MACRO | |
* Saves the context of the 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 | |
*/ | |
.macro portSAVE_CONTEXT | |
SEL RB0 | |
/* Save AX Register to stack. */ | |
PUSH AX | |
PUSH HL | |
/* Save CS register. */ | |
MOV A, CS | |
XCH A, X | |
/* Save ES register. */ | |
MOV A, ES | |
PUSH AX | |
/* Save the remaining general purpose registers from bank 0. */ | |
PUSH DE | |
PUSH BC | |
/* Save the other register banks - only necessary in the GCC port. */ | |
SEL RB1 | |
PUSH AX | |
PUSH BC | |
PUSH DE | |
PUSH HL | |
SEL RB2 | |
PUSH AX | |
PUSH BC | |
PUSH DE | |
PUSH HL | |
/* Registers in bank 3 are for ISR use only so don't need saving. */ | |
SEL RB0 | |
/* Save the usCriticalNesting value. */ | |
MOVW AX, !_usCriticalNesting | |
PUSH AX | |
/* Save the Stack pointer. */ | |
MOVW AX, !_pxCurrentTCB | |
MOVW HL, AX | |
MOVW AX, SP | |
MOVW [HL], AX | |
/* Switch stack pointers. */ | |
movw sp,#_stack /* Set stack pointer */ | |
.endm | |
/* | |
* portRESTORE_CONTEXT MACRO | |
* Restores the task Stack Pointer then use this to restore usCriticalNesting, | |
* general purpose registers and the CS and ES (only in far memory mode) | |
* of the selected task from the task stack | |
*/ | |
.macro portRESTORE_CONTEXT MACRO | |
SEL RB0 | |
/* Restore the Stack pointer. */ | |
MOVW AX, !_pxCurrentTCB | |
MOVW HL, AX | |
MOVW AX, [HL] | |
MOVW SP, AX | |
/* Restore usCriticalNesting value. */ | |
POP AX | |
MOVW !_usCriticalNesting, AX | |
/* Restore the alternative register banks - only necessary in the GCC | |
port. Register bank 3 is dedicated for interrupts use so is not saved or | |
restored. */ | |
SEL RB2 | |
POP HL | |
POP DE | |
POP BC | |
POP AX | |
SEL RB1 | |
POP HL | |
POP DE | |
POP BC | |
POP AX | |
SEL RB0 | |
/* Restore the necessary general purpose registers. */ | |
POP BC | |
POP DE | |
/* Restore the ES register. */ | |
POP AX | |
MOV ES, A | |
/* Restore the CS register. */ | |
XCH A, X | |
MOV CS, A | |
/* Restore general purpose register HL. */ | |
POP HL | |
/* Restore AX. */ | |
POP AX | |
.endm | |