Safe formation scaling and motion planning for heterogeneous UAV–UGV teams in cluttered environments | Synapse