Added servo_config and initialize files