Browse Source

FlightTaskManual: remove unused methods

sbg
Dennis Mannhart 7 years ago committed by Beat Küng
parent
commit
3b0373afda
  1. 30
      src/lib/FlightTasks/tasks/FlightTaskManual.cpp

30
src/lib/FlightTasks/tasks/FlightTaskManual.cpp

@ -67,8 +67,6 @@ bool FlightTaskManual::initializeSubscriptions(SubscriptionArray &subscription_a @@ -67,8 +67,6 @@ bool FlightTaskManual::initializeSubscriptions(SubscriptionArray &subscription_a
bool FlightTaskManual::activate()
{
bool ret = FlightTask::activate();
_hold_position = Vector3f(NAN, NAN, NAN);
_hold_yaw = NAN;
return ret;
}
@ -93,34 +91,6 @@ bool FlightTaskManual::update() @@ -93,34 +91,6 @@ bool FlightTaskManual::update()
return true;
}
float FlightTaskManual::_get_input_frame_yaw()
{
/* using constant yaw angle from setpoint here to prevent sideways oscillation in fast forward flight */
if (PX4_ISFINITE(_hold_yaw)) {
return _hold_yaw;
} else {
return _yaw;
}
}
void FlightTaskManual::_updateYaw()
{
const float yaw_speed = _sticks(3) * math::radians(_man_yaw_max.get());
_setYawspeedSetpoint(yaw_speed);
const bool stick_yaw_zero = fabsf(yaw_speed) <= FLT_EPSILON;
if (stick_yaw_zero && !PX4_ISFINITE(_hold_yaw)) {
_hold_yaw = _yaw;
} else if (!stick_yaw_zero) {
_hold_yaw = NAN;
}
_setYawSetpoint(_hold_yaw);
}
bool FlightTaskManual::_evaluateSticks()
{
/* Sticks are rescaled linearly and exponentially from [0,1] to [-1,1] */

Loading…
Cancel
Save