ported Heartbeat task to chibios cpp wrapper