drivers/timer/nrf_rtc_timer: Revert recent changes
Per #13610, recent changes to this driver seem to have introduced unexpected latency regressions. This patch effectively reverts these patches which changed the meat of the driver:ac36886e62
drivers: nrf: timer: add inline qualifier where inlining is intended084363a0dc
drivers: timer: nrf: refactor for speed and correctness71882ff8c4
drivers: timer: nrf: drop unnecessary counter mask4b24e88fa4
drivers: timer: nrf: use irq_lock instead of spinlock While backporting these seemingly unrelated hygiene patches:7cbdb6c5c0
drivers/timer: Restore non-tickless tick count behaviord30c9aeafd
drivers: nrf_power_clock: Migrate to DTS.75f77db432
include: misc: util.h: Rename min/max to MIN/MAX Signed-off-by: Andy Ross <andrew.j.ross@intel.com>
This commit is contained in:
parent
aa4531b2d0
commit
222fd8f1ab
|
@ -1,7 +1,6 @@
|
||||||
/*
|
/*
|
||||||
* Copyright (c) 2016-2017 Nordic Semiconductor ASA
|
* Copyright (c) 2016-2017 Nordic Semiconductor ASA
|
||||||
* Copyright (c) 2018 Intel Corporation
|
* Copyright (c) 2018 Intel Corporation
|
||||||
* Copyright (c) 2019 Peter Bigot Consulting, LLC
|
|
||||||
*
|
*
|
||||||
* SPDX-License-Identifier: Apache-2.0
|
* SPDX-License-Identifier: Apache-2.0
|
||||||
*/
|
*/
|
||||||
|
@ -16,40 +15,28 @@
|
||||||
|
|
||||||
#define RTC NRF_RTC1
|
#define RTC NRF_RTC1
|
||||||
|
|
||||||
/*
|
#define COUNTER_MAX 0x00ffffff
|
||||||
* Compare values must be set to at least 2 greater than the current
|
|
||||||
* counter value to ensure that the compare fires. Compare values are
|
|
||||||
* generally determined by reading the counter, then performing some
|
|
||||||
* calculations to convert a relative delay to an absolute delay.
|
|
||||||
* Assume that the counter will not increment more than twice during
|
|
||||||
* these calculations, allowing for a final check that can replace a
|
|
||||||
* too-low compare with a value that will guarantee fire.
|
|
||||||
*/
|
|
||||||
#define MIN_DELAY 4
|
|
||||||
|
|
||||||
#define CYC_PER_TICK (CONFIG_SYS_CLOCK_HW_CYCLES_PER_SEC \
|
#define CYC_PER_TICK (CONFIG_SYS_CLOCK_HW_CYCLES_PER_SEC \
|
||||||
/ CONFIG_SYS_CLOCK_TICKS_PER_SEC)
|
/ CONFIG_SYS_CLOCK_TICKS_PER_SEC)
|
||||||
#if CYC_PER_TICK < MIN_DELAY
|
#define MAX_TICKS ((COUNTER_MAX - CYC_PER_TICK) / CYC_PER_TICK)
|
||||||
#error Cycles per tick is too small
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#define COUNTER_MAX 0x00ffffffU
|
#define MIN_DELAY 32
|
||||||
#define MAX_TICKS ((COUNTER_MAX - MIN_DELAY) / CYC_PER_TICK)
|
|
||||||
#define MAX_DELAY (MAX_TICKS * CYC_PER_TICK)
|
static struct k_spinlock lock;
|
||||||
|
|
||||||
static u32_t last_count;
|
static u32_t last_count;
|
||||||
|
|
||||||
static inline u32_t counter_sub(u32_t a, u32_t b)
|
static u32_t counter_sub(u32_t a, u32_t b)
|
||||||
{
|
{
|
||||||
return (a - b) & COUNTER_MAX;
|
return (a - b) & COUNTER_MAX;
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline void set_comparator(u32_t cyc)
|
static void set_comparator(u32_t cyc)
|
||||||
{
|
{
|
||||||
nrf_rtc_cc_set(RTC, 0, cyc);
|
nrf_rtc_cc_set(RTC, 0, cyc & COUNTER_MAX);
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline u32_t counter(void)
|
static u32_t counter(void)
|
||||||
{
|
{
|
||||||
return nrf_rtc_counter_get(RTC);
|
return nrf_rtc_counter_get(RTC);
|
||||||
}
|
}
|
||||||
|
@ -67,7 +54,7 @@ void rtc1_nrf_isr(void *arg)
|
||||||
ARG_UNUSED(arg);
|
ARG_UNUSED(arg);
|
||||||
RTC->EVENTS_COMPARE[0] = 0;
|
RTC->EVENTS_COMPARE[0] = 0;
|
||||||
|
|
||||||
u32_t key = irq_lock();
|
k_spinlock_key_t key = k_spin_lock(&lock);
|
||||||
u32_t t = counter();
|
u32_t t = counter();
|
||||||
u32_t dticks = counter_sub(t, last_count) / CYC_PER_TICK;
|
u32_t dticks = counter_sub(t, last_count) / CYC_PER_TICK;
|
||||||
|
|
||||||
|
@ -82,7 +69,7 @@ void rtc1_nrf_isr(void *arg)
|
||||||
set_comparator(next);
|
set_comparator(next);
|
||||||
}
|
}
|
||||||
|
|
||||||
irq_unlock(key);
|
k_spin_unlock(&lock, key);
|
||||||
z_clock_announce(IS_ENABLED(CONFIG_TICKLESS_KERNEL) ? dticks : 1);
|
z_clock_announce(IS_ENABLED(CONFIG_TICKLESS_KERNEL) ? dticks : 1);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -130,53 +117,21 @@ void z_clock_set_timeout(s32_t ticks, bool idle)
|
||||||
ticks = (ticks == K_FOREVER) ? MAX_TICKS : ticks;
|
ticks = (ticks == K_FOREVER) ? MAX_TICKS : ticks;
|
||||||
ticks = MAX(MIN(ticks - 1, (s32_t)MAX_TICKS), 0);
|
ticks = MAX(MIN(ticks - 1, (s32_t)MAX_TICKS), 0);
|
||||||
|
|
||||||
/*
|
k_spinlock_key_t key = k_spin_lock(&lock);
|
||||||
* Get the requested delay in tick-aligned cycles. Increase
|
u32_t cyc, t = counter();
|
||||||
* by one tick to round up so we don't timeout early due to
|
|
||||||
* cycles elapsed since the last tick. Cap at the maximum
|
|
||||||
* tick-aligned delta.
|
|
||||||
*/
|
|
||||||
u32_t cyc = MIN((1 + ticks) * CYC_PER_TICK, MAX_DELAY);
|
|
||||||
|
|
||||||
u32_t key = irq_lock();
|
/* Round up to next tick boundary */
|
||||||
u32_t d = counter_sub(counter(), last_count);
|
cyc = ticks * CYC_PER_TICK + counter_sub(t, last_count);
|
||||||
|
cyc += (CYC_PER_TICK - 1);
|
||||||
|
cyc = (cyc / CYC_PER_TICK) * CYC_PER_TICK;
|
||||||
|
cyc += last_count;
|
||||||
|
|
||||||
/*
|
if (counter_sub(cyc, t) < MIN_DELAY) {
|
||||||
* We've already accounted for anything less than a full tick,
|
cyc += CYC_PER_TICK;
|
||||||
* and assumed we meet the minimum delay for the tick. If
|
|
||||||
* that's not true, we have to adjust, which may involve a
|
|
||||||
* rare and expensive integer division.
|
|
||||||
*/
|
|
||||||
if (d > (CYC_PER_TICK - MIN_DELAY)) {
|
|
||||||
if (d >= CYC_PER_TICK) {
|
|
||||||
/*
|
|
||||||
* We're late by at least one tick. Adjust
|
|
||||||
* the compare offset for the missed ones, and
|
|
||||||
* reduce d to be the portion since the last
|
|
||||||
* (unseen) tick.
|
|
||||||
*/
|
|
||||||
u32_t missed_ticks = d / CYC_PER_TICK;
|
|
||||||
u32_t missed_cycles = missed_ticks * CYC_PER_TICK;
|
|
||||||
cyc += missed_cycles;
|
|
||||||
d -= missed_cycles;
|
|
||||||
}
|
|
||||||
if (d > (CYC_PER_TICK - MIN_DELAY)) {
|
|
||||||
/*
|
|
||||||
* We're (now) within the tick, but too close
|
|
||||||
* to meet the minimum delay required to
|
|
||||||
* guarantee compare firing. Step up to the
|
|
||||||
* next tick.
|
|
||||||
*/
|
|
||||||
cyc += CYC_PER_TICK;
|
|
||||||
}
|
|
||||||
if (cyc > MAX_DELAY) {
|
|
||||||
/* Don't adjust beyond the counter range. */
|
|
||||||
cyc = MAX_DELAY;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
set_comparator(last_count + cyc);
|
|
||||||
|
|
||||||
irq_unlock(key);
|
set_comparator(cyc);
|
||||||
|
k_spin_unlock(&lock, key);
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -186,18 +141,18 @@ u32_t z_clock_elapsed(void)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
u32_t key = irq_lock();
|
k_spinlock_key_t key = k_spin_lock(&lock);
|
||||||
u32_t ret = counter_sub(counter(), last_count) / CYC_PER_TICK;
|
u32_t ret = counter_sub(counter(), last_count) / CYC_PER_TICK;
|
||||||
|
|
||||||
irq_unlock(key);
|
k_spin_unlock(&lock, key);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
u32_t z_timer_cycle_get_32(void)
|
u32_t z_timer_cycle_get_32(void)
|
||||||
{
|
{
|
||||||
u32_t key = irq_lock();
|
k_spinlock_key_t key = k_spin_lock(&lock);
|
||||||
u32_t ret = counter_sub(counter(), last_count) + last_count;
|
u32_t ret = counter_sub(counter(), last_count) + last_count;
|
||||||
|
|
||||||
irq_unlock(key);
|
k_spin_unlock(&lock, key);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in a new issue