Sub: AC_PosControl: Fix units on set_correction_speed_accel_U

This commit is contained in:
Leonard Hall
2025-08-05 11:04:37 +09:00
committed by Randy Mackay
parent f9735e68eb
commit 071ddb88ff
6 changed files with 8 additions and 8 deletions
+3 -3
View File
@@ -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();