1ms refresh done, todo: convert TIM.c to asm