Small debug output changes

- More descriptive comments useful when doing parallel plan

Originally from https://github.com/ompl/ompl/pull/20