fix(simple_planning_simulator): fix acc output for the model sim_mode…

…l_delay_steer_acc_geared_wo_fall_guard (autowarefoundation#8607)

fix acceleration output

Signed-off-by: Yuki Takagi <yuki.takagi@tier4.jp>

simulator/simple_planning_simulator/include/simple_planning_simulator/vehicle_model/sim_model_delay_steer_acc_geared_wo_fall_guard.hpp

@@ -64,6 +64,7 @@ class SimModelDelaySteerAccGearedWoFallGuard : public SimModelInterface
     VX,
     STEER,
     PEDAL_ACCX,
+    ACCX,
   };
   enum IDX_U { PEDAL_ACCX_DES = 0, GEAR, SLOPE_ACCX, STEER_DES };
 

simulator/simple_planning_simulator/src/simple_planning_simulator/vehicle_model/sim_model_delay_steer_acc_geared_wo_fall_guard.cpp

@@ -64,7 +64,7 @@ double SimModelDelaySteerAccGearedWoFallGuard::getVy()
 }
 double SimModelDelaySteerAccGearedWoFallGuard::getAx()
 {
-  return state_(IDX::PEDAL_ACCX);
+  return state_(IDX::ACCX);
 }
 double SimModelDelaySteerAccGearedWoFallGuard::getWz()
 {
@@ -103,6 +103,8 @@ void SimModelDelaySteerAccGearedWoFallGuard::update(const double & dt)
     // stop condition is satisfied
     state_(IDX::VX) = 0.0;
   }
+
+  state_(IDX::ACCX) = (state_(IDX::VX) - prev_state(IDX::VX)) / dt;
 }
 
 void SimModelDelaySteerAccGearedWoFallGuard::initializeInputQueue(const double & dt)