fixes #1: pre & post pseudo way point determination now uses
fine-grained time steps
applies proper code formatting following the ROS C++ code style guide
Merge pull request #4 from bit-pirate/groovy-devel

fixes #1 and applies proper formatting