FlightTasks: added handling for switching to the already active task and success feedback

removed and added comments

src/lib/FlightTasks/tasks/FlightTask.hpp

@@ -111,8 +111,8 @@ protected:
 
 	/* Prepared general inputs for every task */
 	matrix::Vector<float, 4> _sticks;
-	matrix::Vector3f _position;
-	matrix::Vector3f _velocity;
+	matrix::Vector3f _position; /*< current vehicle position */
+	matrix::Vector3f _velocity; /*< current vehicle velocity */
 	float _yaw;
 
 	/**

src/lib/FlightTasks/tasks/FlightTaskManual.hpp

@@ -114,8 +114,6 @@ public:
 		velocity_setpoint = velocity_setpoint.emult(vel_scale);
 
 		_set_velocity_setpoint(velocity_setpoint);
-		//printf("------");
-		//velocity_setpoint.print();
 
 		/* handle position and altitude hold */
 		const bool stick_xy_zero = stick_xy_norm <= FLT_EPSILON;
@@ -142,7 +140,6 @@ public:
 		}
 
 		_set_position_setpoint(_hold_position);
-		//_hold_position.print();
 		return 0;
 	};
 
@@ -164,5 +161,5 @@ private:
 
 	uORB::Subscription<control_state_s> _sub_control_state;
 
-	matrix::Vector3f _hold_position;
+	matrix::Vector3f _hold_position; /**< position at which the vehicle stays while the input is zero velocity */
 };