Details | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 2 | mjames | 1 | /**************************************************************************//** |
| 2 | * @file os_systick.c |
||
| 3 | * @brief CMSIS OS Tick SysTick implementation |
||
| 4 | * @version V1.0.1 |
||
| 5 | * @date 24. November 2017 |
||
| 6 | ******************************************************************************/ |
||
| 7 | /* |
||
| 8 | * Copyright (c) 2017-2017 ARM Limited. All rights reserved. |
||
| 9 | * |
||
| 10 | * SPDX-License-Identifier: Apache-2.0 |
||
| 11 | * |
||
| 12 | * Licensed under the Apache License, Version 2.0 (the License); you may |
||
| 13 | * not use this file except in compliance with the License. |
||
| 14 | * You may obtain a copy of the License at |
||
| 15 | * |
||
| 16 | * www.apache.org/licenses/LICENSE-2.0 |
||
| 17 | * |
||
| 18 | * Unless required by applicable law or agreed to in writing, software |
||
| 19 | * distributed under the License is distributed on an AS IS BASIS, WITHOUT |
||
| 20 | * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
||
| 21 | * See the License for the specific language governing permissions and |
||
| 22 | * limitations under the License. |
||
| 23 | */ |
||
| 24 | |||
| 25 | #include "os_tick.h" |
||
| 26 | |||
| 27 | //lint -emacro((923,9078),SCB,SysTick) "cast from unsigned long to pointer" |
||
| 28 | #include "RTE_Components.h" |
||
| 29 | #include CMSIS_device_header |
||
| 30 | |||
| 31 | #ifdef SysTick |
||
| 32 | |||
| 33 | #ifndef SYSTICK_IRQ_PRIORITY |
||
| 34 | #define SYSTICK_IRQ_PRIORITY 0xFFU |
||
| 35 | #endif |
||
| 36 | |||
| 37 | static uint8_t PendST; |
||
| 38 | |||
| 39 | // Setup OS Tick. |
||
| 40 | __WEAK int32_t OS_Tick_Setup (uint32_t freq, IRQHandler_t handler) { |
||
| 41 | uint32_t load; |
||
| 42 | (void)handler; |
||
| 43 | |||
| 44 | if (freq == 0U) { |
||
| 45 | //lint -e{904} "Return statement before end of function" |
||
| 46 | return (-1); |
||
| 47 | } |
||
| 48 | |||
| 49 | load = (SystemCoreClock / freq) - 1U; |
||
| 50 | if (load > 0x00FFFFFFU) { |
||
| 51 | //lint -e{904} "Return statement before end of function" |
||
| 52 | return (-1); |
||
| 53 | } |
||
| 54 | |||
| 55 | // Set SysTick Interrupt Priority |
||
| 56 | #if ((defined(__ARM_ARCH_8M_MAIN__) && (__ARM_ARCH_8M_MAIN__ != 0)) || \ |
||
| 57 | (defined(__CORTEX_M) && (__CORTEX_M == 7U))) |
||
| 58 | SCB->SHPR[11] = SYSTICK_IRQ_PRIORITY; |
||
| 59 | #elif (defined(__ARM_ARCH_8M_BASE__) && (__ARM_ARCH_8M_BASE__ != 0)) |
||
| 60 | SCB->SHPR[1] |= ((uint32_t)SYSTICK_IRQ_PRIORITY << 24); |
||
| 61 | #elif ((defined(__ARM_ARCH_7M__) && (__ARM_ARCH_7M__ != 0)) || \ |
||
| 62 | (defined(__ARM_ARCH_7EM__) && (__ARM_ARCH_7EM__ != 0))) |
||
| 63 | SCB->SHP[11] = SYSTICK_IRQ_PRIORITY; |
||
| 64 | #elif (defined(__ARM_ARCH_6M__) && (__ARM_ARCH_6M__ != 0)) |
||
| 65 | SCB->SHP[1] |= ((uint32_t)SYSTICK_IRQ_PRIORITY << 24); |
||
| 66 | #else |
||
| 67 | #error "Unknown ARM Core!" |
||
| 68 | #endif |
||
| 69 | |||
| 70 | SysTick->CTRL = SysTick_CTRL_CLKSOURCE_Msk | SysTick_CTRL_TICKINT_Msk; |
||
| 71 | SysTick->LOAD = load; |
||
| 72 | SysTick->VAL = 0U; |
||
| 73 | |||
| 74 | PendST = 0U; |
||
| 75 | |||
| 76 | return (0); |
||
| 77 | } |
||
| 78 | |||
| 79 | /// Enable OS Tick. |
||
| 80 | __WEAK void OS_Tick_Enable (void) { |
||
| 81 | |||
| 82 | if (PendST != 0U) { |
||
| 83 | PendST = 0U; |
||
| 84 | SCB->ICSR = SCB_ICSR_PENDSTSET_Msk; |
||
| 85 | } |
||
| 86 | |||
| 87 | SysTick->CTRL |= SysTick_CTRL_ENABLE_Msk; |
||
| 88 | } |
||
| 89 | |||
| 90 | /// Disable OS Tick. |
||
| 91 | __WEAK void OS_Tick_Disable (void) { |
||
| 92 | |||
| 93 | SysTick->CTRL &= ~SysTick_CTRL_ENABLE_Msk; |
||
| 94 | |||
| 95 | if ((SCB->ICSR & SCB_ICSR_PENDSTSET_Msk) != 0U) { |
||
| 96 | SCB->ICSR = SCB_ICSR_PENDSTCLR_Msk; |
||
| 97 | PendST = 1U; |
||
| 98 | } |
||
| 99 | } |
||
| 100 | |||
| 101 | // Acknowledge OS Tick IRQ. |
||
| 102 | __WEAK void OS_Tick_AcknowledgeIRQ (void) { |
||
| 103 | (void)SysTick->CTRL; |
||
| 104 | } |
||
| 105 | |||
| 106 | // Get OS Tick IRQ number. |
||
| 107 | __WEAK int32_t OS_Tick_GetIRQn (void) { |
||
| 108 | return ((int32_t)SysTick_IRQn); |
||
| 109 | } |
||
| 110 | |||
| 111 | // Get OS Tick clock. |
||
| 112 | __WEAK uint32_t OS_Tick_GetClock (void) { |
||
| 113 | return (SystemCoreClock); |
||
| 114 | } |
||
| 115 | |||
| 116 | // Get OS Tick interval. |
||
| 117 | __WEAK uint32_t OS_Tick_GetInterval (void) { |
||
| 118 | return (SysTick->LOAD + 1U); |
||
| 119 | } |
||
| 120 | |||
| 121 | // Get OS Tick count value. |
||
| 122 | __WEAK uint32_t OS_Tick_GetCount (void) { |
||
| 123 | uint32_t load = SysTick->LOAD; |
||
| 124 | return (load - SysTick->VAL); |
||
| 125 | } |
||
| 126 | |||
| 127 | // Get OS Tick overflow status. |
||
| 128 | __WEAK uint32_t OS_Tick_GetOverflow (void) { |
||
| 129 | return ((SysTick->CTRL >> 16) & 1U); |
||
| 130 | } |
||
| 131 | |||
| 132 | #endif // SysTick |