ros-planning / robot_pose_ekf

robot_pose_ekf package for ROS Melodic and later
278 stars 91 forks source link

initializing with non valid quaternion #4

Open cimbar opened 4 years ago

cimbar commented 4 years ago

When the odometry message's quaternion value is not valid, robot_pose_ekf cannot be initialized with only vision odometry and imu source. Although non valid odometry message will be fixed after a specific time, robot_pose_ekf output cannot fix itself after that. I think there is a need to check odometry message validation before start to activate that source to compute ekf output. The quaternion inputs like x=y=z=w=0 or x=y=z=w=nan produce this situation and the ekf output will also be non valid pose.