Create ServoControl.c