Create testServoCode