Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-22 00:28:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

SITL: speed up vicon messages to avoid EKF timeouts during resets

Browse Source
This commit is contained in:
Randy Mackay 2020-05-26 20:52:51 +09:00
parent 630bc01101
commit 31763424a3
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/SITL/SIM_Vicon.cpp
View File

@ -149,8 +149,8 @@ void Vicon::update_vicon_position_estimate(const Location &loc,
// add yaw error reported to vehicle
yaw = wrap_PI(yaw + radians(_sitl->vicon_yaw_error.get()));
// 25ms to 324ms delay before sending
uint32_t delay_ms = 25 + unsigned(random()) % 300;
// 25ms to 124ms delay before sending
uint32_t delay_ms = 25 + unsigned(random()) % 100;
uint64_t time_send_us = now_us + delay_ms * 1000UL;
// send vision position estimate message