Better debug output, always use lightning

Conflicts:

	ompl/ompl_interface/src/model_based_planning_context.cpp