Skip to content

Commit 3605532

Browse files
committed
shanges in time step names
1 parent f6b39cc commit 3605532

11 files changed

Lines changed: 20 additions & 19 deletions

guidance/los_guidance/include/los_guidance/lib/adaptive_los.hpp

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -26,7 +26,7 @@ struct AdaptiveLosParams {
2626
double lookahead_distance_v{};
2727
double adaptation_gain_h{};
2828
double adaptation_gain_v{};
29-
double time_step{};
29+
double time_step_s{};
3030
};
3131

3232
/**

guidance/los_guidance/include/los_guidance/lib/integral_los.hpp

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -22,7 +22,7 @@ struct IntegralLosParams {
2222
double proportional_gain_v{};
2323
double integral_gain_h{};
2424
double integral_gain_v{};
25-
double time_step{};
25+
double time_step_s{};
2626
};
2727

2828
/**

guidance/los_guidance/include/los_guidance/lib/vector_field_los.hpp

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -22,7 +22,7 @@ struct VectorFieldLosParams {
2222
double max_approach_angle_v{};
2323
double proportional_gain_h{};
2424
double proportional_gain_v{};
25-
double time_step{};
25+
double time_step_s{};
2626
};
2727

2828
/**

guidance/los_guidance/src/lib/adaptive_los.cpp

Lines changed: 3 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -8,7 +8,7 @@ AdaptiveLOSGuidance::AdaptiveLOSGuidance(const AdaptiveLosParams& params)
88
: params_{params} {
99
if (params.lookahead_distance_h <= 0.0 ||
1010
params.lookahead_distance_v <= 0.0 || params.adaptation_gain_h <= 0.0 ||
11-
params.adaptation_gain_v <= 0.0 || params.time_step <= 0.0) {
11+
params.adaptation_gain_v <= 0.0 || params.time_step_s <= 0.0) {
1212
throw std::invalid_argument(
1313
"AdaptiveLOSGuidance: all params must be > 0");
1414
}
@@ -58,8 +58,8 @@ void AdaptiveLOSGuidance::update_adaptive_estimates(
5858
(params_.lookahead_distance_v / denom_v) *
5959
cross_track_error.z_e;
6060

61-
beta_c_hat_ += beta_dot * params_.time_step;
62-
alpha_c_hat_ += alpha_dot * params_.time_step;
61+
beta_c_hat_ += beta_dot * params_.time_step_s;
62+
alpha_c_hat_ += alpha_dot * params_.time_step_s;
6363
}
6464

6565
types::GuidanceOutputs AdaptiveLOSGuidance::calculate_outputs(

guidance/los_guidance/src/lib/guidance_manager.cpp

Lines changed: 3 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -65,7 +65,7 @@ void LosGuidanceStateManager::emplace_los_for_method(
6565
c["proportional_gain_v"].as<double>();
6666
params.integral_gain_h = c["integral_gain_h"].as<double>();
6767
params.integral_gain_v = c["integral_gain_v"].as<double>();
68-
params.time_step = time_step_s_;
68+
params.time_step_s = time_step_s_;
6969
los_method_.emplace<IntegralLOSGuidance>(params);
7070
break;
7171
}
@@ -78,7 +78,7 @@ void LosGuidanceStateManager::emplace_los_for_method(
7878
c["lookahead_distance_v"].as<double>();
7979
params.adaptation_gain_h = c["adaptation_gain_h"].as<double>();
8080
params.adaptation_gain_v = c["adaptation_gain_v"].as<double>();
81-
params.time_step = time_step_s_;
81+
params.time_step_s = time_step_s_;
8282
los_method_.emplace<AdaptiveLOSGuidance>(params);
8383
break;
8484
}
@@ -93,7 +93,7 @@ void LosGuidanceStateManager::emplace_los_for_method(
9393
c["proportional_gain_h"].as<double>();
9494
params.proportional_gain_v =
9595
c["proportional_gain_v"].as<double>();
96-
params.time_step = time_step_s_;
96+
params.time_step_s = time_step_s_;
9797
los_method_.emplace<VectorFieldLOSGuidance>(params);
9898
break;
9999
}

guidance/los_guidance/src/lib/integral_los.cpp

Lines changed: 4 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -7,7 +7,7 @@ IntegralLOSGuidance::IntegralLOSGuidance(const IntegralLosParams& params)
77
: m_params(params) {
88
if (params.proportional_gain_h <= 0.0 ||
99
params.proportional_gain_v <= 0.0 || params.integral_gain_h <= 0.0 ||
10-
params.integral_gain_v <= 0.0 || params.time_step <= 0.0) {
10+
params.integral_gain_v <= 0.0 || params.time_step_s <= 0.0) {
1111
throw std::invalid_argument(
1212
"IntegralLOSGuidance: all params must be > 0");
1313
}
@@ -47,8 +47,9 @@ types::GuidanceOutputs IntegralLOSGuidance::calculate_outputs(
4747
const types::CrossTrackError cross_track_error =
4848
calculate_crosstrack_error(inputs);
4949

50-
integrated_horizontal_error_ += cross_track_error.y_e * m_params.time_step;
51-
integrated_vertical_error_ += cross_track_error.z_e * m_params.time_step;
50+
integrated_horizontal_error_ +=
51+
cross_track_error.y_e * m_params.time_step_s;
52+
integrated_vertical_error_ += cross_track_error.z_e * m_params.time_step_s;
5253

5354
const double u_h = m_params.proportional_gain_h * cross_track_error.y_e +
5455
m_params.integral_gain_h * integrated_horizontal_error_;

guidance/los_guidance/src/lib/vector_field_los.cpp

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -9,7 +9,7 @@ VectorFieldLOSGuidance::VectorFieldLOSGuidance(
99
if (params.max_approach_angle_h <= 0.0 ||
1010
params.max_approach_angle_v <= 0.0 ||
1111
params.proportional_gain_h <= 0.0 ||
12-
params.proportional_gain_v <= 0.0 || params.time_step <= 0.0) {
12+
params.proportional_gain_v <= 0.0 || params.time_step_s <= 0.0) {
1313
throw std::invalid_argument(
1414
"VectorFieldLOSGuidance: all params must be > 0");
1515
}

guidance/los_guidance/test/adaptive_los_test.cpp

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -13,7 +13,7 @@ class AdaptiveLosTest : public ::testing::Test {
1313
p.lookahead_distance_v = 1.4;
1414
p.adaptation_gain_h = 0.03;
1515
p.adaptation_gain_v = 0.02;
16-
p.time_step = 0.01;
16+
p.time_step_s = 0.01;
1717
return p;
1818
}
1919

guidance/los_guidance/test/integral_los_test.cpp

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -14,7 +14,7 @@ class IntegralLosTest : public ::testing::Test {
1414
params.integral_gain_v = 0.5;
1515
params.proportional_gain_h = 0.1;
1616
params.proportional_gain_v = 0.1;
17-
params.time_step = 0.01;
17+
params.time_step_s = 0.01;
1818
return params;
1919
}
2020

guidance/los_guidance/test/los_invalid_params_test.cpp

Lines changed: 3 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -14,7 +14,7 @@ TEST(LosInvalidParamsTest, AdaptiveLosRejectsNegativeLookaheadDistance) {
1414
params.lookahead_distance_v = 1.4;
1515
params.adaptation_gain_h = 0.03;
1616
params.adaptation_gain_v = 0.02;
17-
params.time_step = 0.01;
17+
params.time_step_s = 0.01;
1818

1919
EXPECT_THROW(
2020
{ AdaptiveLOSGuidance guidance(params); }, std::invalid_argument);
@@ -35,7 +35,7 @@ TEST(LosInvalidParamsTest, IntegralLosRejectsZeroTimeStep) {
3535
params.proportional_gain_v = 0.5;
3636
params.integral_gain_h = 0.1;
3737
params.integral_gain_v = 0.1;
38-
params.time_step = 0.0;
38+
params.time_step_s = 0.0;
3939

4040
EXPECT_THROW(
4141
{ IntegralLOSGuidance guidance(params); }, std::invalid_argument);
@@ -47,7 +47,7 @@ TEST(LosInvalidParamsTest, VectorFieldLosRejectsNegativeApproachAngle) {
4747
params.max_approach_angle_v = 1.0;
4848
params.proportional_gain_h = 1.5;
4949
params.proportional_gain_v = 0.9;
50-
params.time_step = 0.01;
50+
params.time_step_s = 0.01;
5151

5252
EXPECT_THROW(
5353
{ VectorFieldLOSGuidance guidance(params); }, std::invalid_argument);

0 commit comments

Comments
 (0)