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

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