Cooperative planning for physically interacting heterogeneous robots | Synapse