added unit tests
Merge branch 'issue708' of https://github.com/sethhirsh/tudat-svn-mirror into issue708