PVTCoord improvements and getDist->getDistance

Improved the PVTCoord constructors.
Added PVTCoord.getDistance method.
Bug fix: PVTCoord.offset was not setting toOrient.
Improved PVTCoord unit tests, including enabling offset test
and constructor with vector vel test.