FlightTaskOrbit: alert user about exceeded radius (events)

This commit is contained in:
Matthias Grob 2022-03-28 12:07:29 +02:00
parent 8ad44ee128
commit 3e8d2fea94
1 changed files with 2 additions and 0 deletions

View File

@ -38,6 +38,7 @@
#include "FlightTaskOrbit.hpp"
#include <mathlib/mathlib.h>
#include <px4_platform_common/events.h>
#include <lib/geo/geo.h>
using namespace matrix;
@ -77,6 +78,7 @@ bool FlightTaskOrbit::applyCommandParameters(const vehicle_command_s &command)
_orbit_velocity = new_velocity;
} else {
events::send(events::ID("orbit_radius_exceeded"), events::Log::Alert, "Orbit radius limit exceeded");
ret = false;
}