(sbpl_interface) can add robot links to distance field