Separated behaviour functions. Added pivot-based actuator and fixed pathfinding.