The servo code didn't work

Looks OK. But I haven't checked the ADCSRA register.