123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211 |
- #include <stdbool.h>
- #include "stdlib.h"
- #include "stdio.h"
- #include "optiga/pal/pal_os_event.h"
- #include "nrf_rtc.h"
- #include "nrf_drv_rtc.h"
- #include "nrf_delay.h"
- #include "nrf_pwr_mgmt.h"
- static volatile register_callback callback_registered = NULL;
- static void * callback_ctx;
- static volatile bool timer_elapsed = false;
- static bool m_rtc2_is_initialized = false;
- static const nrf_drv_rtc_t rtc2 = NRF_DRV_RTC_INSTANCE(2);
- static nrf_drv_rtc_config_t m_rtc2_config = NRF_DRV_RTC_DEFAULT_CONFIG;
- #define RTC_CLOCK_FREQUENCY 32768
- #define RTC_PRESCALER 8
- #define RTC_TICK_FREQ (RTC_CLOCK_FREQUENCY/RTC_PRESCALER)
- static void ifx_rtc_handler(nrf_drv_rtc_int_type_t int_type)
- {
- volatile register_callback callback;
- (void)nrf_drv_rtc_cc_disable(&rtc2, int_type);
- switch(int_type)
- {
- case NRF_DRV_RTC_INT_COMPARE0:
-
- if (callback_registered != NULL)
- {
- callback = callback_registered;
- callback_registered = NULL;
- callback(callback_ctx);
- }
- break;
- case NRF_DRV_RTC_INT_COMPARE1:
-
- timer_elapsed = true;
- break;
- default:
-
- break;
- }
- }
- void pal_os_event_init()
- {
- if (m_rtc2_is_initialized == true)
- {
- return;
- }
-
- m_rtc2_config.prescaler = RTC_PRESCALER;
-
- APP_ERROR_CHECK(nrf_drv_rtc_init(&rtc2, &m_rtc2_config, ifx_rtc_handler));
-
- nrf_drv_rtc_enable(&rtc2);
- m_rtc2_is_initialized = true;
- }
- void pal_os_event_register_callback_oneshot(register_callback callback,
- void* callback_args,
- uint32_t time_us)
- {
- callback_registered = callback;
- callback_ctx = callback_args;
-
- uint32_t future_ticks = (time_us/(1000*1000/RTC_TICK_FREQ));
-
-
- if(future_ticks < 2) {
- nrf_delay_us(time_us);
- ifx_rtc_handler(NRF_DRV_RTC_INT_COMPARE0);
- return;
- }
-
- future_ticks += nrf_drv_rtc_counter_get(&rtc2);
-
- APP_ERROR_CHECK(nrf_drv_rtc_cc_set(&rtc2, NRF_DRV_RTC_INT_COMPARE0, future_ticks, true));
- }
- uint32_t pal_os_timer_get_time_in_milliseconds(void)
- {
- return nrf_drv_rtc_counter_get(&rtc2)*1000/RTC_TICK_FREQ;
- }
- void pal_os_timer_delay_in_milliseconds(uint16_t milliseconds)
- {
- timer_elapsed = false;
- uint32_t future_ticks = milliseconds*(RTC_TICK_FREQ/1000);
-
-
- if(future_ticks < 2) {
- nrf_delay_ms(milliseconds);
- return;
- }
-
- future_ticks += nrf_drv_rtc_counter_get(&rtc2);
-
- APP_ERROR_CHECK(nrf_drv_rtc_cc_set(&rtc2, NRF_DRV_RTC_INT_COMPARE1, future_ticks, true));
- while(!timer_elapsed)
- {
- nrf_pwr_mgmt_run();
- }
- timer_elapsed = false;
- }
|