Determine current axis by re-reading of ADMUX instead of global counter
Add initial rest, decay calculation and white balance bias
Reorder, clean up
Read decay period from potentiometer, use phase correct PWM