https://123dok.net/document/q0588w3y-formation-control-of-agricultural-mobile-robots-a-bidirectional-weighted-constraints-approach.html