}		if (spec->dig_in_nid) {			info->stream[SNDRV_PCM_STREAM_CAPTURE] = stac92xx_pcm_digital_capture;			info->stream[SNDRV_PCM_STREAM_CAPTURE].nid = spec->dig_in_nid;		}	}	return 0;}enum {	STAC_CTL_WIDGET_VOL,	STAC_CTL_WIDGET_MUTE,};static snd_kcontrol_new_t stac92xx_control_templates[] = {	HDA_CODEC_VOLUME(NULL, 0, 0, 0),	HDA_CODEC_MUTE(NULL, 0, 0, 0),};/* add dynamic controls */static int stac92xx_add_control(struct sigmatel_spec *spec, int type, const char *name, unsigned long val){	snd_kcontrol_new_t *knew;	if (spec->num_kctl_used >= spec->num_kctl_alloc) {		int num = spec->num_kctl_alloc + NUM_CONTROL_ALLOC;		knew = kcalloc(num + 1, sizeof(*knew), GFP_KERNEL); /* array + terminator */		if (! knew)			return -ENOMEM;		if (spec->kctl_alloc) {			memcpy(knew, spec->kctl_alloc, sizeof(*knew) * spec->num_kctl_alloc);			kfree(spec->kctl_alloc);		}		spec->kctl_alloc = knew;		spec->num_kctl_alloc = num;	}	knew = &spec->kctl_alloc[spec->num_kctl_used];	*knew = stac92xx_control_templates[type];	knew->name = kstrdup(name, GFP_KERNEL);	if (! knew->name)		return -ENOMEM;	knew->private_value = val;	spec->num_kctl_used++;	return 0;}/* fill in the dac_nids table from the parsed pin configuration */static int stac92xx_auto_fill_dac_nids(struct hda_codec *codec, const struct auto_pin_cfg *cfg){	struct sigmatel_spec *spec = codec->spec;	hda_nid_t nid;	int i;	/* check the pins hardwired to audio widget */	for (i = 0; i < cfg->line_outs; i++) {		nid = cfg->line_out_pins[i];		spec->multiout.dac_nids[i] = snd_hda_codec_read(codec, nid, 0,					AC_VERB_GET_CONNECT_LIST, 0) & 0xff;	}	spec->multiout.num_dacs = cfg->line_outs;	return 0;}/* add playback controls from the parsed DAC table */static int stac92xx_auto_create_multi_out_ctls(struct sigmatel_spec *spec, const struct auto_pin_cfg *cfg){	char name[32];	static const char *chname[4] = { "Front", "Surround", NULL /*CLFE*/, "Side" };	hda_nid_t nid;	int i, err;	for (i = 0; i < cfg->line_outs; i++) {		if (! spec->multiout.dac_nids[i])			continue;		nid = spec->multiout.dac_nids[i];		if (i == 2) {			/* Center/LFE */			if ((err = stac92xx_add_control(spec, STAC_CTL_WIDGET_VOL, "Center Playback Volume",					       HDA_COMPOSE_AMP_VAL(nid, 1, 0, HDA_OUTPUT))) < 0)				return err;			if ((err = stac92xx_add_control(spec, STAC_CTL_WIDGET_VOL, "LFE Playback Volume",					       HDA_COMPOSE_AMP_VAL(nid, 2, 0, HDA_OUTPUT))) < 0)				return err;			if ((err = stac92xx_add_control(spec, STAC_CTL_WIDGET_MUTE, "Center Playback Switch",					       HDA_COMPOSE_AMP_VAL(nid, 1, 0, HDA_OUTPUT))) < 0)				return err;			if ((err = stac92xx_add_control(spec, STAC_CTL_WIDGET_MUTE, "LFE Playback Switch",					       HDA_COMPOSE_AMP_VAL(nid, 2, 0, HDA_OUTPUT))) < 0)				return err;		} else {			sprintf(name, "%s Playback Volume", chname[i]);			if ((err = stac92xx_add_control(spec, STAC_CTL_WIDGET_VOL, name,					       HDA_COMPOSE_AMP_VAL(nid, 3, 0, HDA_OUTPUT))) < 0)				return err;			sprintf(name, "%s Playback Switch", chname[i]);			if ((err = stac92xx_add_control(spec, STAC_CTL_WIDGET_MUTE, name,					       HDA_COMPOSE_AMP_VAL(nid, 3, 0, HDA_OUTPUT))) < 0)				return err;		}	}	return 0;}/* add playback controls for HP output */static int stac92xx_auto_create_hp_ctls(struct hda_codec *codec, struct auto_pin_cfg *cfg){	struct sigmatel_spec *spec = codec->spec;	hda_nid_t pin = cfg->hp_pin;	hda_nid_t nid;	int i, err;	unsigned int wid_caps;	if (! pin)		return 0;	wid_caps = snd_hda_param_read(codec, pin, AC_PAR_AUDIO_WIDGET_CAP);	if (wid_caps & AC_WCAP_UNSOL_CAP)		/* Enable unsolicited responses on the HP widget */		snd_hda_codec_write(codec, pin, 0,				AC_VERB_SET_UNSOLICITED_ENABLE,				STAC_UNSOL_ENABLE);	nid = snd_hda_codec_read(codec, pin, 0, AC_VERB_GET_CONNECT_LIST, 0) & 0xff;	for (i = 0; i < cfg->line_outs; i++) {		if (! spec->multiout.dac_nids[i])			continue;		if (spec->multiout.dac_nids[i] == nid)			return 0;	}	spec->multiout.hp_nid = nid;	/* control HP volume/switch on the output mixer amp */	if ((err = stac92xx_add_control(spec, STAC_CTL_WIDGET_VOL, "Headphone Playback Volume",					HDA_COMPOSE_AMP_VAL(nid, 3, 0, HDA_OUTPUT))) < 0)		return err;	if ((err = stac92xx_add_control(spec, STAC_CTL_WIDGET_MUTE, "Headphone Playback Switch",					HDA_COMPOSE_AMP_VAL(nid, 3, 0, HDA_OUTPUT))) < 0)		return err;	return 0;}/* create playback/capture controls for input pins */static int stac92xx_auto_create_analog_input_ctls(struct hda_codec *codec, const struct auto_pin_cfg *cfg){	struct sigmatel_spec *spec = codec->spec;	static char *labels[AUTO_PIN_LAST] = {		"Mic", "Front Mic", "Line", "Front Line", "CD", "Aux"	};	struct hda_input_mux *imux = &spec->private_imux;	hda_nid_t con_lst[HDA_MAX_NUM_INPUTS];	int i, j, k;	for (i = 0; i < AUTO_PIN_LAST; i++) {		int index = -1;		if (cfg->input_pins[i]) {			imux->items[imux->num_items].label = labels[i];			for (j=0; j<spec->num_muxes; j++) {				int num_cons = snd_hda_get_connections(codec, spec->mux_nids[j], con_lst, HDA_MAX_NUM_INPUTS);				for (k=0; k<num_cons; k++)					if (con_lst[k] == cfg->input_pins[i]) {						index = k;					 	break;					}				if (index >= 0)					break;			}			imux->items[imux->num_items].index = index;			imux->num_items++;		}	}	return 0;}static void stac92xx_auto_set_pinctl(struct hda_codec *codec, hda_nid_t nid, int pin_type){	snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_PIN_WIDGET_CONTROL, pin_type);}static void stac92xx_auto_init_multi_out(struct hda_codec *codec){	struct sigmatel_spec *spec = codec->spec;	int i;	for (i = 0; i < spec->autocfg.line_outs; i++) {		hda_nid_t nid = spec->autocfg.line_out_pins[i];		stac92xx_auto_set_pinctl(codec, nid, AC_PINCTL_OUT_EN);	}}static void stac92xx_auto_init_hp_out(struct hda_codec *codec){	struct sigmatel_spec *spec = codec->spec;	hda_nid_t pin;	pin = spec->autocfg.hp_pin;	if (pin) /* connect to front */		stac92xx_auto_set_pinctl(codec, pin, AC_PINCTL_OUT_EN | AC_PINCTL_HP_EN);}static int stac922x_parse_auto_config(struct hda_codec *codec){	struct sigmatel_spec *spec = codec->spec;	int err;	if ((err = snd_hda_parse_pin_def_config(codec, &spec->autocfg)) < 0)		return err;	if ((err = stac92xx_auto_fill_dac_nids(codec, &spec->autocfg)) < 0)		return err;	if (! spec->autocfg.line_outs && ! spec->autocfg.hp_pin)		return 0; /* can't find valid pin config */	if ((err = stac92xx_auto_create_multi_out_ctls(spec, &spec->autocfg)) < 0 ||	    (err = stac92xx_auto_create_hp_ctls(codec, &spec->autocfg)) < 0 ||	    (err = stac92xx_auto_create_analog_input_ctls(codec, &spec->autocfg)) < 0)		return err;	spec->multiout.max_channels = spec->multiout.num_dacs * 2;	if (spec->multiout.max_channels > 2) {		spec->surr_switch = 1;		spec->cur_ch_mode = 1;		spec->num_ch_modes = 2;		if (spec->multiout.max_channels == 8) {			spec->cur_ch_mode++;			spec->num_ch_modes++;		}	}	if (spec->autocfg.dig_out_pin) {		spec->multiout.dig_out_nid = 0x08;		stac92xx_auto_set_pinctl(codec, spec->autocfg.dig_out_pin, AC_PINCTL_OUT_EN);	}	if (spec->autocfg.dig_in_pin) {		spec->dig_in_nid = 0x09;		stac92xx_auto_set_pinctl(codec, spec->autocfg.dig_in_pin, AC_PINCTL_IN_EN);	}	if (spec->kctl_alloc)		spec->mixers[spec->num_mixers++] = spec->kctl_alloc;	spec->input_mux = &spec->private_imux;	return 1;}static int stac9200_parse_auto_config(struct hda_codec *codec){	struct sigmatel_spec *spec = codec->spec;	int err;	if ((err = snd_hda_parse_pin_def_config(codec, &spec->autocfg)) < 0)		return err;	if ((err = stac92xx_auto_create_analog_input_ctls(codec, &spec->autocfg)) < 0)		return err;	if (spec->autocfg.dig_out_pin) {		spec->multiout.dig_out_nid = 0x05;		stac92xx_auto_set_pinctl(codec, spec->autocfg.dig_out_pin, AC_PINCTL_OUT_EN);	}	if (spec->autocfg.dig_in_pin) {		spec->dig_in_nid = 0x04;		stac92xx_auto_set_pinctl(codec, spec->autocfg.dig_in_pin, AC_PINCTL_IN_EN);	}	if (spec->kctl_alloc)		spec->mixers[spec->num_mixers++] = spec->kctl_alloc;	spec->input_mux = &spec->private_imux;	return 1;}static int stac92xx_init_pstate(struct hda_codec *codec){       hda_nid_t nid, nid_start;       int nodes;	snd_hda_codec_write(codec, 0x01, 0, AC_VERB_SET_POWER_STATE, 0x00);       nodes = snd_hda_get_sub_nodes(codec, codec->afg, &nid_start);       for (nid = nid_start; nid < nodes + nid_start; nid++) {               unsigned int wid_caps = snd_hda_param_read(codec, nid,                                                  AC_PAR_AUDIO_WIDGET_CAP);		if (wid_caps & AC_WCAP_POWER)			snd_hda_codec_write(codec, nid, 0,                                    AC_VERB_SET_POWER_STATE, 0x00);	}	mdelay(100);	return 0;}static int stac92xx_init(struct hda_codec *codec){	struct sigmatel_spec *spec = codec->spec;	stac92xx_init_pstate(codec);	snd_hda_sequence_write(codec, spec->init);	stac92xx_auto_init_multi_out(codec);	stac92xx_auto_init_hp_out(codec);	return 0;}static void stac92xx_free(struct hda_codec *codec){	struct sigmatel_spec *spec = codec->spec;	int i;	if (! spec)		return;	if (spec->kctl_alloc) {		for (i = 0; i < spec->num_kctl_used; i++)			kfree(spec->kctl_alloc[i].name);		kfree(spec->kctl_alloc);	}	kfree(spec);}static void stac92xx_set_pinctl(struct hda_codec *codec, hda_nid_t nid,				unsigned int flag){	unsigned int pin_ctl = snd_hda_codec_read(codec, nid,			0, AC_VERB_GET_PIN_WIDGET_CONTROL, 0x00);	snd_hda_codec_write(codec, nid, 0,			AC_VERB_SET_PIN_WIDGET_CONTROL,			pin_ctl | flag);}static void stac92xx_reset_pinctl(struct hda_codec *codec, hda_nid_t nid,				  unsigned int flag){	unsigned int pin_ctl = snd_hda_codec_read(codec, nid,			0, AC_VERB_GET_PIN_WIDGET_CONTROL, 0x00);	snd_hda_codec_write(codec, nid, 0,			AC_VERB_SET_PIN_WIDGET_CONTROL,			pin_ctl & ~flag);}static void stac92xx_unsol_event(struct hda_codec *codec, unsigned int res){	struct sigmatel_spec *spec = codec->spec;	struct auto_pin_cfg *cfg = &spec->autocfg;	int i, presence;	if ((res >> 26) != STAC_HP_EVENT)		return;	presence = snd_hda_codec_read(codec, cfg->hp_pin, 0,			AC_VERB_GET_PIN_SENSE, 0x00) >> 31;	if (presence) {		/* disable lineouts, enable hp */		for (i = 0; i < cfg->line_outs; i++)			stac92xx_reset_pinctl(codec, cfg->line_out_pins[i],						AC_PINCTL_OUT_EN);		stac92xx_set_pinctl(codec, cfg->hp_pin, AC_PINCTL_OUT_EN);	} else {		/* enable lineouts, disable hp */		for (i = 0; i < cfg->line_outs; i++)			stac92xx_set_pinctl(codec, cfg->line_out_pins[i],						AC_PINCTL_OUT_EN);		stac92xx_reset_pinctl(codec, cfg->hp_pin, AC_PINCTL_OUT_EN);	}} #ifdef CONFIG_PMstatic int stac92xx_resume(struct hda_codec *codec){	struct sigmatel_spec *spec = codec->spec;	int i;	stac92xx_init(codec);	for (i = 0; i < spec->num_mixers; i++)		snd_hda_resume_ctls(codec, spec->mixers[i]);	if (spec->multiout.dig_out_nid)		snd_hda_resume_spdif_out(codec);	if (spec->dig_in_nid)		snd_hda_resume_spdif_in(codec);	return 0;}#endifstatic struct hda_codec_ops stac92xx_patch_ops = {	.build_controls = stac92xx_build_controls,	.build_pcms = stac92xx_build_pcms,	.init = stac92xx_init,	.free = stac92xx_free,	.unsol_event = stac92xx_unsol_event,#ifdef CONFIG_PM	.resume = stac92xx_resume,#endif};static int patch_stac9200(struct hda_codec *codec){	struct sigmatel_spec *spec;	int err;	spec  = kzalloc(sizeof(*spec), GFP_KERNEL);	if (spec == NULL)		return -ENOMEM;	codec->spec = spec;#ifdef STAC_TEST	spec->pin_nids = stac9200_pin_nids;	spec->num_pins = 8;	spec->pin_configs = stac9200_pin_configs;	stac92xx_set_config_regs(codec);#endif	spec->multiout.max_channels = 2;	spec->multiout.num_dacs = 1;	spec->multiout.dac_nids = stac9200_dac_nids;	spec->adc_nids = stac9200_adc_nids;	spec->mux_nids = stac9200_mux_nids;	spec->num_muxes = 1;	spec->init = stac9200_core_init;	spec->mixer = stac9200_mixer;	err = stac9200_parse_auto_config(codec);	if (err < 0) {		stac92xx_free(codec);		return err;	}	codec->patch_ops = stac92xx_patch_ops;	return 0;}static int patch_stac922x(struct hda_codec *codec){	struct sigmatel_spec *spec;	int err;	spec  = kzalloc(sizeof(*spec), GFP_KERNEL);	if (spec == NULL)		return -ENOMEM;	codec->spec = spec;#ifdef STAC_TEST	spec->num_pins = 10;	spec->pin_nids = stac922x_pin_nids;	spec->pin_configs = stac922x_pin_configs;	stac92xx_set_config_regs(codec);#endif	spec->adc_nids = stac922x_adc_nids;	spec->mux_nids = stac922x_mux_nids;	spec->num_muxes = 2;	spec->init = stac922x_core_init;	spec->mixer = stac922x_mixer;	spec->multiout.dac_nids = spec->dac_nids;	err = stac922x_parse_auto_config(codec);	if (err < 0) {		stac92xx_free(codec);		return err;	}	codec->patch_ops = stac92xx_patch_ops;	return 0;}/* * patch entries */struct hda_codec_preset snd_hda_preset_sigmatel[] = { 	{ .id = 0x83847690, .name = "STAC9200", .patch = patch_stac9200 }, 	{ .id = 0x83847882, .name = "STAC9220 A1", .patch = patch_stac922x }, 	{ .id = 0x83847680, .name = "STAC9221 A1", .patch = patch_stac922x }, 	{ .id = 0x83847880, .name = "STAC9220 A2", .patch = patch_stac922x }, 	{ .id = 0x83847681, .name = "STAC9220D/9223D A2", .patch = patch_stac922x }, 	{ .id = 0x83847682, .name = "STAC9221 A2", .patch = patch_stac922x }, 	{ .id = 0x83847683, .name = "STAC9221D A2", .patch = patch_stac922x },	{} /* terminator */};