REACHING A TARGET WITHIN A GPS-DENIED OR COSTLY AREA: A TWO-STAGE OPTIMAL CONTROL APPROACH