fix robot_pose_ekf test