begriffs open source - cmsis-freertos/blob - Source/portable/RVDS/ARM7_LPC21xx/portASM.s

   1 ;/*
   2 ; * FreeRTOS Kernel V11.2.0
   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     INCLUDE portmacro.inc
  30
  31     IMPORT  vTaskSwitchContext
  32     IMPORT  xTaskIncrementTick
  33
  34     EXPORT  vPortYieldProcessor
  35     EXPORT  vPortStartFirstTask
  36     EXPORT  vPreemptiveTick
  37     EXPORT  vPortYield
  38
  39
  40 VICVECTADDR EQU 0xFFFFF030
  41 T0IR        EQU 0xE0004000
  42 T0MATCHBIT  EQU 0x00000001
  43
  44     ARM
  45     AREA    PORT_ASM, CODE, READONLY
  46
  47
  48
  49 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  50 ; Starting the first task is done by just restoring the context
  51 ; setup by pxPortInitialiseStack
  52 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  53 vPortStartFirstTask
  54
  55     PRESERVE8
  56
  57     portRESTORE_CONTEXT
  58
  59 vPortYield
  60
  61     PRESERVE8
  62
  63     SVC 0
  64     bx lr
  65
  66 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  67 ; Interrupt service routine for the SWI interrupt.  The vector table is
  68 ; configured in the startup.s file.
  69 ;
  70 ; vPortYieldProcessor() is used to manually force a context switch.  The
  71 ; SWI interrupt is generated by a call to taskYIELD() or portYIELD().
  72 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  73
  74 vPortYieldProcessor
  75
  76     PRESERVE8
  77
  78     ; Within an IRQ ISR the link register has an offset from the true return
  79     ; address, but an SWI ISR does not.  Add the offset manually so the same
  80     ; ISR return code can be used in both cases.
  81     ADD LR, LR, #4
  82
  83     ; Perform the context switch.
  84     portSAVE_CONTEXT                    ; Save current task context
  85     LDR R0, =vTaskSwitchContext         ; Get the address of the context switch function
  86     MOV LR, PC                          ; Store the return address
  87     BX  R0                              ; Call the contedxt switch function
  88     portRESTORE_CONTEXT                 ; restore the context of the selected task
  89
  90
  91
  92 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  93 ; Interrupt service routine for preemptive scheduler tick timer
  94 ; Only used if portUSE_PREEMPTION is set to 1 in portmacro.h
  95 ;
  96 ; Uses timer 0 of LPC21XX Family
  97 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  98
  99 vPreemptiveTick
 100
 101     PRESERVE8
 102
 103     portSAVE_CONTEXT                    ; Save the context of the current task.
 104
 105     LDR R0, =xTaskIncrementTick         ; Increment the tick count.
 106     MOV LR, PC                          ; This may make a delayed task ready
 107     BX R0                               ; to run.
 108
 109     CMP R0, #0
 110     BEQ SkipContextSwitch
 111     LDR R0, =vTaskSwitchContext         ; Find the highest priority task that
 112     MOV LR, PC                          ; is ready to run.
 113     BX R0
 114 SkipContextSwitch
 115     MOV R0, #T0MATCHBIT                 ; Clear the timer event
 116     LDR R1, =T0IR
 117     STR R0, [R1]
 118
 119     LDR R0, =VICVECTADDR                ; Acknowledge the interrupt
 120     STR R0,[R0]
 121
 122     portRESTORE_CONTEXT                 ; Restore the context of the highest
 123                                         ; priority task that is ready to run.
 124     END