TIM2 works with c, todo: change every thing to asm, make a better startup and file structure