begriffs open source - freertos/blob - portable/Renesas/SH2A_FPU/portasm.src

   1 ;/*
   2 ; * FreeRTOS Kernel <DEVELOPMENT BRANCH>
   3 ; * Copyright (C) 2021 Amazon.com, Inc. or its affiliates. All Rights Reserved.
   4 ; *
   5 ; * SPDX-License-Identifier: MIT
   6 ; *
   7 ; * Permission is hereby granted, free of charge, to any person obtaining a copy of
   8 ; * this software and associated documentation files (the "Software"), to deal in
   9 ; * the Software without restriction, including without limitation the rights to
  10 ; * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
  11 ; * the Software, and to permit persons to whom the Software is furnished to do so,
  12 ; * subject to the following conditions:
  13 ; *
  14 ; * The above copyright notice and this permission notice shall be included in all
  15 ; * copies or substantial portions of the Software.
  16 ; *
  17 ; * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  18 ; * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
  19 ; * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
  20 ; * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
  21 ; * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  22 ; * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  23 ; *
  24 ; * https://www.FreeRTOS.org
  25 ; * https://github.com/FreeRTOS
  26 ; *
  27 ; */
  28
  29     .import _pxCurrentTCB
  30     .import _vTaskSwitchContext
  31     .import _xTaskIncrementTick
  32
  33     .export _vPortStartFirstTask
  34     .export _ulPortGetGBR
  35     .export _vPortYieldHandler
  36     .export _vPortPreemptiveTick
  37     .export _vPortCooperativeTick
  38     .export _vPortSaveFlopRegisters
  39     .export _vPortRestoreFlopRegisters
  40
  41     .section    P
  42
  43     .INCLUDE "ISR_Support.inc"
  44
  45 _vPortStartFirstTask:
  46
  47     portRESTORE_CONTEXT
  48
  49 ;-----------------------------------------------------------
  50
  51 _vPortYieldHandler:
  52
  53     portSAVE_CONTEXT
  54
  55     mov.l   #_vTaskSwitchContext, r0
  56     jsr     @r0
  57     nop
  58
  59     portRESTORE_CONTEXT
  60
  61 ;-----------------------------------------------------------
  62
  63 _vPortPreemptiveTick
  64
  65     portSAVE_CONTEXT
  66
  67     mov.l   #_xTaskIncrementTick, r0
  68     jsr     @r0
  69     nop
  70
  71     mov.l   #_vTaskSwitchContext, r0
  72     jsr     @r0
  73     nop
  74
  75     portRESTORE_CONTEXT
  76
  77 ;-----------------------------------------------------------
  78
  79 _vPortCooperativeTick
  80
  81     portSAVE_CONTEXT
  82
  83     mov.l   #_xTaskIncrementTick, r0
  84     jsr     @r0
  85     nop
  86
  87     portRESTORE_CONTEXT
  88
  89 ;-----------------------------------------------------------
  90
  91 _ulPortGetGBR:
  92
  93     stc.l   gbr, r0
  94     rts
  95     nop
  96
  97 ;-----------------------------------------------------------
  98
  99 _vPortSaveFlopRegisters:
 100
 101     fmov.s  fr0, @-r4
 102     fmov.s  fr1, @-r4
 103     fmov.s  fr2, @-r4
 104     fmov.s  fr3, @-r4
 105     fmov.s  fr4, @-r4
 106     fmov.s  fr5, @-r4
 107     fmov.s  fr6, @-r4
 108     fmov.s  fr7, @-r4
 109     fmov.s  fr8, @-r4
 110     fmov.s  fr9, @-r4
 111     fmov.s  fr10, @-r4
 112     fmov.s  fr11, @-r4
 113     fmov.s  fr12, @-r4
 114     fmov.s  fr13, @-r4
 115     fmov.s  fr14, @-r4
 116     fmov.s  fr15, @-r4
 117     sts.l   fpul, @-r4
 118     sts.l   fpscr, @-r4
 119
 120     rts
 121     nop
 122
 123 ;-----------------------------------------------------------
 124
 125 _vPortRestoreFlopRegisters:
 126
 127     add.l  #-72, r4
 128     lds.l  @r4+, fpscr
 129     lds.l  @r4+, fpul
 130     fmov.s @r4+, fr15
 131     fmov.s @r4+, fr14
 132     fmov.s @r4+, fr13
 133     fmov.s @r4+, fr12
 134     fmov.s @r4+, fr11
 135     fmov.s @r4+, fr10
 136     fmov.s @r4+, fr9
 137     fmov.s @r4+, fr8
 138     fmov.s @r4+, fr7
 139     fmov.s @r4+, fr6
 140     fmov.s @r4+, fr5
 141     fmov.s @r4+, fr4
 142     fmov.s @r4+, fr3
 143     fmov.s @r4+, fr2
 144     fmov.s @r4+, fr1
 145     fmov.s @r4+, fr0
 146
 147     rts
 148     nop
 149
 150     .end