Building Heterogeneous Robot Control and Service Layer