Add flocking implementation and run callbacks for navigation