Fix non-working servo