Joint Indoor Localization and Navigation of UAVs for Network Formation Control