engine_control/source/firmware/arch/stm32f4xx/driver/stm32_sys_tick.c

78 lines
1.5 KiB
C
Raw Normal View History

2016-07-23 05:59:54 +00:00
//! \file stm32_sys_tick.c
//! \author tkl
//! \date Feb 15, 2012
//! \brief Source file of the stm32f10x architecture dependent sys tick timer implementation.
#include <stdint.h>
#include <stddef.h>
#include <stdio.h>
#include "stm32f4xx.h"
#include "stm32_sys_tick.h"
#include "stm32f4xx_isr.h"
struct stm32_sys_tick_obj {
stm32_sys_tick_cb_t sys_tick_cb;
void *sys_tick_cb_param;
};
static struct stm32_sys_tick_obj stm32_sys_tick_obj;
int stm32_sys_tick_open(const void *sys_tick) {
if(sys_tick == NULL)
return -1;
struct stm32_sys_tick *this = (struct stm32_sys_tick *)sys_tick;
uint32_t div = 1000;
switch(*this->tick_time_base) {
case STM32_SYS_TICK_TIME_BASE_US:
div = 1000000;
break;
case STM32_SYS_TICK_TIME_BASE_MS:
div = 1000;
break;
default:
return -1;
}
if(SysTick_Config(SystemCoreClock / div))
return -1;
return 0;
}
int stm32_sys_tick_close(const void *sys_tick)
{
if(sys_tick == NULL)
return -1;
SysTick->CTRL = 0;
return 0;
}
int stm32_sys_tick_set_cb(const void *sys_tick, const void *callback, const void *param)
{
if((sys_tick == NULL) || (callback == NULL))
return -1;
stm32_sys_tick_obj.sys_tick_cb = (stm32_sys_tick_cb_t)callback;
stm32_sys_tick_obj.sys_tick_cb_param = (void*)param;
return 0;
}
void SysTick_Handler(void)
{
enter_isr();
if(stm32_sys_tick_obj.sys_tick_cb != NULL) {
stm32_sys_tick_cb_t cb = stm32_sys_tick_obj.sys_tick_cb;
void *param = stm32_sys_tick_obj.sys_tick_cb_param;
cb(param);
}
exit_isr();
}