Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-28 10:46:33 +08:00
Code Issues Actions 27 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
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/distance_sensor/broadcom/afbrs50/AFBRS50.cpp
+13
View File
@@ -370,6 +370,19 @@ status_t AFBRS50::setRateAndDfm(uint32_t rate_hz, argus_dfm_mode_t dfm_mode)
return status; 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)); status = Argus_SetConfigurationFrameTime(_hnd, (1000000 / rate_hz));
if (status != STATUS_OK) { if (status != STATUS_OK) {