add some comments for the docu, refactoring of duplicated code, improve…

Merged Benedikt Zoennchen requested to merge issue#96 into develop

add some comments for the docu, refactoring of duplicated code, improve performance of the transformation of the output into trajectory jave objects.

Merge request reports