Added cloneTo method to support trajectory point copying.  Refactored/expanded test suite