Vision-Based Navigation I: A navigation filter for fusing DTM/correspondence updates