Create testservo.c