Minor changes

- More descriptive comments useful when doing parallel plan
- Feature to allow color console output (stolen straight from MoveIt!)
Probably depends on your terminal type... you wrote it :)
https://github.com/ros-planning/moveit_core/blob/hydro-devel/macros/include/moveit/macros/console_colors.h