Integration Of 3D And 2D Imaging Data For Assured Navigation In Unknown Environments