FlightTask: make applyCommandParameters getting called recursively & pass command by reference

src/lib/FlightTasks/tasks/FlightTask.hpp

@@ -76,7 +76,7 @@ public:
 	 * To be called to adopt parameters from an arrived vehicle command
 	 * @return true if accepted, false if declined
 	 */
-	virtual bool applyCommandParameters(vehicle_command_s command) = 0;
+	virtual bool applyCommandParameters(const vehicle_command_s &command) { return true; };
 
 	/**
 	 * Call before activate() or update()

src/lib/FlightTasks/tasks/FlightTaskManual.hpp

@@ -56,7 +56,7 @@ public:
 
 	bool initializeSubscriptions(SubscriptionArray &subscription_array) override;
 
-	bool applyCommandParameters(vehicle_command_s command) override { return false; };
+	bool applyCommandParameters(const vehicle_command_s &command) override { return FlightTask::applyCommandParameters(command); };
 
 	bool updateInitialize() override;
 

src/lib/FlightTasks/tasks/FlightTaskOrbit.cpp

@@ -51,16 +51,16 @@ FlightTaskOrbit::FlightTaskOrbit(control::SuperBlock *parent, const char *name)
 	_sticks_data_required = false;
 }
 
-bool FlightTaskOrbit::applyCommandParameters(vehicle_command_s command)
+bool FlightTaskOrbit::applyCommandParameters(const vehicle_command_s &command)
 {
-	float &r = command.param3; /**< commanded radius */
-	float &v = command.param4; /**< commanded velocity */
+	const float &r = command.param3; /**< commanded radius */
+	const float &v = command.param4; /**< commanded velocity */
 
 	if (math::isInRange(r, 5.f, 50.f) &&
 	    fabs(v) < 10.f) {
 		_r = r;
 		_v = v;
-		return true;
+		return FlightTaskManual::applyCommandParameters(command);
 	}
 
 	return false;

src/lib/FlightTasks/tasks/FlightTaskOrbit.hpp

@@ -50,7 +50,7 @@ public:
 
 	virtual ~FlightTaskOrbit() = default;
 
-	bool applyCommandParameters(vehicle_command_s command) override;
+	bool applyCommandParameters(const vehicle_command_s &command) override;
 
 	bool activate() override;