Heterogeneous Robot Group Control and Applications