| /* |
| * 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 |