123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233 |
- #include "FreeRTOS.h"
- #include "task.h"
- #if configTICK_SOURCE == FREERTOS_USE_SYSTICK
- #error NRF51 does not support SysTick module
- #elif configTICK_SOURCE == FREERTOS_USE_RTC
- #if configUSE_16_BIT_TICKS == 1
- #error This port does not support 16 bit ticks.
- #endif
- #include "nrf_rtc.h"
- #include "nrf_drv_clock.h"
- void xPortSysTickHandler( void )
- {
- #if configUSE_TICKLESS_IDLE == 1
- nrf_rtc_event_clear(portNRF_RTC_REG, NRF_RTC_EVENT_COMPARE_0);
- #endif
- BaseType_t switch_req = pdFALSE;
- uint32_t isrstate = portSET_INTERRUPT_MASK_FROM_ISR();
- uint32_t systick_counter = nrf_rtc_counter_get(portNRF_RTC_REG);
- nrf_rtc_event_clear(portNRF_RTC_REG, NRF_RTC_EVENT_TICK);
- if (configUSE_DISABLE_TICK_AUTO_CORRECTION_DEBUG == 0)
- {
-
- TickType_t diff;
- diff = (systick_counter - xTaskGetTickCount()) & portNRF_RTC_MAXTICKS;
-
- if ((diff > 1) && (xTaskGetSchedulerState() != taskSCHEDULER_RUNNING))
- {
- diff = 1;
- }
- while ((diff--) > 0)
- {
- switch_req |= xTaskIncrementTick();
- }
- }
- else
- {
- switch_req = xTaskIncrementTick();
- }
-
- if ( switch_req != pdFALSE )
- {
-
- SCB->ICSR = SCB_ICSR_PENDSVSET_Msk;
- __SEV();
- }
- portCLEAR_INTERRUPT_MASK_FROM_ISR( isrstate );
- }
- void vPortSetupTimerInterrupt( void )
- {
-
- nrf_drv_clock_lfclk_request(NULL);
-
- nrf_rtc_prescaler_set(portNRF_RTC_REG, portNRF_RTC_PRESCALER);
- nrf_rtc_int_enable (portNRF_RTC_REG, RTC_INTENSET_TICK_Msk);
- nrf_rtc_task_trigger (portNRF_RTC_REG, NRF_RTC_TASK_CLEAR);
- nrf_rtc_task_trigger (portNRF_RTC_REG, NRF_RTC_TASK_START);
- nrf_rtc_event_enable(portNRF_RTC_REG, RTC_EVTEN_OVRFLW_Msk);
- NVIC_SetPriority(portNRF_RTC_IRQn, configKERNEL_INTERRUPT_PRIORITY);
- NVIC_EnableIRQ(portNRF_RTC_IRQn);
- }
- #if configUSE_TICKLESS_IDLE == 1
- void vPortSuppressTicksAndSleep( TickType_t xExpectedIdleTime )
- {
-
- TickType_t enterTime;
-
- if ( xExpectedIdleTime > portNRF_RTC_MAXTICKS - configEXPECTED_IDLE_TIME_BEFORE_SLEEP )
- {
- xExpectedIdleTime = portNRF_RTC_MAXTICKS - configEXPECTED_IDLE_TIME_BEFORE_SLEEP;
- }
-
- #ifdef SOFTDEVICE_PRESENT
- do{
- uint8_t dummy = 0;
- uint32_t err_code = sd_nvic_critical_region_enter(&dummy);
- APP_ERROR_CHECK(err_code);
- }while (0);
- #else
- __disable_irq();
- #endif
-
- enterTime = nrf_rtc_counter_get(portNRF_RTC_REG);
- if ( eTaskConfirmSleepModeStatus() != eAbortSleep )
- {
- TickType_t xModifiableIdleTime;
- TickType_t wakeupTime = (enterTime + xExpectedIdleTime) & portNRF_RTC_MAXTICKS;
-
- nrf_rtc_int_disable(portNRF_RTC_REG, NRF_RTC_INT_TICK_MASK);
-
- nrf_rtc_cc_set(portNRF_RTC_REG, 0, wakeupTime);
- nrf_rtc_event_clear(portNRF_RTC_REG, NRF_RTC_EVENT_COMPARE_0);
- nrf_rtc_int_enable(portNRF_RTC_REG, NRF_RTC_INT_COMPARE0_MASK);
- __DSB();
-
- xModifiableIdleTime = xExpectedIdleTime;
- configPRE_SLEEP_PROCESSING( xModifiableIdleTime );
- if ( xModifiableIdleTime > 0 )
- {
- #ifdef SOFTDEVICE_PRESENT
- uint32_t err_code = sd_app_evt_wait();
- APP_ERROR_CHECK(err_code);
- #else
-
- do{
- __WFE();
- } while (0 == (NVIC->ISPR[0]));
- #endif
- }
- configPOST_SLEEP_PROCESSING( xExpectedIdleTime );
- nrf_rtc_int_disable(portNRF_RTC_REG, NRF_RTC_INT_COMPARE0_MASK);
- nrf_rtc_event_clear(portNRF_RTC_REG, NRF_RTC_EVENT_COMPARE_0);
-
- {
- TickType_t diff;
- TickType_t exitTime;
- nrf_rtc_event_clear(portNRF_RTC_REG, NRF_RTC_EVENT_TICK);
- nrf_rtc_int_enable (portNRF_RTC_REG, NRF_RTC_INT_TICK_MASK);
- exitTime = nrf_rtc_counter_get(portNRF_RTC_REG);
- diff = (exitTime - enterTime) & portNRF_RTC_MAXTICKS;
-
- NVIC_ClearPendingIRQ(portNRF_RTC_IRQn);
- if ((configUSE_TICKLESS_IDLE_SIMPLE_DEBUG) && (diff > xExpectedIdleTime))
- {
- diff = xExpectedIdleTime;
- }
- if (diff > 0)
- {
- vTaskStepTick(diff);
- }
- }
- }
- #ifdef SOFTDEVICE_PRESENT
- uint32_t err_code = sd_nvic_critical_region_exit(0);
- APP_ERROR_CHECK(err_code);
- #else
- __enable_irq();
- #endif
- }
- #endif
- #else
- #error Unsupported configTICK_SOURCE value
- #endif
|