Issue here is, formation memebers keep switching states IDLE -> WALKING -> .... because of the reformation code.
Until better solution I suggest to make it this way.
I managed to make formation dance just thanks to this reforming code and fact that members cant get into their positions perfectly.
Notice formations will still reform once their memebers are idle, but not after their members starts to do orders by themselves.