hector_pose_estimation_core: fixed yaw update indices