fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

drv_hrt: fix TSAN issues

Browse Source
This commit is contained in:
Julian Oes 2026-02-18 12:44:41 +13:00
parent 9074c81838
commit 261cc16077
No known key found for this signature in database
GPG Key ID: F0ED380FEA56DE41
2 changed files with 12 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
platforms/posix/src/px4/common/drv_hrt.cpp
View File

@ -134,7 +134,10 @@ void hrt_store_absolute_time(volatile hrt_abstime *t)
*/
bool hrt_called(struct hrt_call *entry)
{
return (entry->deadline == 0);
hrt_lock();
bool result = (entry->deadline == 0);
hrt_unlock();
return result;
}
/*
@ -416,12 +419,15 @@ hrt_call_invoke()
call->deadline = 0;
/* invoke the callout (if there is one) */
if (call->callout) {
hrt_callout callout = call->callout;
void *arg = call->arg;
if (callout) {
// Unlock so we don't deadlock in callback
hrt_unlock();
//PX4_INFO("call %p: %p(%p)", call, call->callout, call->arg);
call->callout(call->arg);
//PX4_INFO("call %p: %p(%p)", call, callout, arg);
callout(arg);
hrt_lock();
}

4
src/drivers/drv_hrt.h
View File

@ -272,14 +272,14 @@ static inline uint16_t get_latency_bucket_count(void) { return LATENCY_BUCKET_CO
static inline latency_info_t get_latency(uint16_t bucket_idx, uint16_t counter_idx)
{
latency_info_t ret = {latency_buckets[bucket_idx], latency_counters[counter_idx]};
latency_info_t ret = {latency_buckets[bucket_idx], __atomic_load_n(&latency_counters[counter_idx], __ATOMIC_RELAXED)};
return ret;
}
static inline void reset_latency_counters(void)
{
for (int i = 0; i <= get_latency_bucket_count(); i++) {
latency_counters[i] = 0;
__atomic_store_n(&latency_counters[i], 0, __ATOMIC_RELAXED);
}
}