Finished Multi Robot Movement Node