consume all available queued vehicle_commands

This commit is contained in:
Daniel Agar
2021-01-26 12:00:18 -05:00
parent d5c7e243a9
commit d1dfa26903
11 changed files with 167 additions and 175 deletions
+1 -1
View File
@@ -212,7 +212,7 @@ Navigator::run()
_position_controller_status_sub.update();
_home_pos_sub.update(&_home_pos);
if (_vehicle_command_sub.updated()) {
while (_vehicle_command_sub.updated()) {
const unsigned last_generation = _vehicle_command_sub.get_last_generation();
vehicle_command_s cmd{};
_vehicle_command_sub.copy(&cmd);