dropped max planned acceleration a bit
moved timestamp conversion constants to Constants.hpp
added compensation for rapid path changes.  #39