fixed up servo code