|
|
|
@ -82,7 +82,7 @@ bool Copter::poshold_init(bool ignore_checks)
@@ -82,7 +82,7 @@ bool Copter::poshold_init(bool ignore_checks)
|
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// initialize vertical speeds and leash lengths
|
|
|
|
|
// initialize vertical speeds and acceleration
|
|
|
|
|
pos_control.set_speed_z(-g.pilot_velocity_z_max, g.pilot_velocity_z_max); |
|
|
|
|
pos_control.set_accel_z(g.pilot_accel_z); |
|
|
|
|
|
|
|
|
@ -136,7 +136,7 @@ void Copter::poshold_run()
@@ -136,7 +136,7 @@ void Copter::poshold_run()
|
|
|
|
|
float vel_fw, vel_right; // vehicle's current velocity in body-frame forward and right directions
|
|
|
|
|
const Vector3f& vel = inertial_nav.get_velocity(); |
|
|
|
|
|
|
|
|
|
// initialize vertical speeds and leash lengths
|
|
|
|
|
// initialize vertical speeds and acceleration
|
|
|
|
|
pos_control.set_speed_z(-g.pilot_velocity_z_max, g.pilot_velocity_z_max); |
|
|
|
|
pos_control.set_accel_z(g.pilot_accel_z); |
|
|
|
|
|
|
|
|
|