/* | |
* 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 | |
* | |
*/ | |
/* | |
* Purpose: Lowest level routines for all ColdFire processors. | |
* | |
* Notes: | |
* | |
* ulPortSetIPL() and mcf5xxx_wr_cacr() copied with permission from FreeScale | |
* supplied source files. | |
*/ | |
.global ulPortSetIPL | |
.global _ulPortSetIPL | |
.global mcf5xxx_wr_cacrx | |
.global _mcf5xxx_wr_cacrx | |
.global vPortYieldISR | |
.global _vPortYieldISR | |
.global vPortStartFirstTask | |
.global _vPortStartFirstTask | |
.extern _pxCurrentTCB | |
.extern _vPortYieldHandler | |
.text | |
.macro portSAVE_CONTEXT | |
lea.l (-60, sp), sp | |
movem.l d0-a6, (sp) | |
move.l _pxCurrentTCB, a0 | |
move.l sp, (a0) | |
.endm | |
.macro portRESTORE_CONTEXT | |
move.l _pxCurrentTCB, a0 | |
move.l (a0), sp | |
movem.l (sp), d0-a6 | |
lea.l (60, sp), sp | |
rte | |
.endm | |
/********************************************************************/ | |
/* | |
* This routines changes the IPL to the value passed into the routine. | |
* It also returns the old IPL value back. | |
* Calling convention from C: | |
* old_ipl = asm_set_ipl(new_ipl); | |
* For the Diab Data C compiler, it passes return value thru D0. | |
* Note that only the least significant three bits of the passed | |
* value are used. | |
*/ | |
ulPortSetIPL: | |
_ulPortSetIPL: | |
link A6,#-8 | |
movem.l D6-D7,(SP) | |
move.w SR,D7 /* current sr */ | |
move.l D7,D6 /* prepare return value */ | |
andi.l #0x0700,D6 /* mask out IPL */ | |
lsr.l #8,D6 /* IPL */ | |
andi.l #0x07,D0 /* least significant three bits */ | |
lsl.l #8,D0 /* move over to make mask */ | |
andi.l #0x0000F8FF,D7 /* zero out current IPL */ | |
or.l D0,D7 /* place new IPL in sr */ | |
move.w D7,SR | |
move.l D6, D0 /* Return value in D0. */ | |
movem.l (SP),D6-D7 | |
lea 8(SP),SP | |
unlk A6 | |
rts | |
/********************************************************************/ | |
mcf5xxx_wr_cacrx: | |
_mcf5xxx_wr_cacrx: | |
move.l 4(sp),d0 | |
.long 0x4e7b0002 /* movec d0,cacr */ | |
nop | |
rts | |
/********************************************************************/ | |
/* Yield interrupt. */ | |
_vPortYieldISR: | |
vPortYieldISR: | |
portSAVE_CONTEXT | |
jsr _vPortYieldHandler | |
portRESTORE_CONTEXT | |
/********************************************************************/ | |
vPortStartFirstTask: | |
_vPortStartFirstTask: | |
portRESTORE_CONTEXT | |
.end | |