[F&E]: Improve Unit Tests (docstrings included)

[luigigisolfi]

Description:

This issue will be taken care of during the Tudat Summer Camp and relates to the list in #611.

Suggestions for implementation:

No response

Additional context:

No response