SAFE NEAR RANGE NAVIGATION BASED ON 3D TIME-OF-FLIGHT CAMERAS