Fully autonomous 3D continuous obstacle avoidance