Fixing timestamps and finishing stm32 timer off for the time being