fixed for chibios 2.6