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

add check for DFMMode after setting it

Browse Source
This commit is contained in:
Jacob Dahl 2025-07-09 23:23:03 -08:00 committed by Alex Klimaj
parent abf53826b5
commit 79f6b84190
1 changed files with 13 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
src/drivers/distance_sensor/broadcom/afbrs50/AFBRS50.cpp
View File

@ -370,6 +370,19 @@ status_t AFBRS50::setRateAndDfm(uint32_t rate_hz, argus_dfm_mode_t dfm_mode)
return status;
}
argus_dfm_mode_t result_mode;
status = Argus_GetConfigurationDFMMode(_hnd, &result_mode);
if (status != STATUS_OK) {
PX4_ERR("Argus_GetConfigurationDFMMode status not okay: %i", (int)status);
return status;
}
if (result_mode != dfm_mode) {
PX4_ERR("Argus_SetConfigurationDFMMode failed: %i", (int)status);
return status;
}
status = Argus_SetConfigurationFrameTime(_hnd, (1000000 / rate_hz));
if (status != STATUS_OK) {