(Xronos Embedded CPP) Fixing scheduler