Setting Goal pose gives error related to matrix dimension mismatch in eigen library's function. How to solve this ?

[siddharth-w]

Code of Conduct

• I have read CODE OF CONDUCT and Support Guidelines before creating this Discussion post.

Contents

[rviz2-45] [INFO] [1733910402.195243253] [rviz2]: Setting goal pose: Frame:map, Position(74.6885, 5.85385, 0), Orientation(0, 0, 0.0185089, 0.999829) = Angle: 0.0370199
[component_container_mt-27] [INFO] [1733910402.503724677] [route_handler]: getMainLanelets: lanelet_sequence = [ids: 7 ]
[component_container_mt-27] [INFO] [1733910402.518625091] [planning.mission_planning.mission_planner]: initial pose - x: 21.888502, y: 2.853853, z: -2.577400
[component_container_mt-27] [INFO] [1733910402.518707872] [planning.mission_planning.mission_planner]: initial orientation - qx: -0.000187, qy: 0.011240, qz: 0.016659, qw: 0.999798
[component_container_mt-27] [INFO] [1733910402.518726571] [planning.mission_planning.mission_planner]: goal pose - x: 74.688515, y: 5.853854, z: 0.000000
[component_container_mt-27] [INFO] [1733910402.518740962] [planning.mission_planning.mission_planner]: goal orientation - qx: 0.000000, qy: 0.000000, qz: 0.018509, qw: 0.999829
[component_container_mt-38] [INFO] [1733910402.593744729] [control.trajectory_follower.lane_departure_checker_node]: waiting for reference_trajectory msg...
[topic_state_monitor_node-13] [INFO] [1733910403.350654610] [system.topic_state_monitor_control_command_control_cmd]: /control/command/control_cmd has not received. Set ERROR in diagnostics.
[component_container_mt-38] [INFO] [1733910403.993885450] [control.trajectory_follower.lane_departure_checker_node]: waiting for predicted_trajectory msg...
[component_container_mt-38] component_container_mt: /usr/include/eigen3/Eigen/src/Core/CwiseBinaryOp.h:116: Eigen::CwiseBinaryOp<BinaryOp, Lhs, Rhs>::CwiseBinaryOp(const Lhs&, const Rhs&, const BinaryOp&) [with BinaryOp = Eigen::internal::scalar_sum_op<double, double>; LhsType = const Eigen::Matrix<double, -1, 1>; RhsType = const Eigen::CwiseBinaryOp<Eigen::internal::scalar_product_op<double, double>, const Eigen::Matrix<double, -1, 1>, const Eigen::CwiseNullaryOp<Eigen::internal::scalar_constant_op, const Eigen::Matrix<double, -1, 1> > >; Eigen::CwiseBinaryOp<BinaryOp, Lhs, Rhs>::Lhs = Eigen::Matrix<double, -1, 1>; Eigen::CwiseBinaryOp<BinaryOp, Lhs, Rhs>::Rhs = Eigen::CwiseBinaryOp<Eigen::internal::scalar_product_op<double, double>, const Eigen::Matrix<double, -1, 1>, const Eigen::CwiseNullaryOp<Eigen::internal::scalar_constant_op, const Eigen::Matrix<double, -1, 1> > >]: Assertion `aLhs.rows() == aRhs.rows() && aLhs.cols() == aRhs.cols()' failed.
[component_container_mt-38] *** Aborted at 1733910404 (unix time) try "date -d @1733910404" if you are using GNU date ***
[component_container_mt-38] PC: @ 0x0 (unknown)
[component_container_mt-38] *** SIGABRT (@0x3e8000017fc) received by PID 6140 (TID 0x7a76b5000640) from PID 6140; stack trace: ***
[component_container_mt-38] @ 0x7a76bbc42520 (unknown)
[component_container_mt-38] @ 0x7a76bbc969fc pthread_kill
[component_container_mt-38] @ 0x7a76bbc42476 raise
[component_container_mt-38] @ 0x7a76bbc287f3 abort
[component_container_mt-38] @ 0x7a76bbc2871b (unknown)
[component_container_mt-38] @ 0x7a76bbc39e96 __assert_fail
[component_container_mt-38] @ 0x7a76ad86a974 Eigen::CwiseBinaryOp<>::CwiseBinaryOp()
[topic_state_monitor_node-11] [WARN] [1733910404.251995766] [system.topic_state_monitor_scenario_planning_trajectory]: /planning/scenario_planning/trajectory topic rate has dropped to the warning level. Set WARN in diagnostics.
[component_container_mt-38] @ 0x7a76ad86a40c Eigen::MatrixBase<>::operator+<>()
[component_container_mt-38] @ 0x7a76ad86ddde _ZZNK8autoware6motion7control22mpc_lateral_controller22KinematicsBicycleModel45calculatePredictedTrajectoryInWorldCoordinateERKN5Eigen6MatrixIdLin1ELin1ELi0ELin1ELin1EEES8_S8_S8_S8_S8_RKNS2_13MPCTrajectoryEdENKUlRKNS5_IdLin1ELi1ELi0ELin1ELi1EEERKdddE0_clESE_SG_dd
[component_container_mt-38] @ 0x7a76ad86dfa3 autoware::motion::control::mpc_lateral_controller::KinematicsBicycleModel::calculatePredictedTrajectoryInWorldCoordinate()
[component_container_mt-38] @ 0x7a76ad7d7c29 autoware::motion::control::mpc_lateral_controller::MPC::calculatePredictedTrajectory()
[component_container_mt-38] @ 0x7a76ad7d16d0 autoware::motion::control::mpc_lateral_controller::MPC::calculateMPC()
[component_container_mt-38] @ 0x7a76ad770c7d autoware::motion::control::mpc_lateral_controller::MpcLateralController::run()
[component_container_mt-38] @ 0x7a76ae3795d1 autoware::motion::control::trajectory_follower_node::Controller::callbackTimerControl()
[component_container_mt-38] @ 0x7a76ae4f5a72 std::__invoke_impl<>()
[component_container_mt-38] @ 0x7a76ae4ec4ff std::__invoke<>()
[component_container_mt-38] @ 0x7a76ae4e1d8f _ZNSt5_BindIFMN8autoware6motion7control24trajectory_follower_node10ControllerEFvvEPS4_EE6__callIvJEJLm0EEEET_OSt5tupleIJDpT0_EESt12_Index_tupleIJXspT1_EEE
[component_container_mt-38] @ 0x7a76ae4c57c7 std::_Bind<>::operator()<>()
[component_container_mt-38] @ 0x7a76ae4bf150 rclcpp::GenericTimer<>::execute_callback_delegate<>()
[component_container_mt-38] @ 0x7a76ae4b4857 rclcpp::GenericTimer<>::execute_callback()
[component_container_mt-38] @ 0x7a76bc4dafd1 rclcpp::Executor::execute_any_executable()
[component_container_mt-38] @ 0x7a76bc4e23ba rclcpp::executors::MultiThreadedExecutor::run()
[component_container_mt-38] @ 0x7a76bc0dc253 (unknown)
[component_container_mt-38] @ 0x7a76bbc94ac3 (unknown)
[component_container_mt-38] @ 0x7a76bbd26850 (unknown)
[topic_state_monitor_node-12] [INFO] [1733910404.812143606] [system.topic_state_monitor_trajectory_follower_control_cmd]: /control/trajectory_follower/control_cmd has not received. Set ERROR in diagnostics.
[ERROR] [component_container_mt-38]: process has died [pid 6140, exit code -6, cmd '/opt/ros/humble/lib/rclcpp_components/component_container_mt --ros-args -r __node:=control_container -r __ns:=/control -p use_sim_time:=False -p wheel_radius:=0.383 -p wheel_width:=0.235 -p wheel_base:=2.79 -p wheel_tread:=1.64 -p front_overhang:=1.0 -p rear_overhang:=1.1 -p left_overhang:=0.128 -p right_overhang:=0.128 -p vehicle_height:=2.5 -p max_steer_angle:=0.7'].

I am not able to reproduce this error in other systems.