Implemented buildFormation and move()/setTargetPosition