Format ServoTest.c