Remove all this servo code