Ros program to control all modular robots - View it on GitHub