Fix for ChibiOS 2.3.4