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