public void HeuristicA1()
 {
     movementBehaviour.KinematicArrive();
 }