public void HeuristicA2()
 {
     movementBehaviour.KinematicArrive();
     movementBehaviour.InterpolateRotate();
 }