Added cloneTo method to support trajectory point copying.

Addresses issue #27.  Refactored/expanded test suite.