Merge upstream changes from sbpl_manipulation. Fix Distancefield parameters so it should work...