We propose a novel fault-tolerant control reallocation method that adapts to arbitrary number of modular robots and their assembly formations. We propose an agile trajectory planning method for MARS ...