Skip to content

Commit

Permalink
AC_WPNav: terrain spelling fix
Browse files Browse the repository at this point in the history
  • Loading branch information
rmackay9 committed Sep 6, 2021
1 parent 97decc4 commit ba50f68
Show file tree
Hide file tree
Showing 2 changed files with 8 additions and 8 deletions.
12 changes: 6 additions & 6 deletions libraries/AC_WPNav/AC_WPNav.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -177,8 +177,8 @@ void AC_WPNav::wp_and_spline_init(float speed_cms)
_this_leg_is_spline = false;

// initialise the terrain velocity to the current maximum velocity
_terain_vel = _wp_desired_speed_xy_cms;
_terain_accel = 0.0;
_terrain_vel = _wp_desired_speed_xy_cms;
_terrain_accel = 0.0;
}

/// set_speed_xy - allows main code to pass target horizontal velocity for wp navigation
Expand All @@ -187,7 +187,7 @@ void AC_WPNav::set_speed_xy(float speed_cms)
// range check target speed
if (speed_cms >= WPNAV_WP_SPEED_MIN) {
// update terrain following speed scalar
_terain_vel = speed_cms * _terain_vel / _wp_desired_speed_xy_cms;
_terrain_vel = speed_cms * _terrain_vel / _wp_desired_speed_xy_cms;

// initialize the desired wp speed
_wp_desired_speed_xy_cms = speed_cms;
Expand Down Expand Up @@ -463,11 +463,11 @@ bool AC_WPNav::advance_wp_target_along_track(float dt)

float vel_time_scalar = 1.0;
if (is_positive(_wp_desired_speed_xy_cms)) {
update_vel_accel(_terain_vel, _terain_accel, dt, false);
update_vel_accel(_terrain_vel, _terrain_accel, dt, false);
shape_vel_accel( _wp_desired_speed_xy_cms * offset_z_scaler, 0.0,
_terain_vel, _terain_accel,
_terrain_vel, _terrain_accel,
-_wp_accel_cmss, _wp_accel_cmss, _pos_control.get_shaping_jerk_xy_cmsss(), dt, true);
vel_time_scalar = _terain_vel / _wp_desired_speed_xy_cms;
vel_time_scalar = _terrain_vel / _wp_desired_speed_xy_cms;
}

// change s-curve time speed with a time constant of maximum acceleration / maximum jerk
Expand Down
4 changes: 2 additions & 2 deletions libraries/AC_WPNav/AC_WPNav.h
Original file line number Diff line number Diff line change
Expand Up @@ -262,8 +262,8 @@ class AC_WPNav
Vector3f _origin; // starting point of trip to next waypoint in cm from ekf origin
Vector3f _destination; // target destination in cm from ekf origin
float _track_scalar_dt; // time compression multiplier to slow the progress along the track
float _terain_vel; // maximum horizontal velocity used to ensure the aircraft can maintain height above terain
float _terain_accel; // acceleration value used to change _terain_vel
float _terrain_vel; // maximum horizontal velocity used to ensure the aircraft can maintain height above terrain
float _terrain_accel; // acceleration value used to change _terain_vel

// terrain following variables
bool _terrain_alt; // true if origin and destination.z are alt-above-terrain, false if alt-above-ekf-origin
Expand Down

0 comments on commit ba50f68

Please sign in to comment.