mirror of
https://github.com/ArduPilot/ardupilot.git
synced 2026-10-06 19:00:27 +08:00
Sub: AC_PosControl: Fix units on set_correction_speed_accel_U
This commit is contained in:
committed by
Randy Mackay
parent
f9735e68eb
commit
071ddb88ff
@@ -105,7 +105,7 @@ void ModeGuided::guided_vel_control_start()
|
||||
|
||||
// initialize vertical maximum speeds and acceleration
|
||||
position_control->set_max_speed_accel_U_cm(-sub.get_pilot_speed_dn(), g.pilot_speed_up, g.pilot_accel_z);
|
||||
position_control->set_correction_speed_accel_U_cmss(-sub.get_pilot_speed_dn(), g.pilot_speed_up, g.pilot_accel_z);
|
||||
position_control->set_correction_speed_accel_U_cm(-sub.get_pilot_speed_dn(), g.pilot_speed_up, g.pilot_accel_z);
|
||||
|
||||
// initialise velocity controller
|
||||
position_control->init_U_controller();
|
||||
@@ -124,7 +124,7 @@ void ModeGuided::guided_posvel_control_start()
|
||||
|
||||
// set vertical speed and acceleration
|
||||
position_control->set_max_speed_accel_U_cm(sub.wp_nav.get_default_speed_down_cms(), sub.wp_nav.get_default_speed_up_cms(), sub.wp_nav.get_accel_U_cmss());
|
||||
position_control->set_correction_speed_accel_U_cmss(sub.wp_nav.get_default_speed_down_cms(), sub.wp_nav.get_default_speed_up_cms(), sub.wp_nav.get_accel_U_cmss());
|
||||
position_control->set_correction_speed_accel_U_cm(sub.wp_nav.get_default_speed_down_cms(), sub.wp_nav.get_default_speed_up_cms(), sub.wp_nav.get_accel_U_cmss());
|
||||
|
||||
// initialise velocity controller
|
||||
position_control->init_U_controller();
|
||||
@@ -143,7 +143,7 @@ void ModeGuided::guided_angle_control_start()
|
||||
|
||||
// set vertical speed and acceleration
|
||||
position_control->set_max_speed_accel_U_cm(sub.wp_nav.get_default_speed_down_cms(), sub.wp_nav.get_default_speed_up_cms(), sub.wp_nav.get_accel_U_cmss());
|
||||
position_control->set_correction_speed_accel_U_cmss(sub.wp_nav.get_default_speed_down_cms(), sub.wp_nav.get_default_speed_up_cms(), sub.wp_nav.get_accel_U_cmss());
|
||||
position_control->set_correction_speed_accel_U_cm(sub.wp_nav.get_default_speed_down_cms(), sub.wp_nav.get_default_speed_up_cms(), sub.wp_nav.get_accel_U_cmss());
|
||||
|
||||
// initialise velocity controller
|
||||
position_control->init_U_controller();
|
||||
|
||||
Reference in New Issue
Block a user