166 lines
		
	
	
		
			3.8 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			166 lines
		
	
	
		
			3.8 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
|   | /**************************************************************************//**
 | ||
|  |  * @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
 |