Fixed servos_test

The accuracy and precision of the two servo motors can now be tested
simultaneously by analyzing the feedback values for each motor.