* Updated the NavigationTest to use the USS
Merge branch 'master' of https://github.com/dionbosschieter/cleanstormers.git
+ Added soft boundries setting the boundries to an area of 3m2
+ Cleaned up some code
TODO: Add events instead of polling
* Basic routines are implemented
Merge branch 'master' of https://github.com/dionbosschieter/cleanstormers.git