Added Gauss Newton inverse depth estimation procedure