mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-22 08:38:36 -04:00
Copter: remove setting of pos-con jerk
This commit is contained in:
parent
7511781a7e
commit
853d7ab573
@ -15,7 +15,6 @@ bool Copter::ModeCircle::init(bool ignore_checks)
|
||||
// initialize speeds and accelerations
|
||||
pos_control->set_speed_xy(wp_nav->get_speed_xy());
|
||||
pos_control->set_accel_xy(wp_nav->get_wp_acceleration());
|
||||
pos_control->set_jerk_xy_to_default();
|
||||
pos_control->set_speed_z(-get_pilot_speed_dn(), g.pilot_speed_up);
|
||||
pos_control->set_accel_z(g.pilot_accel_z);
|
||||
|
||||
|
@ -104,10 +104,9 @@ void Copter::ModeGuided::vel_control_start()
|
||||
// set guided_mode to velocity controller
|
||||
guided_mode = Guided_Velocity;
|
||||
|
||||
// initialise horizontal speed, acceleration and jerk
|
||||
// initialise horizontal speed, acceleration
|
||||
pos_control->set_speed_xy(wp_nav->get_speed_xy());
|
||||
pos_control->set_accel_xy(wp_nav->get_wp_acceleration());
|
||||
pos_control->set_jerk_xy_to_default();
|
||||
|
||||
// initialize vertical speeds and acceleration
|
||||
pos_control->set_speed_z(-get_pilot_speed_dn(), g.pilot_speed_up);
|
||||
@ -128,7 +127,6 @@ void Copter::ModeGuided::posvel_control_start()
|
||||
// set speed and acceleration from wpnav's speed and acceleration
|
||||
pos_control->set_speed_xy(wp_nav->get_speed_xy());
|
||||
pos_control->set_accel_xy(wp_nav->get_wp_acceleration());
|
||||
pos_control->set_jerk_xy_to_default();
|
||||
|
||||
const Vector3f& curr_pos = inertial_nav.get_position();
|
||||
const Vector3f& curr_vel = inertial_nav.get_velocity();
|
||||
|
Loading…
Reference in New Issue
Block a user