| /**************************************************************************//** |
| * @file os_tick_ptim.c |
| * @brief CMSIS OS Tick implementation for Private Timer |
| * @version V1.0.2 |
| * @date 02. March 2018 |
| ******************************************************************************/ |
| /* |
| * Copyright (c) 2017-2018 Arm Limited. All rights reserved. |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| * |
| * Licensed under the Apache License, Version 2.0 (the License); you may |
| * not use this file except in compliance with the License. |
| * You may obtain a copy of the License at |
| * |
| * www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an AS IS BASIS, WITHOUT |
| * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| */ |
| |
| #include "RTE_Components.h" |
| #include CMSIS_device_header |
| |
| #if defined(PTIM) |
| |
| #include "os_tick.h" |
| #include "irq_ctrl.h" |
| |
| #ifndef PTIM_IRQ_PRIORITY |
| #define PTIM_IRQ_PRIORITY 0xFFU |
| #endif |
| |
| static uint8_t PTIM_PendIRQ; // Timer interrupt pending flag |
| |
| // Setup OS Tick. |
| int32_t OS_Tick_Setup (uint32_t freq, IRQHandler_t handler) { |
| uint32_t load; |
| uint32_t prio; |
| uint32_t bits; |
| |
| if (freq == 0U) { |
| return (-1); |
| } |
| |
| PTIM_PendIRQ = 0U; |
| |
| // Private Timer runs with the system frequency |
| load = (SystemCoreClock / freq) - 1U; |
| |
| // Disable Private Timer and set load value |
| PTIM_SetControl (0U); |
| PTIM_SetLoadValue (load); |
| |
| // Disable corresponding IRQ |
| IRQ_Disable (PrivTimer_IRQn); |
| IRQ_ClearPending(PrivTimer_IRQn); |
| |
| // Determine number of implemented priority bits |
| IRQ_SetPriority (PrivTimer_IRQn, 0xFFU); |
| |
| prio = IRQ_GetPriority (PrivTimer_IRQn); |
| |
| // At least bits [7:4] must be implemented |
| if ((prio & 0xF0U) == 0U) { |
| return (-1); |
| } |
| |
| for (bits = 0; bits < 4; bits++) { |
| if ((prio & 0x01) != 0) { |
| break; |
| } |
| prio >>= 1; |
| } |
| |
| // Adjust configured priority to the number of implemented priority bits |
| prio = (PTIM_IRQ_PRIORITY << bits) & 0xFFUL; |
| |
| // Set Private Timer interrupt priority |
| IRQ_SetPriority(PrivTimer_IRQn, prio-1U); |
| |
| // Set edge-triggered IRQ |
| IRQ_SetMode(PrivTimer_IRQn, IRQ_MODE_TRIG_EDGE); |
| |
| // Register tick interrupt handler function |
| IRQ_SetHandler(PrivTimer_IRQn, handler); |
| |
| // Enable corresponding interrupt |
| IRQ_Enable (PrivTimer_IRQn); |
| |
| // Set bits: IRQ enable and Auto reload |
| PTIM_SetControl (0x06U); |
| |
| return (0); |
| } |
| |
| /// Enable OS Tick. |
| void OS_Tick_Enable (void) { |
| uint32_t ctrl; |
| |
| // Set pending interrupt if flag set |
| if (PTIM_PendIRQ != 0U) { |
| PTIM_PendIRQ = 0U; |
| IRQ_SetPending (PrivTimer_IRQn); |
| } |
| |
| // Start the Private Timer |
| ctrl = PTIM_GetControl(); |
| // Set bit: Timer enable |
| ctrl |= 1U; |
| PTIM_SetControl (ctrl); |
| } |
| |
| /// Disable OS Tick. |
| void OS_Tick_Disable (void) { |
| uint32_t ctrl; |
| |
| // Stop the Private Timer |
| ctrl = PTIM_GetControl(); |
| // Clear bit: Timer enable |
| ctrl &= ~1U; |
| PTIM_SetControl (ctrl); |
| |
| // Remember pending interrupt flag |
| if (IRQ_GetPending(PrivTimer_IRQn) != 0) { |
| IRQ_ClearPending (PrivTimer_IRQn); |
| PTIM_PendIRQ = 1U; |
| } |
| } |
| |
| // Acknowledge OS Tick IRQ. |
| void OS_Tick_AcknowledgeIRQ (void) { |
| PTIM_ClearEventFlag(); |
| } |
| |
| // Get OS Tick IRQ number. |
| int32_t OS_Tick_GetIRQn (void) { |
| return (PrivTimer_IRQn); |
| } |
| |
| // Get OS Tick clock. |
| uint32_t OS_Tick_GetClock (void) { |
| return (SystemCoreClock); |
| } |
| |
| // Get OS Tick interval. |
| uint32_t OS_Tick_GetInterval (void) { |
| return (PTIM_GetLoadValue() + 1U); |
| } |
| |
| // Get OS Tick count value. |
| uint32_t OS_Tick_GetCount (void) { |
| uint32_t load = PTIM_GetLoadValue(); |
| return (load - PTIM_GetCurrentValue()); |
| } |
| |
| // Get OS Tick overflow status. |
| uint32_t OS_Tick_GetOverflow (void) { |
| return (PTIM->ISR & 1); |
| } |
| |
| #endif // PTIM |