@@ -387,11 +387,11 @@ bool ConstantTurnRateMotionTracker::measureWithPose(
387
387
const bool enable_yaw_measurement = trust_yaw_input_ && object_has_orientation;
388
388
389
389
if (enable_yaw_measurement) {
390
- Eigen::MatrixXd Cyaw = Eigen::MatrixXd::Zero (1 , ekf_params_.dim_x );
391
- Cyaw (0 , IDX::YAW) = 1 ;
392
- C_list.push_back (Cyaw );
390
+ Eigen::MatrixXd C_yaw = Eigen::MatrixXd::Zero (1 , ekf_params_.dim_x );
391
+ C_yaw (0 , IDX::YAW) = 1 ;
392
+ C_list.push_back (C_yaw );
393
393
394
- Eigen::MatrixXd Yyaw = Eigen::MatrixXd::Zero (1 , 1 );
394
+ Eigen::MatrixXd Y_yaw = Eigen::MatrixXd::Zero (1 , 1 );
395
395
const auto yaw = [&] {
396
396
auto obj_yaw = tier4_autoware_utils::normalizeRadian (
397
397
tf2::getYaw (object.kinematics .pose_with_covariance .pose .orientation ));
@@ -404,12 +404,12 @@ bool ConstantTurnRateMotionTracker::measureWithPose(
404
404
return obj_yaw;
405
405
}();
406
406
407
- Yyaw << yaw;
408
- Y_list.push_back (Yyaw );
407
+ Y_yaw << yaw;
408
+ Y_list.push_back (Y_yaw );
409
409
410
- Eigen::MatrixXd Ryaw = Eigen::MatrixXd::Zero (1 , 1 );
411
- Ryaw << ekf_params_.r_cov_yaw ;
412
- R_block_list.push_back (Ryaw );
410
+ Eigen::MatrixXd R_yaw = Eigen::MatrixXd::Zero (1 , 1 );
411
+ R_yaw << ekf_params_.r_cov_yaw ;
412
+ R_block_list.push_back (R_yaw );
413
413
}
414
414
415
415
// 3. add linear velocity measurement
0 commit comments