Begin of seperation
More separation in simps and implementation of compass observer
finished speration
Merge branch 'TestAndDocument' of github.com:BeuthProjects/guts into TestAndDocument