Some debug, trying to make sbpl_arm_planner_moveit_plugin work...