new module for algorithms, currently implementing rigid formation control