Finished up servo_open test
merged anna's servo test changes in