Trying to get OOP to ChibiOS (and if it works will probably become RuuviTracker firmware)