Minor changes

- More descriptive comments useful when doing parallel plan
- Feature to allow color console output (stolen straight from MoveIt!)
Im only using the colors in my lightning code right now, but it has plenty
of potential.