Trying to set up correct formation preserving, needs debugging, it's not yet working