reorganising the code a bit, we still have lots of test to implement so we need to make a bit clearer
moving things around + added some missing doxy comments
Merge pull request #8 from shadow-robot/F_clean_code_self_test

Cleaning self tests code.