TurnInDirection works
RotateAroundAngle, TurnAround and TurnTowardsDestination implemented
GoAwayFromCurrentDestination fixed (Bug in test)