mirror of https://github.com/ARMmbed/mbed-os.git
				
				
				
			
		
			
				
	
	
		
			193 lines
		
	
	
		
			7.0 KiB
		
	
	
	
		
			C
		
	
	
			
		
		
	
	
			193 lines
		
	
	
		
			7.0 KiB
		
	
	
	
		
			C
		
	
	
/* mbed Microcontroller Library
 | 
						|
 * Copyright (c) 2014, STMicroelectronics
 | 
						|
 * All rights reserved.
 | 
						|
 *
 | 
						|
 * Redistribution and use in source and binary forms, with or without
 | 
						|
 * modification, are permitted provided that the following conditions are met:
 | 
						|
 *
 | 
						|
 * 1. Redistributions of source code must retain the above copyright notice,
 | 
						|
 *    this list of conditions and the following disclaimer.
 | 
						|
 * 2. Redistributions in binary form must reproduce the above copyright notice,
 | 
						|
 *    this list of conditions and the following disclaimer in the documentation
 | 
						|
 *    and/or other materials provided with the distribution.
 | 
						|
 * 3. Neither the name of STMicroelectronics nor the names of its contributors
 | 
						|
 *    may be used to endorse or promote products derived from this software
 | 
						|
 *    without specific prior written permission.
 | 
						|
 *
 | 
						|
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 | 
						|
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 | 
						|
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
 | 
						|
 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
 | 
						|
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 | 
						|
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
 | 
						|
 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
 | 
						|
 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
 | 
						|
 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 | 
						|
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 | 
						|
 */
 | 
						|
#include "hal_tick.h"
 | 
						|
 | 
						|
// A 16-bit timer is used
 | 
						|
#if TIM_MST_16BIT
 | 
						|
 | 
						|
#define DEBUG_TICK 0 // Set to 1 to toggle a pin (see below which pin) at each tick
 | 
						|
 | 
						|
TIM_HandleTypeDef TimMasterHandle;
 | 
						|
volatile uint32_t PreviousVal = 0;
 | 
						|
 | 
						|
void us_ticker_irq_handler(void);
 | 
						|
void set_compare(uint16_t count);
 | 
						|
 | 
						|
extern volatile uint32_t SlaveCounter;
 | 
						|
extern volatile uint32_t oc_int_part;
 | 
						|
extern volatile uint16_t oc_rem_part;
 | 
						|
extern volatile uint8_t  tim_it_update;
 | 
						|
extern volatile uint32_t tim_it_counter;
 | 
						|
 | 
						|
#if defined(TARGET_STM32F0)
 | 
						|
void timer_update_irq_handler(void) {
 | 
						|
#else
 | 
						|
void timer_irq_handler(void) {
 | 
						|
#endif
 | 
						|
    uint16_t cnt_val = TIM_MST->CNT;
 | 
						|
    TimMasterHandle.Instance = TIM_MST;
 | 
						|
 | 
						|
    // Clear Update interrupt flag
 | 
						|
    if (__HAL_TIM_GET_FLAG(&TimMasterHandle, TIM_FLAG_UPDATE) == SET) {
 | 
						|
        if (__HAL_TIM_GET_IT_SOURCE(&TimMasterHandle, TIM_IT_UPDATE) == SET) {
 | 
						|
            __HAL_TIM_CLEAR_IT(&TimMasterHandle, TIM_IT_UPDATE);
 | 
						|
            SlaveCounter++;
 | 
						|
            tim_it_counter = cnt_val + (uint32_t)(SlaveCounter << 16);
 | 
						|
            tim_it_update = 1;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
#if defined(TARGET_STM32F0)
 | 
						|
} // end timer_update_irq_handler function
 | 
						|
// Used for mbed timeout (channel 1) and HAL tick (channel 2)
 | 
						|
void timer_oc_irq_handler(void)
 | 
						|
{
 | 
						|
    uint16_t cnt_val = TIM_MST->CNT;
 | 
						|
    TimMasterHandle.Instance = TIM_MST;
 | 
						|
#endif
 | 
						|
 | 
						|
    // Channel 1 for mbed timeout
 | 
						|
    if (__HAL_TIM_GET_FLAG(&TimMasterHandle, TIM_FLAG_CC1) == SET) {
 | 
						|
        if (__HAL_TIM_GET_IT_SOURCE(&TimMasterHandle, TIM_IT_CC1) == SET) {
 | 
						|
            __HAL_TIM_CLEAR_IT(&TimMasterHandle, TIM_IT_CC1);
 | 
						|
            if (oc_rem_part > 0) {
 | 
						|
                set_compare(oc_rem_part); // Finish the remaining time left
 | 
						|
                oc_rem_part = 0;
 | 
						|
            } else {
 | 
						|
                if (oc_int_part > 0) {
 | 
						|
                    set_compare(0xFFFF);
 | 
						|
                    oc_rem_part = cnt_val; // To finish the counter loop the next time
 | 
						|
                    oc_int_part--;
 | 
						|
                } else {
 | 
						|
                    us_ticker_irq_handler();
 | 
						|
                }
 | 
						|
            }
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    // Channel 2 for HAL tick
 | 
						|
    if (__HAL_TIM_GET_FLAG(&TimMasterHandle, TIM_FLAG_CC2) == SET) {
 | 
						|
        if (__HAL_TIM_GET_IT_SOURCE(&TimMasterHandle, TIM_IT_CC2) == SET) {
 | 
						|
            __HAL_TIM_CLEAR_IT(&TimMasterHandle, TIM_IT_CC2);
 | 
						|
            uint32_t val = __HAL_TIM_GetCounter(&TimMasterHandle);
 | 
						|
            if ((val - PreviousVal) >= HAL_TICK_DELAY) {
 | 
						|
                // Increment HAL variable
 | 
						|
                HAL_IncTick();
 | 
						|
                // Prepare next interrupt
 | 
						|
                __HAL_TIM_SetCompare(&TimMasterHandle, TIM_CHANNEL_2, val + HAL_TICK_DELAY);
 | 
						|
                PreviousVal = val;
 | 
						|
#if DEBUG_TICK > 0
 | 
						|
                HAL_GPIO_TogglePin(GPIOB, GPIO_PIN_6);
 | 
						|
#endif
 | 
						|
            }
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
// Reconfigure the HAL tick using a standard timer instead of systick.
 | 
						|
HAL_StatusTypeDef HAL_InitTick(uint32_t TickPriority) {
 | 
						|
    // Enable timer clock
 | 
						|
    TIM_MST_RCC;
 | 
						|
 | 
						|
    // Reset timer
 | 
						|
    TIM_MST_RESET_ON;
 | 
						|
    TIM_MST_RESET_OFF;
 | 
						|
 | 
						|
    // Update the SystemCoreClock variable
 | 
						|
    SystemCoreClockUpdate();
 | 
						|
 | 
						|
    // Configure time base
 | 
						|
    TimMasterHandle.Instance = TIM_MST;
 | 
						|
    TimMasterHandle.Init.Period        = 0xFFFFFFFF;
 | 
						|
    TimMasterHandle.Init.Prescaler     = (uint32_t)(SystemCoreClock / 1000000) - 1; // 1 us tick
 | 
						|
    TimMasterHandle.Init.ClockDivision = 0;
 | 
						|
    TimMasterHandle.Init.CounterMode   = TIM_COUNTERMODE_UP;
 | 
						|
    HAL_TIM_Base_Init(&TimMasterHandle);
 | 
						|
 | 
						|
    // Configure output compare channel 1 for mbed timeout (enabled later when used)
 | 
						|
    HAL_TIM_OC_Start(&TimMasterHandle, TIM_CHANNEL_1);
 | 
						|
 | 
						|
    // Configure output compare channel 2 for HAL tick
 | 
						|
    HAL_TIM_OC_Start(&TimMasterHandle, TIM_CHANNEL_2);
 | 
						|
    PreviousVal = __HAL_TIM_GetCounter(&TimMasterHandle);
 | 
						|
    __HAL_TIM_SetCompare(&TimMasterHandle, TIM_CHANNEL_2, PreviousVal + HAL_TICK_DELAY);
 | 
						|
 | 
						|
    // Configure interrupts
 | 
						|
    // Update interrupt used for 32-bit counter
 | 
						|
    // Output compare channel 1 interrupt for mbed timeout
 | 
						|
    // Output compare channel 2 interrupt for HAL tick
 | 
						|
#if defined(TARGET_STM32F0)
 | 
						|
    NVIC_SetVector(TIM_MST_UP_IRQ, (uint32_t)timer_update_irq_handler);
 | 
						|
    NVIC_EnableIRQ(TIM_MST_UP_IRQ);
 | 
						|
    NVIC_SetPriority(TIM_MST_UP_IRQ, 0);
 | 
						|
    NVIC_SetVector(TIM_MST_OC_IRQ, (uint32_t)timer_oc_irq_handler);
 | 
						|
    NVIC_EnableIRQ(TIM_MST_OC_IRQ);
 | 
						|
    NVIC_SetPriority(TIM_MST_OC_IRQ, 1);
 | 
						|
#else
 | 
						|
    NVIC_SetVector(TIM_MST_IRQ, (uint32_t)timer_irq_handler);
 | 
						|
    NVIC_EnableIRQ(TIM_MST_IRQ);
 | 
						|
#endif
 | 
						|
 | 
						|
    // Enable interrupts
 | 
						|
    __HAL_TIM_ENABLE_IT(&TimMasterHandle, TIM_IT_UPDATE); // For 32-bit counter
 | 
						|
    __HAL_TIM_ENABLE_IT(&TimMasterHandle, TIM_IT_CC2); // For HAL tick
 | 
						|
 | 
						|
    // Enable timer
 | 
						|
    HAL_TIM_Base_Start(&TimMasterHandle);
 | 
						|
 | 
						|
#if DEBUG_TICK > 0
 | 
						|
    __GPIOB_CLK_ENABLE();
 | 
						|
    GPIO_InitTypeDef GPIO_InitStruct;
 | 
						|
    GPIO_InitStruct.Pin = GPIO_PIN_6;
 | 
						|
    GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
 | 
						|
    GPIO_InitStruct.Pull = GPIO_PULLUP;
 | 
						|
    GPIO_InitStruct.Speed = GPIO_SPEED_HIGH;
 | 
						|
    HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
 | 
						|
#endif
 | 
						|
 | 
						|
    return HAL_OK;
 | 
						|
}
 | 
						|
 | 
						|
void HAL_SuspendTick(void)
 | 
						|
{
 | 
						|
    TimMasterHandle.Instance = TIM_MST;
 | 
						|
 | 
						|
    // Disable HAL tick and us_ticker update interrupts (used for 32 bit counter)
 | 
						|
    __HAL_TIM_DISABLE_IT(&TimMasterHandle, (TIM_IT_CC2 | TIM_IT_UPDATE));
 | 
						|
}
 | 
						|
 | 
						|
void HAL_ResumeTick(void)
 | 
						|
{
 | 
						|
    TimMasterHandle.Instance = TIM_MST;
 | 
						|
 | 
						|
    // Enable HAL tick and us_ticker update interrupts (used for 32 bit counter)
 | 
						|
    __HAL_TIM_ENABLE_IT(&TimMasterHandle, (TIM_IT_CC2 | TIM_IT_UPDATE));
 | 
						|
}
 | 
						|
 | 
						|
#endif // TIM_MST_16BIT
 |