[MTS_MDOT_F411RE] Fix startup to work with RTOS

The old startup skipped directly to main skipping some critical init sections for the RTOS