Fix to work with Chibios 2.6.1.