CPP wrappers ported to chibios-3.0