Add filter feature to ADC
Set initial duty cycle to zero
Add speed controller into timer, plus code for testing