ARMmbed
/
mbed-os
mirror of https://github.com/ARMmbed/mbed-os.git
1
0
Fork 0
Code Issues Projects Releases Wiki Activity

lp_ticker code condensation

pull/1501/head
Steven Cooreman 2016-01-05 16:23:45 +01:00
parent 8fac7bb8e6
commit dc2e6317ba
1 changed files with 25 additions and 41 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

60
libraries/mbed/targets/hal/TARGET_Silicon_Labs/TARGET_EFM32/lp_ticker.c
View File

@ -44,9 +44,23 @@ static int rtc_reserved = 0;
void lp_ticker_init() void lp_ticker_init()
{ {
if(!rtc_reserved) {
INT_Disable();
rtc_init_real(RTC_INIT_LPTIMER); rtc_init_real(RTC_INIT_LPTIMER);
rtc_set_comp0_handler((uint32_t)lp_ticker_irq_handler); rtc_set_comp0_handler((uint32_t)lp_ticker_irq_handler);
rtc_reserved = 1; rtc_reserved = 1;
INT_Enable();
}
}
void lp_ticker_free()
{
if(rtc_reserved) {
INT_Disable();
rtc_free_real(RTC_INIT_LPTIMER);
rtc_reserved = 0;
INT_Enable();
}
} }
#ifndef RTCC_COUNT #ifndef RTCC_COUNT
@ -62,12 +76,7 @@ void lp_ticker_set_interrupt(timestamp_t timestamp)
/* Initialize RTC */ /* Initialize RTC */
rtc_set_comp0_handler((uint32_t)lp_ticker_irq_handler); rtc_set_comp0_handler((uint32_t)lp_ticker_irq_handler);
INT_Disable(); lp_ticker_init();
if(!rtc_reserved) {
rtc_init_real(RTC_INIT_LPTIMER);
rtc_reserved = 1;
}
INT_Enable();
/* calculate offset value */ /* calculate offset value */
timestamp_t offset = timestamp - current_time; timestamp_t offset = timestamp - current_time;
@ -94,13 +103,7 @@ void lp_ticker_set_interrupt(timestamp_t timestamp)
inline void lp_ticker_disable_interrupt() inline void lp_ticker_disable_interrupt()
{ {
RTC_IntDisable(RTC_IF_COMP0); RTC_IntDisable(RTC_IF_COMP0);
lp_ticker_free();
INT_Disable();
if(rtc_reserved) {
rtc_free_real(RTC_INIT_LPTIMER);
rtc_reserved = 0;
}
INT_Enable();
} }
inline void lp_ticker_clear_interrupt() inline void lp_ticker_clear_interrupt()
@ -110,12 +113,8 @@ inline void lp_ticker_clear_interrupt()
timestamp_t lp_ticker_read() timestamp_t lp_ticker_read()
{ {
if(!rtc_reserved) { lp_ticker_init();
INT_Disable();
rtc_init_real(RTC_INIT_LPTIMER);
rtc_reserved = 1;
INT_Enable();
}
uint64_t ticks_temp; uint64_t ticks_temp;
uint64_t ticks = RTC_CounterGet(); uint64_t ticks = RTC_CounterGet();
@ -141,12 +140,7 @@ void lp_ticker_set_interrupt(timestamp_t timestamp)
/* Initialize RTC */ /* Initialize RTC */
rtc_set_comp0_handler((uint32_t)lp_ticker_irq_handler); rtc_set_comp0_handler((uint32_t)lp_ticker_irq_handler);
INT_Disable(); lp_ticker_init();
if(!rtc_reserved) {
rtc_init_real(RTC_INIT_LPTIMER);
rtc_reserved = 1;
}
INT_Enable();
/* calculate offset value */ /* calculate offset value */
timestamp_t offset = timestamp - current_time; timestamp_t offset = timestamp - current_time;
@ -180,13 +174,7 @@ void lp_ticker_set_interrupt(timestamp_t timestamp)
inline void lp_ticker_disable_interrupt() inline void lp_ticker_disable_interrupt()
{ {
RTCC_IntDisable(RTCC_IF_CC0); RTCC_IntDisable(RTCC_IF_CC0);
lp_ticker_free();
INT_Disable();
if(rtc_reserved) {
rtc_free_real(RTC_INIT_LPTIMER);
rtc_reserved = 0;
}
INT_Enable();
} }
inline void lp_ticker_clear_interrupt() inline void lp_ticker_clear_interrupt()
@ -196,12 +184,8 @@ inline void lp_ticker_clear_interrupt()
timestamp_t lp_ticker_read() timestamp_t lp_ticker_read()
{ {
if(!rtc_reserved) { lp_ticker_init();
INT_Disable();
rtc_init_real(RTC_INIT_LPTIMER);
rtc_reserved = 1;
INT_Enable();
}
uint64_t ticks_temp; uint64_t ticks_temp;
uint64_t ticks = RTCC_CounterGet(); uint64_t ticks = RTCC_CounterGet();