main: Add wfi to main loop
feedback: Fix timer interrupt