Skip to content

Commit 30ea518

Browse files
committed
add comments
Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
1 parent e4dadc5 commit 30ea518

File tree

1 file changed

+4
-0
lines changed

1 file changed

+4
-0
lines changed

simulator/simple_planning_simulator/src/simple_planning_simulator/vehicle_model/sim_model_delay_steer_acc_geared.cpp

+4
Original file line numberDiff line numberDiff line change
@@ -72,6 +72,7 @@ double SimModelDelaySteerAccGeared::getWz()
7272
}
7373
double SimModelDelaySteerAccGeared::getSteer()
7474
{
75+
// return measured values with bias added to actual values
7576
return state_(IDX::STEER) + steer_bias_;
7677
}
7778
void SimModelDelaySteerAccGeared::update(const double & dt)
@@ -120,6 +121,9 @@ Eigen::VectorXd SimModelDelaySteerAccGeared::calcModel(
120121
sat(input(IDX_U::ACCX_DES), vx_rate_lim_, -vx_rate_lim_) * debug_acc_scaling_factor_;
121122
const double steer_des =
122123
sat(input(IDX_U::STEER_DES), steer_lim_, -steer_lim_) * debug_steer_scaling_factor_;
124+
// NOTE: `steer_des` is calculated by control from measured values. getSteer() also gets the
125+
// measured value. The steer_rate used in the motion calculation is obtained from these
126+
// differences.
123127
const double steer_diff = getSteer() - steer_des;
124128
const double steer_diff_with_dead_band = std::invoke([&]() {
125129
if (steer_diff > steer_dead_band_) {

0 commit comments

Comments
 (0)