| /* |
| * Copyright (c) 2016-2021 Nordic Semiconductor ASA |
| * Copyright (c) 2018 Intel Corporation |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| #include <zephyr/init.h> |
| #include <soc.h> |
| #include <zephyr/drivers/clock_control.h> |
| #include <zephyr/drivers/clock_control/nrf_clock_control.h> |
| #include <zephyr/drivers/timer/system_timer.h> |
| #include <zephyr/drivers/timer/nrf_rtc_timer.h> |
| #include <zephyr/sys/util.h> |
| #include <zephyr/sys_clock.h> |
| #include <zephyr/sys/barrier.h> |
| #include <haly/nrfy_rtc.h> |
| #include <zephyr/irq.h> |
| |
| #define RTC_PRETICK (IS_ENABLED(CONFIG_SOC_NRF53_RTC_PRETICK) && \ |
| IS_ENABLED(CONFIG_SOC_NRF5340_CPUNET)) |
| |
| #define EXT_CHAN_COUNT CONFIG_NRF_RTC_TIMER_USER_CHAN_COUNT |
| #define CHAN_COUNT (EXT_CHAN_COUNT + 1) |
| |
| #define RTC NRF_RTC1 |
| #define RTC_IRQn NRFX_IRQ_NUMBER_GET(RTC) |
| #define RTC_LABEL rtc1 |
| #define CHAN_COUNT_MAX (RTC1_CC_NUM - (RTC_PRETICK ? 1 : 0)) |
| |
| BUILD_ASSERT(CHAN_COUNT <= CHAN_COUNT_MAX, "Not enough compare channels"); |
| /* Ensure that counter driver for RTC1 is not enabled. */ |
| BUILD_ASSERT(DT_NODE_HAS_STATUS(DT_NODELABEL(RTC_LABEL), disabled), |
| "Counter for RTC1 must be disabled"); |
| |
| #define COUNTER_BIT_WIDTH 24U |
| #define COUNTER_SPAN BIT(COUNTER_BIT_WIDTH) |
| #define COUNTER_MAX (COUNTER_SPAN - 1U) |
| #define COUNTER_HALF_SPAN (COUNTER_SPAN / 2U) |
| #define CYC_PER_TICK (sys_clock_hw_cycles_per_sec() \ |
| / CONFIG_SYS_CLOCK_TICKS_PER_SEC) |
| #define MAX_TICKS ((COUNTER_HALF_SPAN - CYC_PER_TICK) / CYC_PER_TICK) |
| #define MAX_CYCLES (MAX_TICKS * CYC_PER_TICK) |
| |
| #define OVERFLOW_RISK_RANGE_END (COUNTER_SPAN / 16) |
| #define ANCHOR_RANGE_START (COUNTER_SPAN / 8) |
| #define ANCHOR_RANGE_END (7 * COUNTER_SPAN / 8) |
| #define TARGET_TIME_INVALID (UINT64_MAX) |
| |
| extern void rtc_pretick_rtc1_isr_hook(void); |
| |
| static volatile uint32_t overflow_cnt; |
| static volatile uint64_t anchor; |
| static uint64_t last_count; |
| static bool sys_busy; |
| |
| struct z_nrf_rtc_timer_chan_data { |
| z_nrf_rtc_timer_compare_handler_t callback; |
| void *user_context; |
| volatile uint64_t target_time; |
| }; |
| |
| static struct z_nrf_rtc_timer_chan_data cc_data[CHAN_COUNT]; |
| static atomic_t int_mask; |
| static atomic_t alloc_mask; |
| static atomic_t force_isr_mask; |
| |
| static uint32_t counter_sub(uint32_t a, uint32_t b) |
| { |
| return (a - b) & COUNTER_MAX; |
| } |
| |
| static void set_comparator(int32_t chan, uint32_t cyc) |
| { |
| nrfy_rtc_cc_set(RTC, chan, cyc & COUNTER_MAX); |
| } |
| |
| static bool event_check(int32_t chan) |
| { |
| return nrfy_rtc_event_check(RTC, NRF_RTC_CHANNEL_EVENT_ADDR(chan)); |
| } |
| |
| static void event_clear(int32_t chan) |
| { |
| nrfy_rtc_event_clear(RTC, NRF_RTC_CHANNEL_EVENT_ADDR(chan)); |
| } |
| |
| static void event_enable(int32_t chan) |
| { |
| nrfy_rtc_event_enable(RTC, NRF_RTC_CHANNEL_INT_MASK(chan)); |
| } |
| |
| static void event_disable(int32_t chan) |
| { |
| nrfy_rtc_event_disable(RTC, NRF_RTC_CHANNEL_INT_MASK(chan)); |
| } |
| |
| static uint32_t counter(void) |
| { |
| return nrfy_rtc_counter_get(RTC); |
| } |
| |
| static uint32_t absolute_time_to_cc(uint64_t absolute_time) |
| { |
| /* 24 least significant bits represent target CC value */ |
| return absolute_time & COUNTER_MAX; |
| } |
| |
| static uint32_t full_int_lock(void) |
| { |
| uint32_t mcu_critical_state; |
| |
| if (IS_ENABLED(CONFIG_NRF_RTC_TIMER_LOCK_ZERO_LATENCY_IRQS)) { |
| mcu_critical_state = __get_PRIMASK(); |
| __disable_irq(); |
| } else { |
| mcu_critical_state = irq_lock(); |
| } |
| |
| return mcu_critical_state; |
| } |
| |
| static void full_int_unlock(uint32_t mcu_critical_state) |
| { |
| if (IS_ENABLED(CONFIG_NRF_RTC_TIMER_LOCK_ZERO_LATENCY_IRQS)) { |
| __set_PRIMASK(mcu_critical_state); |
| } else { |
| irq_unlock(mcu_critical_state); |
| } |
| } |
| |
| uint32_t z_nrf_rtc_timer_compare_evt_address_get(int32_t chan) |
| { |
| __ASSERT_NO_MSG(chan >= 0 && chan < CHAN_COUNT); |
| return nrfy_rtc_event_address_get(RTC, nrfy_rtc_compare_event_get(chan)); |
| } |
| |
| uint32_t z_nrf_rtc_timer_capture_task_address_get(int32_t chan) |
| { |
| #if defined(RTC_TASKS_CAPTURE_TASKS_CAPTURE_Msk) |
| __ASSERT_NO_MSG(chan >= 0 && chan < CHAN_COUNT); |
| if (chan == 0) { |
| return 0; |
| } |
| |
| return nrfy_rtc_task_address_get(RTC, nrfy_rtc_capture_task_get(chan)); |
| #else |
| ARG_UNUSED(chan); |
| return 0; |
| #endif |
| } |
| |
| static bool compare_int_lock(int32_t chan) |
| { |
| atomic_val_t prev = atomic_and(&int_mask, ~BIT(chan)); |
| |
| nrfy_rtc_int_disable(RTC, NRF_RTC_CHANNEL_INT_MASK(chan)); |
| |
| barrier_dmem_fence_full(); |
| barrier_isync_fence_full(); |
| |
| return prev & BIT(chan); |
| } |
| |
| |
| bool z_nrf_rtc_timer_compare_int_lock(int32_t chan) |
| { |
| __ASSERT_NO_MSG(chan > 0 && chan < CHAN_COUNT); |
| |
| return compare_int_lock(chan); |
| } |
| |
| static void compare_int_unlock(int32_t chan, bool key) |
| { |
| if (key) { |
| atomic_or(&int_mask, BIT(chan)); |
| nrfy_rtc_int_enable(RTC, NRF_RTC_CHANNEL_INT_MASK(chan)); |
| if (atomic_get(&force_isr_mask) & BIT(chan)) { |
| NVIC_SetPendingIRQ(RTC_IRQn); |
| } |
| } |
| } |
| |
| void z_nrf_rtc_timer_compare_int_unlock(int32_t chan, bool key) |
| { |
| __ASSERT_NO_MSG(chan > 0 && chan < CHAN_COUNT); |
| |
| compare_int_unlock(chan, key); |
| } |
| |
| uint32_t z_nrf_rtc_timer_compare_read(int32_t chan) |
| { |
| __ASSERT_NO_MSG(chan >= 0 && chan < CHAN_COUNT); |
| |
| return nrfy_rtc_cc_get(RTC, chan); |
| } |
| |
| uint64_t z_nrf_rtc_timer_get_ticks(k_timeout_t t) |
| { |
| uint64_t curr_time; |
| int64_t curr_tick; |
| int64_t result; |
| int64_t abs_ticks; |
| |
| do { |
| curr_time = z_nrf_rtc_timer_read(); |
| curr_tick = sys_clock_tick_get(); |
| } while (curr_time != z_nrf_rtc_timer_read()); |
| |
| abs_ticks = Z_TICK_ABS(t.ticks); |
| if (abs_ticks < 0) { |
| /* relative timeout */ |
| return (t.ticks > COUNTER_SPAN) ? |
| -EINVAL : (curr_time + t.ticks); |
| } |
| |
| /* absolute timeout */ |
| result = abs_ticks - curr_tick; |
| |
| if (result > COUNTER_SPAN) { |
| return -EINVAL; |
| } |
| |
| return curr_time + result; |
| } |
| |
| /** @brief Function safely sets an alarm. |
| * |
| * It assumes that provided value is at most COUNTER_HALF_SPAN cycles from now |
| * (other values are considered to be from the past). It detects late setting |
| * and properly adjusts CC values that are too near in the future to guarantee |
| * triggering a COMPARE event soon, not after 512 seconds when the RTC wraps |
| * around first. |
| * |
| * @param[in] chan A channel for which a new CC value is to be set. |
| * |
| * @param[in] req_cc Requested CC register value to be set. |
| * |
| * @param[in] exact Use @c false to allow CC adjustment if @c req_cc value is |
| * close to the current value of the timer. |
| * Use @c true to disallow CC adjustment. The function can |
| * fail with -EINVAL result if @p req_cc is too close to the |
| * current value. |
| * |
| * @retval 0 The requested CC has been set successfully. |
| * @retval -EINVAL The requested CC value could not be reliably set. |
| */ |
| static int set_alarm(int32_t chan, uint32_t req_cc, bool exact) |
| { |
| int ret = 0; |
| |
| /* Ensure that the value exposed in this driver API is consistent with |
| * assumptions of this function. |
| */ |
| BUILD_ASSERT(NRF_RTC_TIMER_MAX_SCHEDULE_SPAN <= COUNTER_HALF_SPAN); |
| |
| /* According to product specifications, when the current counter value |
| * is N, a value of N+2 written to the CC register is guaranteed to |
| * trigger a COMPARE event at N+2, but tests show that this compare |
| * value can be missed when the previous CC value is N+1 and the write |
| * occurs in the second half of the RTC clock cycle (such situation can |
| * be provoked by test_next_cycle_timeouts in the nrf_rtc_timer suite). |
| * This never happens when the written value is N+3. Use 3 cycles as |
| * the nearest possible scheduling then. |
| */ |
| enum { MIN_CYCLES_FROM_NOW = 3 }; |
| uint32_t cc_val = req_cc; |
| uint32_t cc_inc = MIN_CYCLES_FROM_NOW; |
| |
| /* Disable event routing for the channel to avoid getting a COMPARE |
| * event for the previous CC value before the new one takes effect |
| * (however, even if such spurious event was generated, it would be |
| * properly filtered out in process_channel(), where the target time |
| * is checked). |
| * Clear also the event as it may already be generated at this point. |
| */ |
| event_disable(chan); |
| event_clear(chan); |
| |
| for (;;) { |
| uint32_t now; |
| |
| set_comparator(chan, cc_val); |
| /* Enable event routing after the required CC value was set. |
| * Even though the above operation may get repeated (see below), |
| * there is no need to disable event routing in every iteration |
| * of the loop, as the COMPARE event resulting from any attempt |
| * of setting the CC register is acceptable (as mentioned above, |
| * process_channel() does the proper filtering). |
| */ |
| event_enable(chan); |
| |
| now = counter(); |
| |
| /* Check if the CC register was successfully set to a value |
| * that will for sure trigger a COMPARE event as expected. |
| * If not, try again, adjusting the CC value accordingly. |
| * Increase the CC value by a larger number of cycles in each |
| * trial to avoid spending too much time in this loop if it |
| * continuously gets interrupted and delayed by something. |
| */ |
| if (counter_sub(cc_val, now + MIN_CYCLES_FROM_NOW) > |
| (COUNTER_HALF_SPAN - MIN_CYCLES_FROM_NOW)) { |
| /* If the COMPARE event turns out to be already |
| * generated, check if the loop can be finished. |
| */ |
| if (event_check(chan)) { |
| /* If the current counter value has not yet |
| * reached the requested CC value, the event |
| * must come from the previously set CC value |
| * (the alarm is apparently rescheduled). |
| * The event needs to be cleared then and the |
| * loop needs to be continued. |
| */ |
| now = counter(); |
| if (counter_sub(now, req_cc) > COUNTER_HALF_SPAN) { |
| event_clear(chan); |
| if (exact) { |
| ret = -EINVAL; |
| break; |
| } |
| } else { |
| break; |
| } |
| } else if (exact) { |
| ret = -EINVAL; |
| break; |
| } |
| |
| cc_val = now + cc_inc; |
| cc_inc++; |
| } else { |
| break; |
| } |
| } |
| |
| return ret; |
| } |
| |
| static int compare_set_nolocks(int32_t chan, uint64_t target_time, |
| z_nrf_rtc_timer_compare_handler_t handler, |
| void *user_data, bool exact) |
| { |
| int ret = 0; |
| uint32_t cc_value = absolute_time_to_cc(target_time); |
| uint64_t curr_time = z_nrf_rtc_timer_read(); |
| |
| if (curr_time < target_time) { |
| if (target_time - curr_time > COUNTER_HALF_SPAN) { |
| /* Target time is too distant. */ |
| return -EINVAL; |
| } |
| |
| if (target_time != cc_data[chan].target_time) { |
| /* Target time is valid and is different than currently set. |
| * Set CC value. |
| */ |
| ret = set_alarm(chan, cc_value, exact); |
| } |
| } else if (!exact) { |
| /* Force ISR handling when exiting from critical section. */ |
| atomic_or(&force_isr_mask, BIT(chan)); |
| } else { |
| ret = -EINVAL; |
| } |
| |
| if (ret == 0) { |
| cc_data[chan].target_time = target_time; |
| cc_data[chan].callback = handler; |
| cc_data[chan].user_context = user_data; |
| } |
| |
| return ret; |
| } |
| |
| static int compare_set(int32_t chan, uint64_t target_time, |
| z_nrf_rtc_timer_compare_handler_t handler, |
| void *user_data, bool exact) |
| { |
| bool key; |
| |
| key = compare_int_lock(chan); |
| |
| int ret = compare_set_nolocks(chan, target_time, handler, user_data, exact); |
| |
| compare_int_unlock(chan, key); |
| |
| return ret; |
| } |
| |
| int z_nrf_rtc_timer_set(int32_t chan, uint64_t target_time, |
| z_nrf_rtc_timer_compare_handler_t handler, |
| void *user_data) |
| { |
| __ASSERT_NO_MSG(chan > 0 && chan < CHAN_COUNT); |
| |
| return compare_set(chan, target_time, handler, user_data, false); |
| } |
| |
| int z_nrf_rtc_timer_exact_set(int32_t chan, uint64_t target_time, |
| z_nrf_rtc_timer_compare_handler_t handler, |
| void *user_data) |
| { |
| __ASSERT_NO_MSG(chan > 0 && chan < CHAN_COUNT); |
| |
| return compare_set(chan, target_time, handler, user_data, true); |
| } |
| |
| void z_nrf_rtc_timer_abort(int32_t chan) |
| { |
| __ASSERT_NO_MSG(chan > 0 && chan < CHAN_COUNT); |
| |
| bool key = compare_int_lock(chan); |
| |
| cc_data[chan].target_time = TARGET_TIME_INVALID; |
| event_clear(chan); |
| event_disable(chan); |
| (void)atomic_and(&force_isr_mask, ~BIT(chan)); |
| |
| compare_int_unlock(chan, key); |
| } |
| |
| uint64_t z_nrf_rtc_timer_read(void) |
| { |
| uint64_t val = ((uint64_t)overflow_cnt) << COUNTER_BIT_WIDTH; |
| |
| barrier_dmem_fence_full(); |
| |
| uint32_t cntr = counter(); |
| |
| val += cntr; |
| |
| if (cntr < OVERFLOW_RISK_RANGE_END) { |
| /* `overflow_cnt` can have incorrect value due to still unhandled overflow or |
| * due to possibility that this code preempted overflow interrupt before final write |
| * of `overflow_cnt`. Update of `anchor` occurs far in time from this moment, so |
| * `anchor` is considered valid and stable. Because of this timing there is no risk |
| * of incorrect `anchor` value caused by non-atomic read of 64-bit `anchor`. |
| */ |
| if (val < anchor) { |
| /* Unhandled overflow, detected, let's add correction */ |
| val += COUNTER_SPAN; |
| } |
| } else { |
| /* `overflow_cnt` is considered valid and stable in this range, no need to |
| * check validity using `anchor` |
| */ |
| } |
| |
| return val; |
| } |
| |
| static inline bool in_anchor_range(uint32_t cc_value) |
| { |
| return (cc_value >= ANCHOR_RANGE_START) && (cc_value < ANCHOR_RANGE_END); |
| } |
| |
| static inline void anchor_update(uint32_t cc_value) |
| { |
| /* Update anchor when far from overflow */ |
| if (in_anchor_range(cc_value)) { |
| /* In this range `overflow_cnt` is considered valid and stable. |
| * Write of 64-bit `anchor` is non atomic. However it happens |
| * far in time from the moment the `anchor` is read in |
| * `z_nrf_rtc_timer_read`. |
| */ |
| anchor = (((uint64_t)overflow_cnt) << COUNTER_BIT_WIDTH) + cc_value; |
| } |
| } |
| |
| static void sys_clock_timeout_handler(int32_t chan, |
| uint64_t expire_time, |
| void *user_data) |
| { |
| uint32_t cc_value = absolute_time_to_cc(expire_time); |
| uint32_t dticks = (uint32_t)(expire_time - last_count) / CYC_PER_TICK; |
| |
| last_count += dticks * CYC_PER_TICK; |
| |
| anchor_update(cc_value); |
| |
| if (!IS_ENABLED(CONFIG_TICKLESS_KERNEL)) { |
| /* protection is not needed because we are in the RTC interrupt |
| * so it won't get preempted by the interrupt. |
| */ |
| compare_set(chan, last_count + CYC_PER_TICK, |
| sys_clock_timeout_handler, NULL, false); |
| } |
| |
| sys_clock_announce(dticks); |
| } |
| |
| static bool channel_processing_check_and_clear(int32_t chan) |
| { |
| if (nrfy_rtc_int_enable_check(RTC, NRF_RTC_CHANNEL_INT_MASK(chan))) { |
| /* The processing of channel can be caused by CC match |
| * or be forced. |
| */ |
| if ((atomic_and(&force_isr_mask, ~BIT(chan)) & BIT(chan)) || |
| event_check(chan)) { |
| event_clear(chan); |
| return true; |
| } |
| } |
| |
| return false; |
| } |
| |
| static void process_channel(int32_t chan) |
| { |
| if (channel_processing_check_and_clear(chan)) { |
| void *user_context; |
| uint32_t mcu_critical_state; |
| uint64_t curr_time; |
| uint64_t expire_time; |
| z_nrf_rtc_timer_compare_handler_t handler = NULL; |
| |
| curr_time = z_nrf_rtc_timer_read(); |
| |
| /* This critical section is used to provide atomic access to |
| * cc_data structure and prevent higher priority contexts |
| * (including ZLIs) from overwriting it. |
| */ |
| mcu_critical_state = full_int_lock(); |
| |
| /* If target_time is in the past or is equal to current time |
| * value, execute the handler. |
| */ |
| expire_time = cc_data[chan].target_time; |
| if (curr_time >= expire_time) { |
| handler = cc_data[chan].callback; |
| user_context = cc_data[chan].user_context; |
| cc_data[chan].callback = NULL; |
| cc_data[chan].target_time = TARGET_TIME_INVALID; |
| event_disable(chan); |
| /* Because of the way set_alarm() sets the CC register, |
| * it may turn out that another COMPARE event has been |
| * generated for the same alarm. Make sure the event |
| * is cleared, so that the ISR is not executed again |
| * unnecessarily. |
| */ |
| event_clear(chan); |
| } |
| |
| full_int_unlock(mcu_critical_state); |
| |
| if (handler) { |
| handler(chan, expire_time, user_context); |
| } |
| } |
| } |
| |
| /* Note: this function has public linkage, and MUST have this |
| * particular name. The platform architecture itself doesn't care, |
| * but there is a test (tests/arch/arm_irq_vector_table) that needs |
| * to find it to it can set it in a custom vector table. Should |
| * probably better abstract that at some point (e.g. query and reset |
| * it by pointer at runtime, maybe?) so we don't have this leaky |
| * symbol. |
| */ |
| void rtc_nrf_isr(const void *arg) |
| { |
| ARG_UNUSED(arg); |
| |
| if (RTC_PRETICK) { |
| rtc_pretick_rtc1_isr_hook(); |
| } |
| |
| if (nrfy_rtc_int_enable_check(RTC, NRF_RTC_INT_OVERFLOW_MASK) && |
| nrfy_rtc_events_process(RTC, NRF_RTC_INT_OVERFLOW_MASK)) { |
| overflow_cnt++; |
| } |
| |
| for (int32_t chan = 0; chan < CHAN_COUNT; chan++) { |
| process_channel(chan); |
| } |
| } |
| |
| int32_t z_nrf_rtc_timer_chan_alloc(void) |
| { |
| int32_t chan; |
| atomic_val_t prev; |
| do { |
| chan = alloc_mask ? 31 - __builtin_clz(alloc_mask) : -1; |
| if (chan < 0) { |
| return -ENOMEM; |
| } |
| prev = atomic_and(&alloc_mask, ~BIT(chan)); |
| } while (!(prev & BIT(chan))); |
| |
| return chan; |
| } |
| |
| void z_nrf_rtc_timer_chan_free(int32_t chan) |
| { |
| __ASSERT_NO_MSG(chan > 0 && chan < CHAN_COUNT); |
| |
| atomic_or(&alloc_mask, BIT(chan)); |
| } |
| |
| |
| int z_nrf_rtc_timer_trigger_overflow(void) |
| { |
| uint32_t mcu_critical_state; |
| int err = 0; |
| |
| if (!IS_ENABLED(CONFIG_NRF_RTC_TIMER_TRIGGER_OVERFLOW) || |
| (CONFIG_NRF_RTC_TIMER_USER_CHAN_COUNT > 0)) { |
| return -ENOTSUP; |
| } |
| |
| mcu_critical_state = full_int_lock(); |
| if (sys_busy) { |
| err = -EBUSY; |
| goto bail; |
| } |
| |
| if (counter() >= (COUNTER_SPAN - 100)) { |
| err = -EAGAIN; |
| goto bail; |
| } |
| |
| nrfy_rtc_task_trigger(RTC, NRF_RTC_TASK_TRIGGER_OVERFLOW); |
| k_busy_wait(80); |
| |
| uint64_t now = z_nrf_rtc_timer_read(); |
| |
| if (err == 0) { |
| sys_clock_timeout_handler(0, now, NULL); |
| } |
| bail: |
| full_int_unlock(mcu_critical_state); |
| |
| return err; |
| } |
| |
| void sys_clock_set_timeout(int32_t ticks, bool idle) |
| { |
| ARG_UNUSED(idle); |
| uint32_t cyc; |
| |
| if (!IS_ENABLED(CONFIG_TICKLESS_KERNEL)) { |
| return; |
| } |
| |
| if (ticks == K_TICKS_FOREVER) { |
| cyc = MAX_TICKS * CYC_PER_TICK; |
| sys_busy = false; |
| } else { |
| /* Value of ticks can be zero or negative, what means "announce |
| * the next tick" (the same as ticks equal to 1). |
| */ |
| cyc = CLAMP(ticks, 1, (int32_t)MAX_TICKS); |
| cyc *= CYC_PER_TICK; |
| sys_busy = true; |
| } |
| |
| uint32_t unannounced = z_nrf_rtc_timer_read() - last_count; |
| |
| /* If we haven't announced for more than half the 24-bit wrap |
| * duration, then force an announce to avoid loss of a wrap |
| * event. This can happen if new timeouts keep being set |
| * before the existing one triggers the interrupt. |
| */ |
| if (unannounced >= COUNTER_HALF_SPAN) { |
| cyc = 0; |
| } |
| |
| /* Get the cycles from last_count to the tick boundary after |
| * the requested ticks have passed starting now. |
| */ |
| cyc += unannounced; |
| cyc = DIV_ROUND_UP(cyc, CYC_PER_TICK) * CYC_PER_TICK; |
| |
| /* Due to elapsed time the calculation above might produce a |
| * duration that laps the counter. Don't let it. |
| * This limitation also guarantees that the anchor will be properly |
| * updated before every overflow (see anchor_update()). |
| */ |
| if (cyc > MAX_CYCLES) { |
| cyc = MAX_CYCLES; |
| } |
| |
| uint64_t target_time = cyc + last_count; |
| |
| compare_set(0, target_time, sys_clock_timeout_handler, NULL, false); |
| } |
| |
| uint32_t sys_clock_elapsed(void) |
| { |
| if (!IS_ENABLED(CONFIG_TICKLESS_KERNEL)) { |
| return 0; |
| } |
| |
| return (z_nrf_rtc_timer_read() - last_count) / CYC_PER_TICK; |
| } |
| |
| uint32_t sys_clock_cycle_get_32(void) |
| { |
| return (uint32_t)z_nrf_rtc_timer_read(); |
| } |
| |
| static void int_event_disable_rtc(void) |
| { |
| uint32_t mask = NRF_RTC_INT_TICK_MASK | |
| NRF_RTC_INT_OVERFLOW_MASK | |
| NRF_RTC_INT_COMPARE0_MASK | |
| NRF_RTC_INT_COMPARE1_MASK | |
| NRF_RTC_INT_COMPARE2_MASK | |
| NRF_RTC_INT_COMPARE3_MASK; |
| |
| /* Reset interrupt enabling to expected reset values */ |
| nrfy_rtc_int_disable(RTC, mask); |
| |
| /* Reset event routing enabling to expected reset values */ |
| nrfy_rtc_event_disable(RTC, mask); |
| } |
| |
| void sys_clock_disable(void) |
| { |
| nrf_rtc_task_trigger(RTC, NRF_RTC_TASK_STOP); |
| irq_disable(RTC_IRQn); |
| int_event_disable_rtc(); |
| NVIC_ClearPendingIRQ(RTC_IRQn); |
| } |
| |
| static int sys_clock_driver_init(void) |
| { |
| static const enum nrf_lfclk_start_mode mode = |
| IS_ENABLED(CONFIG_SYSTEM_CLOCK_NO_WAIT) ? |
| CLOCK_CONTROL_NRF_LF_START_NOWAIT : |
| (IS_ENABLED(CONFIG_SYSTEM_CLOCK_WAIT_FOR_AVAILABILITY) ? |
| CLOCK_CONTROL_NRF_LF_START_AVAILABLE : |
| CLOCK_CONTROL_NRF_LF_START_STABLE); |
| |
| int_event_disable_rtc(); |
| |
| /* TODO: replace with counter driver to access RTC */ |
| nrfy_rtc_prescaler_set(RTC, 0); |
| for (int32_t chan = 0; chan < CHAN_COUNT; chan++) { |
| cc_data[chan].target_time = TARGET_TIME_INVALID; |
| nrfy_rtc_int_enable(RTC, NRF_RTC_CHANNEL_INT_MASK(chan)); |
| } |
| |
| nrfy_rtc_int_enable(RTC, NRF_RTC_INT_OVERFLOW_MASK); |
| |
| NVIC_ClearPendingIRQ(RTC_IRQn); |
| |
| IRQ_CONNECT(RTC_IRQn, DT_IRQ(DT_NODELABEL(RTC_LABEL), priority), |
| rtc_nrf_isr, 0, 0); |
| irq_enable(RTC_IRQn); |
| |
| nrfy_rtc_task_trigger(RTC, NRF_RTC_TASK_CLEAR); |
| nrfy_rtc_task_trigger(RTC, NRF_RTC_TASK_START); |
| |
| int_mask = BIT_MASK(CHAN_COUNT); |
| if (CONFIG_NRF_RTC_TIMER_USER_CHAN_COUNT) { |
| alloc_mask = BIT_MASK(EXT_CHAN_COUNT) << 1; |
| } |
| |
| uint32_t initial_timeout = IS_ENABLED(CONFIG_TICKLESS_KERNEL) ? |
| MAX_CYCLES : CYC_PER_TICK; |
| |
| compare_set(0, initial_timeout, sys_clock_timeout_handler, NULL, false); |
| |
| z_nrf_clock_control_lf_on(mode); |
| |
| return 0; |
| } |
| |
| SYS_INIT(sys_clock_driver_init, PRE_KERNEL_2, |
| CONFIG_SYSTEM_CLOCK_INIT_PRIORITY); |