fixed some build issues
changed circumference to radius
adde some debug output
some corrections in getting the lin velocity
changed math macros to functions for type safety
added output
now setting sampling interval
some fixes and added output
changed output
minor fixes
added stopping for maze solver