Cleaned up servo test script.