https://5dok.net/document/nzwkno0z-coordinate-formation-control-multi-agent-systems-rooted-graphs.html